~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/sound/soc/sh/rcar/dvc.c

Version: ~ [ linux-5.6-rc1 ] ~ [ linux-5.5.2 ] ~ [ linux-5.4.17 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.102 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.170 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.213 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.213 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.19.8 ] ~ [ linux-3.18.140 ] ~ [ linux-3.17.8 ] ~ [ linux-3.16.81 ] ~ [ linux-3.15.10 ] ~ [ linux-3.14.79 ] ~ [ linux-3.13.11 ] ~ [ linux-3.12.74 ] ~ [ linux-3.11.10 ] ~ [ linux-3.10.108 ] ~ [ linux-3.9.11 ] ~ [ linux-3.8.13 ] ~ [ linux-3.7.10 ] ~ [ linux-3.6.11 ] ~ [ linux-3.5.7 ] ~ [ linux-3.4.113 ] ~ [ linux-3.3.8 ] ~ [ linux-3.2.102 ] ~ [ linux-3.1.10 ] ~ [ linux-3.0.101 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  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 
 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 
 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 
 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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 
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 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp