1 // SPDX-License-Identifier: GPL-2.0
3 // Renesas R-Car CMD support
5 // Copyright (C) 2015 Renesas Solutions Corp.
6 // Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
14 #define CMD_NAME "cmd"
16 #define rsnd_cmd_nr(priv) ((priv)->cmd_nr)
17 #define for_each_rsnd_cmd(pos, priv, i) \
19 ((i) < rsnd_cmd_nr(priv)) && \
20 ((pos) = (struct rsnd_cmd *)(priv)->cmd + i); \
23 static int rsnd_cmd_init(struct rsnd_mod *mod,
24 struct rsnd_dai_stream *io,
25 struct rsnd_priv *priv)
27 struct rsnd_mod *dvc = rsnd_io_to_mod_dvc(io);
28 struct rsnd_mod *mix = rsnd_io_to_mod_mix(io);
29 struct device *dev = rsnd_priv_to_dev(priv);
31 static const u32 path[] = {
41 if (ARRAY_SIZE(path) < rsnd_mod_id(mod) + 1)
45 struct rsnd_dai *rdai;
49 * it is assuming that integrater is well understanding about
50 * data path. Here doesn't check impossible connection,
54 for_each_rsnd_dai(rdai, priv, i) {
55 struct rsnd_dai_stream *tio = &rdai->playback;
56 struct rsnd_mod *src = rsnd_io_to_mod_src(tio);
58 if (mix == rsnd_io_to_mod_mix(tio))
59 data |= path[rsnd_mod_id(src)];
62 src = rsnd_io_to_mod_src(tio);
63 if (mix == rsnd_io_to_mod_mix(tio))
64 data |= path[rsnd_mod_id(src)];
68 struct rsnd_mod *src = rsnd_io_to_mod_src(io);
70 static const u8 cmd_case[] = {
84 data = path[rsnd_mod_id(src)] |
85 cmd_case[rsnd_mod_id(src)] << 16;
88 dev_dbg(dev, "ctu/mix path = 0x%08x\n", data);
90 rsnd_mod_write(mod, CMD_ROUTE_SLCT, data);
91 rsnd_mod_write(mod, CMD_BUSIF_MODE, rsnd_get_busif_shift(io, mod) | 1);
92 rsnd_mod_write(mod, CMD_BUSIF_DALIGN, rsnd_get_dalign(mod, io));
94 rsnd_adg_set_cmd_timsel_gen2(mod, io);
99 static int rsnd_cmd_start(struct rsnd_mod *mod,
100 struct rsnd_dai_stream *io,
101 struct rsnd_priv *priv)
103 rsnd_mod_write(mod, CMD_CTRL, 0x10);
108 static int rsnd_cmd_stop(struct rsnd_mod *mod,
109 struct rsnd_dai_stream *io,
110 struct rsnd_priv *priv)
112 rsnd_mod_write(mod, CMD_CTRL, 0);
117 #ifdef CONFIG_DEBUG_FS
118 static void rsnd_cmd_debug_info(struct seq_file *m,
119 struct rsnd_dai_stream *io,
120 struct rsnd_mod *mod)
122 rsnd_debugfs_mod_reg_show(m, mod, RSND_GEN2_SCU,
123 0x180 + rsnd_mod_id_raw(mod) * 0x20, 0x30);
125 #define DEBUG_INFO .debug_info = rsnd_cmd_debug_info
130 static struct rsnd_mod_ops rsnd_cmd_ops = {
132 .init = rsnd_cmd_init,
133 .start = rsnd_cmd_start,
134 .stop = rsnd_cmd_stop,
135 .get_status = rsnd_mod_get_status,
139 static struct rsnd_mod *rsnd_cmd_mod_get(struct rsnd_priv *priv, int id)
141 if (WARN_ON(id < 0 || id >= rsnd_cmd_nr(priv)))
144 return rsnd_mod_get((struct rsnd_cmd *)(priv->cmd) + id);
146 int rsnd_cmd_attach(struct rsnd_dai_stream *io, int id)
148 struct rsnd_priv *priv = rsnd_io_to_priv(io);
149 struct rsnd_mod *mod = rsnd_cmd_mod_get(priv, id);
151 return rsnd_dai_connect(mod, io, mod->type);
154 int rsnd_cmd_probe(struct rsnd_priv *priv)
156 struct device *dev = rsnd_priv_to_dev(priv);
157 struct rsnd_cmd *cmd;
160 /* This driver doesn't support Gen1 at this point */
161 if (rsnd_is_gen1(priv))
164 /* same number as DVC */
169 cmd = devm_kcalloc(dev, nr, sizeof(*cmd), GFP_KERNEL);
176 for_each_rsnd_cmd(cmd, priv, i) {
177 int ret = rsnd_mod_init(priv, rsnd_mod_get(cmd),
187 void rsnd_cmd_remove(struct rsnd_priv *priv)
189 struct rsnd_cmd *cmd;
192 for_each_rsnd_cmd(cmd, priv, i) {
193 rsnd_mod_quit(rsnd_mod_get(cmd));