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
12 /*
13 * Playback Volume
14 * amixer set "DVC Out" 100%
15 *
16 * Capture Volume
17 * amixer set "DVC In" 100%
18 *
19 * Playback Mute
20 * amixer set "DVC Out Mute" on
21 *
22 * Capture Mute
23 * amixer set "DVC In Mute" on
24 *
25 * Volume Ramp
26 * amixer set "DVC Out Ramp Up Rate" "0.125 dB/64 steps"
27 * amixer set "DVC Out Ramp Down Rate" "0.125 dB/512 steps"
28 * amixer set "DVC Out Ramp" on
29 * aplay xxx.wav &
30 * amixer set "DVC Out" 80% // Volume Down
31 * amixer set "DVC Out" 100% // Volume Up
32 */
33
34 #include "rsnd.h"
35
36 #define RSND_DVC_NAME_SIZE 16
37
38 #define DVC_NAME "dvc"
39
40 struct rsnd_dvc {
41 struct rsnd_mod mod;
42 struct rsnd_kctrl_cfg_m volume;
43 struct rsnd_kctrl_cfg_m mute;
44 struct rsnd_kctrl_cfg_s ren; /* Ramp Enable */
45 struct rsnd_kctrl_cfg_s rup; /* Ramp Rate Up */
46 struct rsnd_kctrl_cfg_s rdown; /* Ramp Rate Down */
47 };
48
49 #define rsnd_dvc_get(priv, id) ((struct rsnd_dvc *)(priv->dvc) + id)
50 #define rsnd_dvc_nr(priv) ((priv)->dvc_nr)
51
52 #define rsnd_mod_to_dvc(_mod) \
53 container_of((_mod), struct rsnd_dvc, mod)
54
55 #define for_each_rsnd_dvc(pos, priv, i) \
56 for ((i) = 0; \
57 ((i) < rsnd_dvc_nr(priv)) && \
58 ((pos) = (struct rsnd_dvc *)(priv)->dvc + i); \
59 i++)
60
61 static const char * const dvc_ramp_rate[] = {
62 "128 dB/1 step", /* 00000 */
63 "64 dB/1 step", /* 00001 */
64 "32 dB/1 step", /* 00010 */
65 "16 dB/1 step", /* 00011 */
66 "8 dB/1 step", /* 00100 */
67 "4 dB/1 step", /* 00101 */
68 "2 dB/1 step", /* 00110 */
69 "1 dB/1 step", /* 00111 */
70 "0.5 dB/1 step", /* 01000 */
71 "0.25 dB/1 step", /* 01001 */
72 "0.125 dB/1 step", /* 01010 */
73 "0.125 dB/2 steps", /* 01011 */
74 "0.125 dB/4 steps", /* 01100 */
75 "0.125 dB/8 steps", /* 01101 */
76 "0.125 dB/16 steps", /* 01110 */
77 "0.125 dB/32 steps", /* 01111 */
78 "0.125 dB/64 steps", /* 10000 */
79 "0.125 dB/128 steps", /* 10001 */
80 "0.125 dB/256 steps", /* 10010 */
81 "0.125 dB/512 steps", /* 10011 */
82 "0.125 dB/1024 steps", /* 10100 */
83 "0.125 dB/2048 steps", /* 10101 */
84 "0.125 dB/4096 steps", /* 10110 */
85 "0.125 dB/8192 steps", /* 10111 */
86 };
87
rsnd_dvc_activation(struct rsnd_mod * mod)88 static void rsnd_dvc_activation(struct rsnd_mod *mod)
89 {
90 rsnd_mod_write(mod, DVC_SWRSR, 0);
91 rsnd_mod_write(mod, DVC_SWRSR, 1);
92 }
93
rsnd_dvc_halt(struct rsnd_mod * mod)94 static void rsnd_dvc_halt(struct rsnd_mod *mod)
95 {
96 rsnd_mod_write(mod, DVC_DVUIR, 1);
97 rsnd_mod_write(mod, DVC_SWRSR, 0);
98 }
99
100 #define rsnd_dvc_get_vrpdr(dvc) (dvc->rup.val << 8 | dvc->rdown.val)
101 #define rsnd_dvc_get_vrdbr(dvc) (0x3ff - (dvc->volume.val[0] >> 13))
102
rsnd_dvc_volume_parameter(struct rsnd_dai_stream * io,struct rsnd_mod * mod)103 static void rsnd_dvc_volume_parameter(struct rsnd_dai_stream *io,
104 struct rsnd_mod *mod)
105 {
106 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod);
107 u32 val[RSND_MAX_CHANNELS];
108 int i;
109
110 /* Enable Ramp */
111 if (dvc->ren.val)
112 for (i = 0; i < RSND_MAX_CHANNELS; i++)
113 val[i] = dvc->volume.cfg.max;
114 else
115 for (i = 0; i < RSND_MAX_CHANNELS; i++)
116 val[i] = dvc->volume.val[i];
117
118 /* Enable Digital Volume */
119 rsnd_mod_write(mod, DVC_VOL0R, val[0]);
120 rsnd_mod_write(mod, DVC_VOL1R, val[1]);
121 rsnd_mod_write(mod, DVC_VOL2R, val[2]);
122 rsnd_mod_write(mod, DVC_VOL3R, val[3]);
123 rsnd_mod_write(mod, DVC_VOL4R, val[4]);
124 rsnd_mod_write(mod, DVC_VOL5R, val[5]);
125 rsnd_mod_write(mod, DVC_VOL6R, val[6]);
126 rsnd_mod_write(mod, DVC_VOL7R, val[7]);
127 }
128
rsnd_dvc_volume_init(struct rsnd_dai_stream * io,struct rsnd_mod * mod)129 static void rsnd_dvc_volume_init(struct rsnd_dai_stream *io,
130 struct rsnd_mod *mod)
131 {
132 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod);
133 u32 adinr = 0;
134 u32 dvucr = 0;
135 u32 vrctr = 0;
136 u32 vrpdr = 0;
137 u32 vrdbr = 0;
138
139 adinr = rsnd_get_adinr_bit(mod, io) |
140 rsnd_runtime_channel_after_ctu(io);
141
142 /* Enable Digital Volume, Zero Cross Mute Mode */
143 dvucr |= 0x101;
144
145 /* Enable Ramp */
146 if (dvc->ren.val) {
147 dvucr |= 0x10;
148
149 /*
150 * FIXME !!
151 * use scale-downed Digital Volume
152 * as Volume Ramp
153 * 7F FFFF -> 3FF
154 */
155 vrctr = 0xff;
156 vrpdr = rsnd_dvc_get_vrpdr(dvc);
157 vrdbr = rsnd_dvc_get_vrdbr(dvc);
158 }
159
160 /* Initialize operation */
161 rsnd_mod_write(mod, DVC_DVUIR, 1);
162
163 /* General Information */
164 rsnd_mod_write(mod, DVC_ADINR, adinr);
165 rsnd_mod_write(mod, DVC_DVUCR, dvucr);
166
167 /* Volume Ramp Parameter */
168 rsnd_mod_write(mod, DVC_VRCTR, vrctr);
169 rsnd_mod_write(mod, DVC_VRPDR, vrpdr);
170 rsnd_mod_write(mod, DVC_VRDBR, vrdbr);
171
172 /* Digital Volume Function Parameter */
173 rsnd_dvc_volume_parameter(io, mod);
174
175 /* cancel operation */
176 rsnd_mod_write(mod, DVC_DVUIR, 0);
177 }
178
rsnd_dvc_volume_update(struct rsnd_dai_stream * io,struct rsnd_mod * mod)179 static void rsnd_dvc_volume_update(struct rsnd_dai_stream *io,
180 struct rsnd_mod *mod)
181 {
182 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod);
183 u32 zcmcr = 0;
184 u32 vrpdr = 0;
185 u32 vrdbr = 0;
186 int i;
187
188 for (i = 0; i < dvc->mute.cfg.size; i++)
189 zcmcr |= (!!dvc->mute.cfg.val[i]) << i;
190
191 if (dvc->ren.val) {
192 vrpdr = rsnd_dvc_get_vrpdr(dvc);
193 vrdbr = rsnd_dvc_get_vrdbr(dvc);
194 }
195
196 /* Disable DVC Register access */
197 rsnd_mod_write(mod, DVC_DVUER, 0);
198
199 /* Zero Cross Mute Function */
200 rsnd_mod_write(mod, DVC_ZCMCR, zcmcr);
201
202 /* Volume Ramp Function */
203 rsnd_mod_write(mod, DVC_VRPDR, vrpdr);
204 rsnd_mod_write(mod, DVC_VRDBR, vrdbr);
205 /* add DVC_VRWTR here */
206
207 /* Digital Volume Function Parameter */
208 rsnd_dvc_volume_parameter(io, mod);
209
210 /* Enable DVC Register access */
211 rsnd_mod_write(mod, DVC_DVUER, 1);
212 }
213
rsnd_dvc_probe_(struct rsnd_mod * mod,struct rsnd_dai_stream * io,struct rsnd_priv * priv)214 static int rsnd_dvc_probe_(struct rsnd_mod *mod,
215 struct rsnd_dai_stream *io,
216 struct rsnd_priv *priv)
217 {
218 return rsnd_cmd_attach(io, rsnd_mod_id(mod));
219 }
220
rsnd_dvc_init(struct rsnd_mod * mod,struct rsnd_dai_stream * io,struct rsnd_priv * priv)221 static int rsnd_dvc_init(struct rsnd_mod *mod,
222 struct rsnd_dai_stream *io,
223 struct rsnd_priv *priv)
224 {
225 rsnd_mod_power_on(mod);
226
227 rsnd_dvc_activation(mod);
228
229 rsnd_dvc_volume_init(io, mod);
230
231 rsnd_dvc_volume_update(io, mod);
232
233 return 0;
234 }
235
rsnd_dvc_quit(struct rsnd_mod * mod,struct rsnd_dai_stream * io,struct rsnd_priv * priv)236 static int rsnd_dvc_quit(struct rsnd_mod *mod,
237 struct rsnd_dai_stream *io,
238 struct rsnd_priv *priv)
239 {
240 rsnd_dvc_halt(mod);
241
242 rsnd_mod_power_off(mod);
243
244 return 0;
245 }
246
rsnd_dvc_pcm_new(struct rsnd_mod * mod,struct rsnd_dai_stream * io,struct snd_soc_pcm_runtime * rtd)247 static int rsnd_dvc_pcm_new(struct rsnd_mod *mod,
248 struct rsnd_dai_stream *io,
249 struct snd_soc_pcm_runtime *rtd)
250 {
251 struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod);
252 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
253 int is_play = rsnd_io_is_play(io);
254 int channels = rsnd_rdai_channels_get(rdai);
255 int ret;
256
257 /* Volume */
258 ret = rsnd_kctrl_new_m(mod, io, rtd,
259 is_play ?
260 "DVC Out Playback Volume" : "DVC In Capture Volume",
261 rsnd_kctrl_accept_anytime,
262 rsnd_dvc_volume_update,
263 &dvc->volume, channels,
264 0x00800000 - 1);
265 if (ret < 0)
266 return ret;
267
268 /* Mute */
269 ret = rsnd_kctrl_new_m(mod, io, rtd,
270 is_play ?
271 "DVC Out Mute Switch" : "DVC In Mute Switch",
272 rsnd_kctrl_accept_anytime,
273 rsnd_dvc_volume_update,
274 &dvc->mute, channels,
275 1);
276 if (ret < 0)
277 return ret;
278
279 /* Ramp */
280 ret = rsnd_kctrl_new_s(mod, io, rtd,
281 is_play ?
282 "DVC Out Ramp Switch" : "DVC In Ramp Switch",
283 rsnd_kctrl_accept_anytime,
284 rsnd_dvc_volume_update,
285 &dvc->ren, 1);
286 if (ret < 0)
287 return ret;
288
289 ret = rsnd_kctrl_new_e(mod, io, rtd,
290 is_play ?
291 "DVC Out Ramp Up Rate" : "DVC In Ramp Up Rate",
292 rsnd_kctrl_accept_anytime,
293 rsnd_dvc_volume_update,
294 &dvc->rup,
295 dvc_ramp_rate);
296 if (ret < 0)
297 return ret;
298
299 ret = rsnd_kctrl_new_e(mod, io, rtd,
300 is_play ?
301 "DVC Out Ramp Down Rate" : "DVC In Ramp Down Rate",
302 rsnd_kctrl_accept_anytime,
303 rsnd_dvc_volume_update,
304 &dvc->rdown,
305 dvc_ramp_rate);
306
307 if (ret < 0)
308 return ret;
309
310 return 0;
311 }
312
rsnd_dvc_dma_req(struct rsnd_dai_stream * io,struct rsnd_mod * mod)313 static struct dma_chan *rsnd_dvc_dma_req(struct rsnd_dai_stream *io,
314 struct rsnd_mod *mod)
315 {
316 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
317
318 return rsnd_dma_request_channel(rsnd_dvc_of_node(priv),
319 mod, "tx");
320 }
321
322 static struct rsnd_mod_ops rsnd_dvc_ops = {
323 .name = DVC_NAME,
324 .dma_req = rsnd_dvc_dma_req,
325 .probe = rsnd_dvc_probe_,
326 .init = rsnd_dvc_init,
327 .quit = rsnd_dvc_quit,
328 .pcm_new = rsnd_dvc_pcm_new,
329 };
330
rsnd_dvc_mod_get(struct rsnd_priv * priv,int id)331 struct rsnd_mod *rsnd_dvc_mod_get(struct rsnd_priv *priv, int id)
332 {
333 if (WARN_ON(id < 0 || id >= rsnd_dvc_nr(priv)))
334 id = 0;
335
336 return rsnd_mod_get(rsnd_dvc_get(priv, id));
337 }
338
rsnd_dvc_probe(struct rsnd_priv * priv)339 int rsnd_dvc_probe(struct rsnd_priv *priv)
340 {
341 struct device_node *node;
342 struct device_node *np;
343 struct device *dev = rsnd_priv_to_dev(priv);
344 struct rsnd_dvc *dvc;
345 struct clk *clk;
346 char name[RSND_DVC_NAME_SIZE];
347 int i, nr, ret;
348
349 /* This driver doesn't support Gen1 at this point */
350 if (rsnd_is_gen1(priv))
351 return 0;
352
353 node = rsnd_dvc_of_node(priv);
354 if (!node)
355 return 0; /* not used is not error */
356
357 nr = of_get_child_count(node);
358 if (!nr) {
359 ret = -EINVAL;
360 goto rsnd_dvc_probe_done;
361 }
362
363 dvc = devm_kzalloc(dev, sizeof(*dvc) * nr, GFP_KERNEL);
364 if (!dvc) {
365 ret = -ENOMEM;
366 goto rsnd_dvc_probe_done;
367 }
368
369 priv->dvc_nr = nr;
370 priv->dvc = dvc;
371
372 i = 0;
373 ret = 0;
374 for_each_child_of_node(node, np) {
375 dvc = rsnd_dvc_get(priv, i);
376
377 snprintf(name, RSND_DVC_NAME_SIZE, "%s.%d",
378 DVC_NAME, i);
379
380 clk = devm_clk_get(dev, name);
381 if (IS_ERR(clk)) {
382 ret = PTR_ERR(clk);
383 of_node_put(np);
384 goto rsnd_dvc_probe_done;
385 }
386
387 ret = rsnd_mod_init(priv, rsnd_mod_get(dvc), &rsnd_dvc_ops,
388 clk, rsnd_mod_get_status, RSND_MOD_DVC, i);
389 if (ret) {
390 of_node_put(np);
391 goto rsnd_dvc_probe_done;
392 }
393
394 i++;
395 }
396
397 rsnd_dvc_probe_done:
398 of_node_put(node);
399
400 return ret;
401 }
402
rsnd_dvc_remove(struct rsnd_priv * priv)403 void rsnd_dvc_remove(struct rsnd_priv *priv)
404 {
405 struct rsnd_dvc *dvc;
406 int i;
407
408 for_each_rsnd_dvc(dvc, priv, i) {
409 rsnd_mod_quit(rsnd_mod_get(dvc));
410 }
411 }
412