1 /*
2 * Renesas R-Car DVC support
3 *
4 * Copyright (C) 2014 Renesas Solutions Corp.
5 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
6 *
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.
10 */
11 #include "rsnd.h"
12
13 #define RSND_DVC_NAME_SIZE 16
14 #define RSND_DVC_VOLUME_MAX 100
15 #define RSND_DVC_VOLUME_NUM 2
16
17 #define DVC_NAME "dvc"
18
19 struct rsnd_dvc {
20 struct rsnd_dvc_platform_info *info; /* rcar_snd.h */
21 struct rsnd_mod mod;
22 struct clk *clk;
23 u8 volume[RSND_DVC_VOLUME_NUM];
24 u8 mute[RSND_DVC_VOLUME_NUM];
25 };
26
27 #define rsnd_mod_to_dvc(_mod) \
28 container_of((_mod), struct rsnd_dvc, mod)
29
30 #define for_each_rsnd_dvc(pos, priv, i) \
31 for ((i) = 0; \
32 ((i) < rsnd_dvc_nr(priv)) && \
33 ((pos) = (struct rsnd_dvc *)(priv)->dvc + i); \
34 i++)
35
rsnd_dvc_volume_update(struct rsnd_mod * mod)36 static void rsnd_dvc_volume_update(struct rsnd_mod *mod)
37 {
38 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod);
39 u32 max = (0x00800000 - 1);
40 u32 vol[RSND_DVC_VOLUME_NUM];
41 u32 mute = 0;
42 int i;
43
44 for (i = 0; i < RSND_DVC_VOLUME_NUM; i++) {
45 vol[i] = max / RSND_DVC_VOLUME_MAX * dvc->volume[i];
46 mute |= (!!dvc->mute[i]) << i;
47 }
48
49 rsnd_mod_write(mod, DVC_VOL0R, vol[0]);
50 rsnd_mod_write(mod, DVC_VOL1R, vol[1]);
51
52 rsnd_mod_write(mod, DVC_ZCMCR, mute);
53 }
54
rsnd_dvc_probe_gen2(struct rsnd_mod * mod,struct rsnd_dai * rdai)55 static int rsnd_dvc_probe_gen2(struct rsnd_mod *mod,
56 struct rsnd_dai *rdai)
57 {
58 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
59 struct device *dev = rsnd_priv_to_dev(priv);
60
61 dev_dbg(dev, "%s (Gen2) is probed\n", rsnd_mod_name(mod));
62
63 return 0;
64 }
65
rsnd_dvc_init(struct rsnd_mod * dvc_mod,struct rsnd_dai * rdai)66 static int rsnd_dvc_init(struct rsnd_mod *dvc_mod,
67 struct rsnd_dai *rdai)
68 {
69 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(dvc_mod);
70 struct rsnd_dai_stream *io = rsnd_mod_to_io(dvc_mod);
71 struct rsnd_priv *priv = rsnd_mod_to_priv(dvc_mod);
72 struct rsnd_mod *src_mod = rsnd_io_to_mod_src(io);
73 struct device *dev = rsnd_priv_to_dev(priv);
74 int dvc_id = rsnd_mod_id(dvc_mod);
75 int src_id = rsnd_mod_id(src_mod);
76 u32 route[] = {
77 [0] = 0x30000,
78 [1] = 0x30001,
79 [2] = 0x40000,
80 [3] = 0x10000,
81 [4] = 0x20000,
82 [5] = 0x40100
83 };
84
85 if (src_id >= ARRAY_SIZE(route)) {
86 dev_err(dev, "DVC%d isn't connected to SRC%d\n", dvc_id, src_id);
87 return -EINVAL;
88 }
89
90 clk_prepare_enable(dvc->clk);
91
92 /*
93 * fixme
94 * it doesn't support CTU/MIX
95 */
96 rsnd_mod_write(dvc_mod, CMD_ROUTE_SLCT, route[src_id]);
97
98 rsnd_mod_write(dvc_mod, DVC_SWRSR, 0);
99 rsnd_mod_write(dvc_mod, DVC_SWRSR, 1);
100
101 rsnd_mod_write(dvc_mod, DVC_DVUIR, 1);
102
103 rsnd_mod_write(dvc_mod, DVC_ADINR, rsnd_get_adinr(dvc_mod));
104
105 /* enable Volume / Mute */
106 rsnd_mod_write(dvc_mod, DVC_DVUCR, 0x101);
107
108 /* ch0/ch1 Volume */
109 rsnd_dvc_volume_update(dvc_mod);
110
111 rsnd_mod_write(dvc_mod, DVC_DVUIR, 0);
112
113 rsnd_mod_write(dvc_mod, DVC_DVUER, 1);
114
115 rsnd_adg_set_cmd_timsel_gen2(rdai, dvc_mod, io);
116
117 return 0;
118 }
119
rsnd_dvc_quit(struct rsnd_mod * mod,struct rsnd_dai * rdai)120 static int rsnd_dvc_quit(struct rsnd_mod *mod,
121 struct rsnd_dai *rdai)
122 {
123 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod);
124
125 clk_disable_unprepare(dvc->clk);
126
127 return 0;
128 }
129
rsnd_dvc_start(struct rsnd_mod * mod,struct rsnd_dai * rdai)130 static int rsnd_dvc_start(struct rsnd_mod *mod,
131 struct rsnd_dai *rdai)
132 {
133 rsnd_mod_write(mod, CMD_CTRL, 0x10);
134
135 return 0;
136 }
137
rsnd_dvc_stop(struct rsnd_mod * mod,struct rsnd_dai * rdai)138 static int rsnd_dvc_stop(struct rsnd_mod *mod,
139 struct rsnd_dai *rdai)
140 {
141 rsnd_mod_write(mod, CMD_CTRL, 0);
142
143 return 0;
144 }
145
rsnd_dvc_volume_info(struct snd_kcontrol * kctrl,struct snd_ctl_elem_info * uinfo)146 static int rsnd_dvc_volume_info(struct snd_kcontrol *kctrl,
147 struct snd_ctl_elem_info *uinfo)
148 {
149 struct rsnd_mod *mod = snd_kcontrol_chip(kctrl);
150 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod);
151 u8 *val = (u8 *)kctrl->private_value;
152
153 uinfo->count = RSND_DVC_VOLUME_NUM;
154 uinfo->value.integer.min = 0;
155
156 if (val == dvc->volume) {
157 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
158 uinfo->value.integer.max = RSND_DVC_VOLUME_MAX;
159 } else {
160 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
161 uinfo->value.integer.max = 1;
162 }
163
164 return 0;
165 }
166
rsnd_dvc_volume_get(struct snd_kcontrol * kctrl,struct snd_ctl_elem_value * ucontrol)167 static int rsnd_dvc_volume_get(struct snd_kcontrol *kctrl,
168 struct snd_ctl_elem_value *ucontrol)
169 {
170 u8 *val = (u8 *)kctrl->private_value;
171 int i;
172
173 for (i = 0; i < RSND_DVC_VOLUME_NUM; i++)
174 ucontrol->value.integer.value[i] = val[i];
175
176 return 0;
177 }
178
rsnd_dvc_volume_put(struct snd_kcontrol * kctrl,struct snd_ctl_elem_value * ucontrol)179 static int rsnd_dvc_volume_put(struct snd_kcontrol *kctrl,
180 struct snd_ctl_elem_value *ucontrol)
181 {
182 struct rsnd_mod *mod = snd_kcontrol_chip(kctrl);
183 u8 *val = (u8 *)kctrl->private_value;
184 int i, change = 0;
185
186 for (i = 0; i < RSND_DVC_VOLUME_NUM; i++) {
187 change |= (ucontrol->value.integer.value[i] != val[i]);
188 val[i] = ucontrol->value.integer.value[i];
189 }
190
191 if (change)
192 rsnd_dvc_volume_update(mod);
193
194 return change;
195 }
196
__rsnd_dvc_pcm_new(struct rsnd_mod * mod,struct rsnd_dai * rdai,struct snd_soc_pcm_runtime * rtd,const unsigned char * name,u8 * private)197 static int __rsnd_dvc_pcm_new(struct rsnd_mod *mod,
198 struct rsnd_dai *rdai,
199 struct snd_soc_pcm_runtime *rtd,
200 const unsigned char *name,
201 u8 *private)
202 {
203 struct snd_card *card = rtd->card->snd_card;
204 struct snd_kcontrol *kctrl;
205 struct snd_kcontrol_new knew = {
206 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
207 .name = name,
208 .info = rsnd_dvc_volume_info,
209 .get = rsnd_dvc_volume_get,
210 .put = rsnd_dvc_volume_put,
211 .private_value = (unsigned long)private,
212 };
213 int ret;
214
215 kctrl = snd_ctl_new1(&knew, mod);
216 if (!kctrl)
217 return -ENOMEM;
218
219 ret = snd_ctl_add(card, kctrl);
220 if (ret < 0)
221 return ret;
222
223 return 0;
224 }
225
rsnd_dvc_pcm_new(struct rsnd_mod * mod,struct rsnd_dai * rdai,struct snd_soc_pcm_runtime * rtd)226 static int rsnd_dvc_pcm_new(struct rsnd_mod *mod,
227 struct rsnd_dai *rdai,
228 struct snd_soc_pcm_runtime *rtd)
229 {
230 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
231 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod);
232 int ret;
233
234 /* Volume */
235 ret = __rsnd_dvc_pcm_new(mod, rdai, rtd,
236 rsnd_dai_is_play(rdai, io) ?
237 "DVC Out Playback Volume" : "DVC In Capture Volume",
238 dvc->volume);
239 if (ret < 0)
240 return ret;
241
242 /* Mute */
243 ret = __rsnd_dvc_pcm_new(mod, rdai, rtd,
244 rsnd_dai_is_play(rdai, io) ?
245 "DVC Out Mute Switch" : "DVC In Mute Switch",
246 dvc->mute);
247 if (ret < 0)
248 return ret;
249
250 return 0;
251 }
252
253 static struct rsnd_mod_ops rsnd_dvc_ops = {
254 .name = DVC_NAME,
255 .probe = rsnd_dvc_probe_gen2,
256 .init = rsnd_dvc_init,
257 .quit = rsnd_dvc_quit,
258 .start = rsnd_dvc_start,
259 .stop = rsnd_dvc_stop,
260 .pcm_new = rsnd_dvc_pcm_new,
261 };
262
rsnd_dvc_mod_get(struct rsnd_priv * priv,int id)263 struct rsnd_mod *rsnd_dvc_mod_get(struct rsnd_priv *priv, int id)
264 {
265 if (WARN_ON(id < 0 || id >= rsnd_dvc_nr(priv)))
266 id = 0;
267
268 return &((struct rsnd_dvc *)(priv->dvc) + id)->mod;
269 }
270
rsnd_of_parse_dvc(struct platform_device * pdev,const struct rsnd_of_data * of_data,struct rsnd_priv * priv)271 static void rsnd_of_parse_dvc(struct platform_device *pdev,
272 const struct rsnd_of_data *of_data,
273 struct rsnd_priv *priv)
274 {
275 struct device_node *node;
276 struct rsnd_dvc_platform_info *dvc_info;
277 struct rcar_snd_info *info = rsnd_priv_to_info(priv);
278 struct device *dev = &pdev->dev;
279 int nr;
280
281 if (!of_data)
282 return;
283
284 node = of_get_child_by_name(dev->of_node, "rcar_sound,dvc");
285 if (!node)
286 return;
287
288 nr = of_get_child_count(node);
289 if (!nr)
290 goto rsnd_of_parse_dvc_end;
291
292 dvc_info = devm_kzalloc(dev,
293 sizeof(struct rsnd_dvc_platform_info) * nr,
294 GFP_KERNEL);
295 if (!dvc_info) {
296 dev_err(dev, "dvc info allocation error\n");
297 goto rsnd_of_parse_dvc_end;
298 }
299
300 info->dvc_info = dvc_info;
301 info->dvc_info_nr = nr;
302
303 rsnd_of_parse_dvc_end:
304 of_node_put(node);
305 }
306
rsnd_dvc_probe(struct platform_device * pdev,const struct rsnd_of_data * of_data,struct rsnd_priv * priv)307 int rsnd_dvc_probe(struct platform_device *pdev,
308 const struct rsnd_of_data *of_data,
309 struct rsnd_priv *priv)
310 {
311 struct rcar_snd_info *info = rsnd_priv_to_info(priv);
312 struct device *dev = rsnd_priv_to_dev(priv);
313 struct rsnd_dvc *dvc;
314 struct clk *clk;
315 char name[RSND_DVC_NAME_SIZE];
316 int i, nr;
317
318 rsnd_of_parse_dvc(pdev, of_data, priv);
319
320 nr = info->dvc_info_nr;
321 if (!nr)
322 return 0;
323
324 /* This driver doesn't support Gen1 at this point */
325 if (rsnd_is_gen1(priv)) {
326 dev_warn(dev, "CMD is not supported on Gen1\n");
327 return -EINVAL;
328 }
329
330 dvc = devm_kzalloc(dev, sizeof(*dvc) * nr, GFP_KERNEL);
331 if (!dvc) {
332 dev_err(dev, "CMD allocate failed\n");
333 return -ENOMEM;
334 }
335
336 priv->dvc_nr = nr;
337 priv->dvc = dvc;
338
339 for_each_rsnd_dvc(dvc, priv, i) {
340 snprintf(name, RSND_DVC_NAME_SIZE, "%s.%d",
341 DVC_NAME, i);
342
343 clk = devm_clk_get(dev, name);
344 if (IS_ERR(clk))
345 return PTR_ERR(clk);
346
347 dvc->info = &info->dvc_info[i];
348 dvc->clk = clk;
349
350 rsnd_mod_init(priv, &dvc->mod, &rsnd_dvc_ops, RSND_MOD_DVC, i);
351
352 dev_dbg(dev, "CMD%d probed\n", i);
353 }
354
355 return 0;
356 }
357