2 * Renesas R-Car CMD support
4 * Copyright (C) 2015 Renesas Solutions Corp.
5 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
17 #define CMD_NAME "cmd"
19 #define rsnd_cmd_nr(priv) ((priv)->cmd_nr)
20 #define for_each_rsnd_cmd(pos, priv, i) \
22 ((i) < rsnd_cmd_nr(priv)) && \
23 ((pos) = (struct rsnd_cmd *)(priv)->cmd + i); \
26 static int rsnd_cmd_init(struct rsnd_mod *mod,
27 struct rsnd_dai_stream *io,
28 struct rsnd_priv *priv)
30 struct rsnd_mod *dvc = rsnd_io_to_mod_dvc(io);
31 struct rsnd_mod *mix = rsnd_io_to_mod_mix(io);
32 struct device *dev = rsnd_priv_to_dev(priv);
44 if (ARRAY_SIZE(path) < rsnd_mod_id(mod) + 1)
48 struct rsnd_dai *rdai;
50 struct rsnd_dai_stream *tio;
54 * it is assuming that integrater is well understanding about
55 * data path. Here doesn't check impossible connection,
59 for_each_rsnd_dai(rdai, priv, i) {
60 tio = &rdai->playback;
61 src = rsnd_io_to_mod_src(tio);
62 if (mix == rsnd_io_to_mod_mix(tio))
63 data |= path[rsnd_mod_id(src)];
66 src = rsnd_io_to_mod_src(tio);
67 if (mix == rsnd_io_to_mod_mix(tio))
68 data |= path[rsnd_mod_id(src)];
72 struct rsnd_mod *src = rsnd_io_to_mod_src(io);
88 data = path[rsnd_mod_id(src)] |
89 cmd_case[rsnd_mod_id(src)] << 16;
92 dev_dbg(dev, "ctu/mix path = 0x%08x", data);
94 rsnd_mod_write(mod, CMD_ROUTE_SLCT, data);
95 rsnd_mod_write(mod, CMD_BUSIF_DALIGN, rsnd_get_dalign(mod, io));
97 rsnd_adg_set_cmd_timsel_gen2(mod, io);
102 static int rsnd_cmd_start(struct rsnd_mod *mod,
103 struct rsnd_dai_stream *io,
104 struct rsnd_priv *priv)
106 rsnd_mod_write(mod, CMD_CTRL, 0x10);
111 static int rsnd_cmd_stop(struct rsnd_mod *mod,
112 struct rsnd_dai_stream *io,
113 struct rsnd_priv *priv)
115 rsnd_mod_write(mod, CMD_CTRL, 0);
120 static struct rsnd_mod_ops rsnd_cmd_ops = {
122 .init = rsnd_cmd_init,
123 .start = rsnd_cmd_start,
124 .stop = rsnd_cmd_stop,
127 int rsnd_cmd_attach(struct rsnd_dai_stream *io, int id)
129 struct rsnd_priv *priv = rsnd_io_to_priv(io);
130 struct rsnd_mod *mod = rsnd_cmd_mod_get(priv, id);
132 return rsnd_dai_connect(mod, io, mod->type);
135 struct rsnd_mod *rsnd_cmd_mod_get(struct rsnd_priv *priv, int id)
137 if (WARN_ON(id < 0 || id >= rsnd_cmd_nr(priv)))
140 return rsnd_mod_get((struct rsnd_cmd *)(priv->cmd) + id);
143 int rsnd_cmd_probe(struct rsnd_priv *priv)
145 struct device *dev = rsnd_priv_to_dev(priv);
146 struct rsnd_cmd *cmd;
149 /* This driver doesn't support Gen1 at this point */
150 if (rsnd_is_gen1(priv))
153 /* same number as DVC */
158 cmd = devm_kzalloc(dev, sizeof(*cmd) * nr, GFP_KERNEL);
165 for_each_rsnd_cmd(cmd, priv, i) {
166 ret = rsnd_mod_init(priv, rsnd_mod_get(cmd),
168 rsnd_mod_get_status, RSND_MOD_CMD, i);
176 void rsnd_cmd_remove(struct rsnd_priv *priv)
178 struct rsnd_cmd *cmd;
181 for_each_rsnd_cmd(cmd, priv, i) {
182 rsnd_mod_quit(rsnd_mod_get(cmd));