1// SPDX-License-Identifier: GPL-2.0
2//
3// Renesas R-Car CMD support
4//
5// Copyright (C) 2015 Renesas Solutions Corp.
6// Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
7
8#include "rsnd.h"
9
10struct rsnd_cmd {
11	struct rsnd_mod mod;
12};
13
14#define CMD_NAME "cmd"
15
16#define rsnd_cmd_nr(priv) ((priv)->cmd_nr)
17#define for_each_rsnd_cmd(pos, priv, i)					\
18	for ((i) = 0;							\
19	     ((i) < rsnd_cmd_nr(priv)) &&				\
20		     ((pos) = (struct rsnd_cmd *)(priv)->cmd + i);	\
21	     i++)
22
23static int rsnd_cmd_init(struct rsnd_mod *mod,
24			 struct rsnd_dai_stream *io,
25			 struct rsnd_priv *priv)
26{
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);
30	u32 data;
31	static const u32 path[] = {
32		[1] = 1 << 0,
33		[5] = 1 << 8,
34		[6] = 1 << 12,
35		[9] = 1 << 15,
36	};
37
38	if (!mix && !dvc)
39		return 0;
40
41	if (ARRAY_SIZE(path) < rsnd_mod_id(mod) + 1)
42		return -ENXIO;
43
44	if (mix) {
45		struct rsnd_dai *rdai;
46		int i;
47
48		/*
49		 * it is assuming that integrater is well understanding about
50		 * data path. Here doesn't check impossible connection,
51		 * like src2 + src5
52		 */
53		data = 0;
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);
57
58			if (mix == rsnd_io_to_mod_mix(tio))
59				data |= path[rsnd_mod_id(src)];
60
61			tio = &rdai->capture;
62			src = rsnd_io_to_mod_src(tio);
63			if (mix == rsnd_io_to_mod_mix(tio))
64				data |= path[rsnd_mod_id(src)];
65		}
66
67	} else {
68		struct rsnd_mod *src = rsnd_io_to_mod_src(io);
69
70		static const u8 cmd_case[] = {
71			[0] = 0x3,
72			[1] = 0x3,
73			[2] = 0x4,
74			[3] = 0x1,
75			[4] = 0x2,
76			[5] = 0x4,
77			[6] = 0x1,
78			[9] = 0x2,
79		};
80
81		if (unlikely(!src))
82			return -EIO;
83
84		data = path[rsnd_mod_id(src)] |
85			cmd_case[rsnd_mod_id(src)] << 16;
86	}
87
88	dev_dbg(dev, "ctu/mix path = 0x%08x\n", data);
89
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));
93
94	rsnd_adg_set_cmd_timsel_gen2(mod, io);
95
96	return 0;
97}
98
99static int rsnd_cmd_start(struct rsnd_mod *mod,
100			  struct rsnd_dai_stream *io,
101			  struct rsnd_priv *priv)
102{
103	rsnd_mod_write(mod, CMD_CTRL, 0x10);
104
105	return 0;
106}
107
108static int rsnd_cmd_stop(struct rsnd_mod *mod,
109			 struct rsnd_dai_stream *io,
110			 struct rsnd_priv *priv)
111{
112	rsnd_mod_write(mod, CMD_CTRL, 0);
113
114	return 0;
115}
116
117#ifdef CONFIG_DEBUG_FS
118static void rsnd_cmd_debug_info(struct seq_file *m,
119				struct rsnd_dai_stream *io,
120				struct rsnd_mod *mod)
121{
122	rsnd_debugfs_mod_reg_show(m, mod, RSND_GEN2_SCU,
123				  0x180 + rsnd_mod_id_raw(mod) * 0x20, 0x30);
124}
125#define DEBUG_INFO .debug_info = rsnd_cmd_debug_info
126#else
127#define DEBUG_INFO
128#endif
129
130static struct rsnd_mod_ops rsnd_cmd_ops = {
131	.name		= CMD_NAME,
132	.init		= rsnd_cmd_init,
133	.start		= rsnd_cmd_start,
134	.stop		= rsnd_cmd_stop,
135	.get_status	= rsnd_mod_get_status,
136	DEBUG_INFO
137};
138
139static struct rsnd_mod *rsnd_cmd_mod_get(struct rsnd_priv *priv, int id)
140{
141	if (WARN_ON(id < 0 || id >= rsnd_cmd_nr(priv)))
142		id = 0;
143
144	return rsnd_mod_get((struct rsnd_cmd *)(priv->cmd) + id);
145}
146int rsnd_cmd_attach(struct rsnd_dai_stream *io, int id)
147{
148	struct rsnd_priv *priv = rsnd_io_to_priv(io);
149	struct rsnd_mod *mod = rsnd_cmd_mod_get(priv, id);
150
151	return rsnd_dai_connect(mod, io, mod->type);
152}
153
154int rsnd_cmd_probe(struct rsnd_priv *priv)
155{
156	struct device *dev = rsnd_priv_to_dev(priv);
157	struct rsnd_cmd *cmd;
158	int i, nr;
159
160	/* This driver doesn't support Gen1 at this point */
161	if (rsnd_is_gen1(priv))
162		return 0;
163
164	/* same number as DVC */
165	nr = priv->dvc_nr;
166	if (!nr)
167		return 0;
168
169	cmd = devm_kcalloc(dev, nr, sizeof(*cmd), GFP_KERNEL);
170	if (!cmd)
171		return -ENOMEM;
172
173	priv->cmd_nr	= nr;
174	priv->cmd	= cmd;
175
176	for_each_rsnd_cmd(cmd, priv, i) {
177		int ret = rsnd_mod_init(priv, rsnd_mod_get(cmd),
178					&rsnd_cmd_ops, NULL,
179					RSND_MOD_CMD, i);
180		if (ret)
181			return ret;
182	}
183
184	return 0;
185}
186
187void rsnd_cmd_remove(struct rsnd_priv *priv)
188{
189	struct rsnd_cmd *cmd;
190	int i;
191
192	for_each_rsnd_cmd(cmd, priv, i) {
193		rsnd_mod_quit(rsnd_mod_get(cmd));
194	}
195}
196