Version:  2.0.40 2.2.26 2.4.37 3.11 3.12 3.13 3.14 3.15 3.16 3.17 3.18 3.19 4.0 4.1 4.2 4.3 4.4 4.5 4.6 4.7 4.8

Linux/sound/soc/sh/rcar/core.c

  1 /*
  2  * Renesas R-Car SRU/SCU/SSIU/SSI support
  3  *
  4  * Copyright (C) 2013 Renesas Solutions Corp.
  5  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
  6  *
  7  * Based on fsi.c
  8  * Kuninori Morimoto <morimoto.kuninori@renesas.com>
  9  *
 10  * This program is free software; you can redistribute it and/or modify
 11  * it under the terms of the GNU General Public License version 2 as
 12  * published by the Free Software Foundation.
 13  */
 14 
 15 /*
 16  * Renesas R-Car sound device structure
 17  *
 18  * Gen1
 19  *
 20  * SRU          : Sound Routing Unit
 21  *  - SRC       : Sampling Rate Converter
 22  *  - CMD
 23  *    - CTU     : Channel Count Conversion Unit
 24  *    - MIX     : Mixer
 25  *    - DVC     : Digital Volume and Mute Function
 26  *  - SSI       : Serial Sound Interface
 27  *
 28  * Gen2
 29  *
 30  * SCU          : Sampling Rate Converter Unit
 31  *  - SRC       : Sampling Rate Converter
 32  *  - CMD
 33  *   - CTU      : Channel Count Conversion Unit
 34  *   - MIX      : Mixer
 35  *   - DVC      : Digital Volume and Mute Function
 36  * SSIU         : Serial Sound Interface Unit
 37  *  - SSI       : Serial Sound Interface
 38  */
 39 
 40 /*
 41  *      driver data Image
 42  *
 43  * rsnd_priv
 44  *   |
 45  *   | ** this depends on Gen1/Gen2
 46  *   |
 47  *   +- gen
 48  *   |
 49  *   | ** these depend on data path
 50  *   | ** gen and platform data control it
 51  *   |
 52  *   +- rdai[0]
 53  *   |   |               sru     ssiu      ssi
 54  *   |   +- playback -> [mod] -> [mod] -> [mod] -> ...
 55  *   |   |
 56  *   |   |               sru     ssiu      ssi
 57  *   |   +- capture  -> [mod] -> [mod] -> [mod] -> ...
 58  *   |
 59  *   +- rdai[1]
 60  *   |   |               sru     ssiu      ssi
 61  *   |   +- playback -> [mod] -> [mod] -> [mod] -> ...
 62  *   |   |
 63  *   |   |               sru     ssiu      ssi
 64  *   |   +- capture  -> [mod] -> [mod] -> [mod] -> ...
 65  *   ...
 66  *   |
 67  *   | ** these control ssi
 68  *   |
 69  *   +- ssi
 70  *   |  |
 71  *   |  +- ssi[0]
 72  *   |  +- ssi[1]
 73  *   |  +- ssi[2]
 74  *   |  ...
 75  *   |
 76  *   | ** these control src
 77  *   |
 78  *   +- src
 79  *      |
 80  *      +- src[0]
 81  *      +- src[1]
 82  *      +- src[2]
 83  *      ...
 84  *
 85  *
 86  * for_each_rsnd_dai(xx, priv, xx)
 87  *  rdai[0] => rdai[1] => rdai[2] => ...
 88  *
 89  * for_each_rsnd_mod(xx, rdai, xx)
 90  *  [mod] => [mod] => [mod] => ...
 91  *
 92  * rsnd_dai_call(xxx, fn )
 93  *  [mod]->fn() -> [mod]->fn() -> [mod]->fn()...
 94  *
 95  */
 96 #include <linux/pm_runtime.h>
 97 #include "rsnd.h"
 98 
 99 #define RSND_RATES SNDRV_PCM_RATE_8000_96000
100 #define RSND_FMTS (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE)
101 
102 static const struct of_device_id rsnd_of_match[] = {
103         { .compatible = "renesas,rcar_sound-gen1", .data = (void *)RSND_GEN1 },
104         { .compatible = "renesas,rcar_sound-gen2", .data = (void *)RSND_GEN2 },
105         { .compatible = "renesas,rcar_sound-gen3", .data = (void *)RSND_GEN2 }, /* gen2 compatible */
106         {},
107 };
108 MODULE_DEVICE_TABLE(of, rsnd_of_match);
109 
110 /*
111  *      rsnd_mod functions
112  */
113 void rsnd_mod_make_sure(struct rsnd_mod *mod, enum rsnd_mod_type type)
114 {
115         if (mod->type != type) {
116                 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
117                 struct device *dev = rsnd_priv_to_dev(priv);
118 
119                 dev_warn(dev, "%s[%d] is not your expected module\n",
120                          rsnd_mod_name(mod), rsnd_mod_id(mod));
121         }
122 }
123 
124 char *rsnd_mod_name(struct rsnd_mod *mod)
125 {
126         if (!mod || !mod->ops)
127                 return "unknown";
128 
129         return mod->ops->name;
130 }
131 
132 struct dma_chan *rsnd_mod_dma_req(struct rsnd_dai_stream *io,
133                                   struct rsnd_mod *mod)
134 {
135         if (!mod || !mod->ops || !mod->ops->dma_req)
136                 return NULL;
137 
138         return mod->ops->dma_req(io, mod);
139 }
140 
141 u32 *rsnd_mod_get_status(struct rsnd_dai_stream *io,
142                          struct rsnd_mod *mod,
143                          enum rsnd_mod_type type)
144 {
145         return &mod->status;
146 }
147 
148 int rsnd_mod_init(struct rsnd_priv *priv,
149                   struct rsnd_mod *mod,
150                   struct rsnd_mod_ops *ops,
151                   struct clk *clk,
152                   u32* (*get_status)(struct rsnd_dai_stream *io,
153                                      struct rsnd_mod *mod,
154                                      enum rsnd_mod_type type),
155                   enum rsnd_mod_type type,
156                   int id)
157 {
158         int ret = clk_prepare(clk);
159 
160         if (ret)
161                 return ret;
162 
163         mod->id         = id;
164         mod->ops        = ops;
165         mod->type       = type;
166         mod->clk        = clk;
167         mod->priv       = priv;
168         mod->get_status = get_status;
169 
170         return ret;
171 }
172 
173 void rsnd_mod_quit(struct rsnd_mod *mod)
174 {
175         if (mod->clk)
176                 clk_unprepare(mod->clk);
177         mod->clk = NULL;
178 }
179 
180 void rsnd_mod_interrupt(struct rsnd_mod *mod,
181                         void (*callback)(struct rsnd_mod *mod,
182                                          struct rsnd_dai_stream *io))
183 {
184         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
185         struct rsnd_dai_stream *io;
186         struct rsnd_dai *rdai;
187         int i;
188 
189         for_each_rsnd_dai(rdai, priv, i) {
190                 io = &rdai->playback;
191                 if (mod == io->mod[mod->type])
192                         callback(mod, io);
193 
194                 io = &rdai->capture;
195                 if (mod == io->mod[mod->type])
196                         callback(mod, io);
197         }
198 }
199 
200 int rsnd_io_is_working(struct rsnd_dai_stream *io)
201 {
202         /* see rsnd_dai_stream_init/quit() */
203         return !!io->substream;
204 }
205 
206 void rsnd_set_slot(struct rsnd_dai *rdai,
207                    int slots, int num)
208 {
209         rdai->slots     = slots;
210         rdai->slots_num = num;
211 }
212 
213 int rsnd_get_slot(struct rsnd_dai_stream *io)
214 {
215         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
216 
217         return rdai->slots;
218 }
219 
220 int rsnd_get_slot_num(struct rsnd_dai_stream *io)
221 {
222         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
223 
224         return rdai->slots_num;
225 }
226 
227 int rsnd_runtime_channel_original(struct rsnd_dai_stream *io)
228 {
229         struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
230 
231         return runtime->channels;
232 }
233 
234 int rsnd_runtime_channel_after_ctu(struct rsnd_dai_stream *io)
235 {
236         int chan = rsnd_runtime_channel_original(io);
237         struct rsnd_mod *ctu_mod = rsnd_io_to_mod_ctu(io);
238 
239         if (ctu_mod) {
240                 u32 converted_chan = rsnd_ctu_converted_channel(ctu_mod);
241 
242                 if (converted_chan)
243                         return converted_chan;
244         }
245 
246         return chan;
247 }
248 
249 int rsnd_runtime_channel_for_ssi(struct rsnd_dai_stream *io)
250 {
251         int chan = rsnd_io_is_play(io) ?
252                 rsnd_runtime_channel_after_ctu(io) :
253                 rsnd_runtime_channel_original(io);
254 
255         /* Use Multi SSI */
256         if (rsnd_runtime_is_ssi_multi(io))
257                 chan /= rsnd_get_slot_num(io);
258 
259         /* TDM Extend Mode needs 8ch */
260         if (chan == 6)
261                 chan = 8;
262 
263         return chan;
264 }
265 
266 int rsnd_runtime_is_ssi_multi(struct rsnd_dai_stream *io)
267 {
268         int slots = rsnd_get_slot_num(io);
269         int chan = rsnd_io_is_play(io) ?
270                 rsnd_runtime_channel_after_ctu(io) :
271                 rsnd_runtime_channel_original(io);
272 
273         return (chan >= 6) && (slots > 1);
274 }
275 
276 int rsnd_runtime_is_ssi_tdm(struct rsnd_dai_stream *io)
277 {
278         return rsnd_runtime_channel_for_ssi(io) >= 6;
279 }
280 
281 /*
282  *      ADINR function
283  */
284 u32 rsnd_get_adinr_bit(struct rsnd_mod *mod, struct rsnd_dai_stream *io)
285 {
286         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
287         struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
288         struct device *dev = rsnd_priv_to_dev(priv);
289 
290         switch (runtime->sample_bits) {
291         case 16:
292                 return 8 << 16;
293         case 32:
294                 return 0 << 16;
295         }
296 
297         dev_warn(dev, "not supported sample bits\n");
298 
299         return 0;
300 }
301 
302 /*
303  *      DALIGN function
304  */
305 u32 rsnd_get_dalign(struct rsnd_mod *mod, struct rsnd_dai_stream *io)
306 {
307         struct rsnd_mod *ssi = rsnd_io_to_mod_ssi(io);
308         struct rsnd_mod *target;
309         struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
310         u32 val = 0x76543210;
311         u32 mask = ~0;
312 
313         if (rsnd_io_is_play(io)) {
314                 struct rsnd_mod *src = rsnd_io_to_mod_src(io);
315 
316                 target = src ? src : ssi;
317         } else {
318                 struct rsnd_mod *cmd = rsnd_io_to_mod_cmd(io);
319 
320                 target = cmd ? cmd : ssi;
321         }
322 
323         mask <<= runtime->channels * 4;
324         val = val & mask;
325 
326         switch (runtime->sample_bits) {
327         case 16:
328                 val |= 0x67452301 & ~mask;
329                 break;
330         case 32:
331                 val |= 0x76543210 & ~mask;
332                 break;
333         }
334 
335         /*
336          * exchange channeles on SRC if possible,
337          * otherwise, R/L volume settings on DVC
338          * changes inverted channels
339          */
340         if (mod == target)
341                 return val;
342         else
343                 return 0x76543210;
344 }
345 
346 /*
347  *      rsnd_dai functions
348  */
349 #define rsnd_mod_call(idx, io, func, param...)                  \
350 ({                                                              \
351         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);         \
352         struct rsnd_mod *mod = (io)->mod[idx];                  \
353         struct device *dev = rsnd_priv_to_dev(priv);            \
354         u32 *status = mod->get_status(io, mod, idx);                    \
355         u32 mask = 0xF << __rsnd_mod_shift_##func;                      \
356         u8 val  = (*status >> __rsnd_mod_shift_##func) & 0xF;           \
357         u8 add  = ((val + __rsnd_mod_add_##func) & 0xF);                \
358         int ret = 0;                                                    \
359         int call = (val == __rsnd_mod_call_##func) && (mod)->ops->func; \
360         if (add == 0xF)                                                 \
361                 call = 0;                                               \
362         else                                                            \
363                 *status = (*status & ~mask) +                           \
364                         (add << __rsnd_mod_shift_##func);               \
365         dev_dbg(dev, "%s[%d]\t0x%08x %s\n",                             \
366                 rsnd_mod_name(mod), rsnd_mod_id(mod),                   \
367                 *status, call ? #func : "");                            \
368         if (call)                                                       \
369                 ret = (mod)->ops->func(mod, io, param);                 \
370         if (ret)                                                        \
371                 dev_dbg(dev, "%s[%d] : rsnd_mod_call error %d\n",       \
372                         rsnd_mod_name(mod), rsnd_mod_id(mod), ret);     \
373         ret;                                                            \
374 })
375 
376 static enum rsnd_mod_type rsnd_mod_sequence[][RSND_MOD_MAX] = {
377         {
378                 /* CAPTURE */
379                 RSND_MOD_AUDMAPP,
380                 RSND_MOD_AUDMA,
381                 RSND_MOD_DVC,
382                 RSND_MOD_MIX,
383                 RSND_MOD_CTU,
384                 RSND_MOD_CMD,
385                 RSND_MOD_SRC,
386                 RSND_MOD_SSIU,
387                 RSND_MOD_SSIM3,
388                 RSND_MOD_SSIM2,
389                 RSND_MOD_SSIM1,
390                 RSND_MOD_SSIP,
391                 RSND_MOD_SSI,
392         }, {
393                 /* PLAYBACK */
394                 RSND_MOD_AUDMAPP,
395                 RSND_MOD_AUDMA,
396                 RSND_MOD_SSIM3,
397                 RSND_MOD_SSIM2,
398                 RSND_MOD_SSIM1,
399                 RSND_MOD_SSIP,
400                 RSND_MOD_SSI,
401                 RSND_MOD_SSIU,
402                 RSND_MOD_DVC,
403                 RSND_MOD_MIX,
404                 RSND_MOD_CTU,
405                 RSND_MOD_CMD,
406                 RSND_MOD_SRC,
407         },
408 };
409 
410 #define rsnd_dai_call(fn, io, param...)                         \
411 ({                                                              \
412         struct rsnd_mod *mod;                                   \
413         int type, is_play = rsnd_io_is_play(io);                \
414         int ret = 0, i;                                         \
415         for (i = 0; i < RSND_MOD_MAX; i++) {                    \
416                 type = rsnd_mod_sequence[is_play][i];           \
417                 mod = (io)->mod[type];                          \
418                 if (!mod)                                       \
419                         continue;                               \
420                 ret |= rsnd_mod_call(type, io, fn, param);      \
421         }                                                       \
422         ret;                                                    \
423 })
424 
425 int rsnd_dai_connect(struct rsnd_mod *mod,
426                      struct rsnd_dai_stream *io,
427                      enum rsnd_mod_type type)
428 {
429         struct rsnd_priv *priv;
430         struct device *dev;
431 
432         if (!mod)
433                 return -EIO;
434 
435         if (io->mod[type] == mod)
436                 return 0;
437 
438         if (io->mod[type])
439                 return -EINVAL;
440 
441         priv = rsnd_mod_to_priv(mod);
442         dev = rsnd_priv_to_dev(priv);
443 
444         io->mod[type] = mod;
445 
446         dev_dbg(dev, "%s[%d] is connected to io (%s)\n",
447                 rsnd_mod_name(mod), rsnd_mod_id(mod),
448                 rsnd_io_is_play(io) ? "Playback" : "Capture");
449 
450         return 0;
451 }
452 
453 static void rsnd_dai_disconnect(struct rsnd_mod *mod,
454                                 struct rsnd_dai_stream *io,
455                                 enum rsnd_mod_type type)
456 {
457         io->mod[type] = NULL;
458 }
459 
460 struct rsnd_dai *rsnd_rdai_get(struct rsnd_priv *priv, int id)
461 {
462         if ((id < 0) || (id >= rsnd_rdai_nr(priv)))
463                 return NULL;
464 
465         return priv->rdai + id;
466 }
467 
468 #define rsnd_dai_to_priv(dai) snd_soc_dai_get_drvdata(dai)
469 static struct rsnd_dai *rsnd_dai_to_rdai(struct snd_soc_dai *dai)
470 {
471         struct rsnd_priv *priv = rsnd_dai_to_priv(dai);
472 
473         return rsnd_rdai_get(priv, dai->id);
474 }
475 
476 /*
477  *      rsnd_soc_dai functions
478  */
479 int rsnd_dai_pointer_offset(struct rsnd_dai_stream *io, int additional)
480 {
481         struct snd_pcm_substream *substream = io->substream;
482         struct snd_pcm_runtime *runtime = substream->runtime;
483         int pos = io->byte_pos + additional;
484 
485         pos %= (runtime->periods * io->byte_per_period);
486 
487         return pos;
488 }
489 
490 bool rsnd_dai_pointer_update(struct rsnd_dai_stream *io, int byte)
491 {
492         io->byte_pos += byte;
493 
494         if (io->byte_pos >= io->next_period_byte) {
495                 struct snd_pcm_substream *substream = io->substream;
496                 struct snd_pcm_runtime *runtime = substream->runtime;
497 
498                 io->period_pos++;
499                 io->next_period_byte += io->byte_per_period;
500 
501                 if (io->period_pos >= runtime->periods) {
502                         io->byte_pos = 0;
503                         io->period_pos = 0;
504                         io->next_period_byte = io->byte_per_period;
505                 }
506 
507                 return true;
508         }
509 
510         return false;
511 }
512 
513 void rsnd_dai_period_elapsed(struct rsnd_dai_stream *io)
514 {
515         struct snd_pcm_substream *substream = io->substream;
516 
517         /*
518          * this function should be called...
519          *
520          * - if rsnd_dai_pointer_update() returns true
521          * - without spin lock
522          */
523 
524         snd_pcm_period_elapsed(substream);
525 }
526 
527 static void rsnd_dai_stream_init(struct rsnd_dai_stream *io,
528                                 struct snd_pcm_substream *substream)
529 {
530         struct snd_pcm_runtime *runtime = substream->runtime;
531 
532         io->substream           = substream;
533         io->byte_pos            = 0;
534         io->period_pos          = 0;
535         io->byte_per_period     = runtime->period_size *
536                                   runtime->channels *
537                                   samples_to_bytes(runtime, 1);
538         io->next_period_byte    = io->byte_per_period;
539 }
540 
541 static void rsnd_dai_stream_quit(struct rsnd_dai_stream *io)
542 {
543         io->substream           = NULL;
544 }
545 
546 static
547 struct snd_soc_dai *rsnd_substream_to_dai(struct snd_pcm_substream *substream)
548 {
549         struct snd_soc_pcm_runtime *rtd = substream->private_data;
550 
551         return  rtd->cpu_dai;
552 }
553 
554 static
555 struct rsnd_dai_stream *rsnd_rdai_to_io(struct rsnd_dai *rdai,
556                                         struct snd_pcm_substream *substream)
557 {
558         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
559                 return &rdai->playback;
560         else
561                 return &rdai->capture;
562 }
563 
564 static int rsnd_soc_dai_trigger(struct snd_pcm_substream *substream, int cmd,
565                             struct snd_soc_dai *dai)
566 {
567         struct rsnd_priv *priv = rsnd_dai_to_priv(dai);
568         struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
569         struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
570         int ret;
571         unsigned long flags;
572 
573         spin_lock_irqsave(&priv->lock, flags);
574 
575         switch (cmd) {
576         case SNDRV_PCM_TRIGGER_START:
577                 rsnd_dai_stream_init(io, substream);
578 
579                 ret = rsnd_dai_call(init, io, priv);
580                 if (ret < 0)
581                         goto dai_trigger_end;
582 
583                 ret = rsnd_dai_call(start, io, priv);
584                 if (ret < 0)
585                         goto dai_trigger_end;
586 
587                 ret = rsnd_dai_call(irq, io, priv, 1);
588                 if (ret < 0)
589                         goto dai_trigger_end;
590 
591                 break;
592         case SNDRV_PCM_TRIGGER_STOP:
593                 ret = rsnd_dai_call(irq, io, priv, 0);
594 
595                 ret |= rsnd_dai_call(stop, io, priv);
596 
597                 ret |= rsnd_dai_call(quit, io, priv);
598 
599                 rsnd_dai_stream_quit(io);
600                 break;
601         default:
602                 ret = -EINVAL;
603         }
604 
605 dai_trigger_end:
606         spin_unlock_irqrestore(&priv->lock, flags);
607 
608         return ret;
609 }
610 
611 static int rsnd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
612 {
613         struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
614 
615         /* set master/slave audio interface */
616         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
617         case SND_SOC_DAIFMT_CBM_CFM:
618                 rdai->clk_master = 0;
619                 break;
620         case SND_SOC_DAIFMT_CBS_CFS:
621                 rdai->clk_master = 1; /* codec is slave, cpu is master */
622                 break;
623         default:
624                 return -EINVAL;
625         }
626 
627         /* set format */
628         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
629         case SND_SOC_DAIFMT_I2S:
630                 rdai->sys_delay = 0;
631                 rdai->data_alignment = 0;
632                 rdai->frm_clk_inv = 0;
633                 break;
634         case SND_SOC_DAIFMT_LEFT_J:
635                 rdai->sys_delay = 1;
636                 rdai->data_alignment = 0;
637                 rdai->frm_clk_inv = 1;
638                 break;
639         case SND_SOC_DAIFMT_RIGHT_J:
640                 rdai->sys_delay = 1;
641                 rdai->data_alignment = 1;
642                 rdai->frm_clk_inv = 1;
643                 break;
644         }
645 
646         /* set clock inversion */
647         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
648         case SND_SOC_DAIFMT_NB_IF:
649                 rdai->bit_clk_inv =  rdai->bit_clk_inv;
650                 rdai->frm_clk_inv = !rdai->frm_clk_inv;
651                 break;
652         case SND_SOC_DAIFMT_IB_NF:
653                 rdai->bit_clk_inv = !rdai->bit_clk_inv;
654                 rdai->frm_clk_inv =  rdai->frm_clk_inv;
655                 break;
656         case SND_SOC_DAIFMT_IB_IF:
657                 rdai->bit_clk_inv = !rdai->bit_clk_inv;
658                 rdai->frm_clk_inv = !rdai->frm_clk_inv;
659                 break;
660         case SND_SOC_DAIFMT_NB_NF:
661         default:
662                 break;
663         }
664 
665         return 0;
666 }
667 
668 static int rsnd_soc_set_dai_tdm_slot(struct snd_soc_dai *dai,
669                                      u32 tx_mask, u32 rx_mask,
670                                      int slots, int slot_width)
671 {
672         struct rsnd_priv *priv = rsnd_dai_to_priv(dai);
673         struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
674         struct device *dev = rsnd_priv_to_dev(priv);
675 
676         switch (slots) {
677         case 6:
678                 /* TDM Extend Mode */
679                 rsnd_set_slot(rdai, slots, 1);
680                 break;
681         default:
682                 dev_err(dev, "unsupported TDM slots (%d)\n", slots);
683                 return -EINVAL;
684         }
685 
686         return 0;
687 }
688 
689 static const struct snd_soc_dai_ops rsnd_soc_dai_ops = {
690         .trigger        = rsnd_soc_dai_trigger,
691         .set_fmt        = rsnd_soc_dai_set_fmt,
692         .set_tdm_slot   = rsnd_soc_set_dai_tdm_slot,
693 };
694 
695 void rsnd_parse_connect_common(struct rsnd_dai *rdai,
696                 struct rsnd_mod* (*mod_get)(struct rsnd_priv *priv, int id),
697                 struct device_node *node,
698                 struct device_node *playback,
699                 struct device_node *capture)
700 {
701         struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
702         struct device_node *np;
703         struct rsnd_mod *mod;
704         int i;
705 
706         if (!node)
707                 return;
708 
709         i = 0;
710         for_each_child_of_node(node, np) {
711                 mod = mod_get(priv, i);
712                 if (np == playback)
713                         rsnd_dai_connect(mod, &rdai->playback, mod->type);
714                 if (np == capture)
715                         rsnd_dai_connect(mod, &rdai->capture, mod->type);
716                 i++;
717         }
718 
719         of_node_put(node);
720 }
721 
722 static int rsnd_dai_probe(struct rsnd_priv *priv)
723 {
724         struct device_node *dai_node;
725         struct device_node *dai_np;
726         struct device_node *playback, *capture;
727         struct rsnd_dai_stream *io_playback;
728         struct rsnd_dai_stream *io_capture;
729         struct snd_soc_dai_driver *rdrv, *drv;
730         struct rsnd_dai *rdai;
731         struct device *dev = rsnd_priv_to_dev(priv);
732         int nr, dai_i, io_i;
733         int ret;
734 
735         dai_node = rsnd_dai_of_node(priv);
736         nr = of_get_child_count(dai_node);
737         if (!nr) {
738                 ret = -EINVAL;
739                 goto rsnd_dai_probe_done;
740         }
741 
742         rdrv = devm_kzalloc(dev, sizeof(*rdrv) * nr, GFP_KERNEL);
743         rdai = devm_kzalloc(dev, sizeof(*rdai) * nr, GFP_KERNEL);
744         if (!rdrv || !rdai) {
745                 ret = -ENOMEM;
746                 goto rsnd_dai_probe_done;
747         }
748 
749         priv->rdai_nr   = nr;
750         priv->daidrv    = rdrv;
751         priv->rdai      = rdai;
752 
753         /*
754          * parse all dai
755          */
756         dai_i = 0;
757         for_each_child_of_node(dai_node, dai_np) {
758                 rdai            = rsnd_rdai_get(priv, dai_i);
759                 drv             = rdrv + dai_i;
760                 io_playback     = &rdai->playback;
761                 io_capture      = &rdai->capture;
762 
763                 snprintf(rdai->name, RSND_DAI_NAME_SIZE, "rsnd-dai.%d", dai_i);
764 
765                 rdai->priv      = priv;
766                 drv->name       = rdai->name;
767                 drv->ops        = &rsnd_soc_dai_ops;
768 
769                 snprintf(rdai->playback.name, RSND_DAI_NAME_SIZE,
770                          "DAI%d Playback", dai_i);
771                 drv->playback.rates             = RSND_RATES;
772                 drv->playback.formats           = RSND_FMTS;
773                 drv->playback.channels_min      = 2;
774                 drv->playback.channels_max      = 6;
775                 drv->playback.stream_name       = rdai->playback.name;
776 
777                 snprintf(rdai->capture.name, RSND_DAI_NAME_SIZE,
778                          "DAI%d Capture", dai_i);
779                 drv->capture.rates              = RSND_RATES;
780                 drv->capture.formats            = RSND_FMTS;
781                 drv->capture.channels_min       = 2;
782                 drv->capture.channels_max       = 6;
783                 drv->capture.stream_name        = rdai->capture.name;
784 
785                 rdai->playback.rdai             = rdai;
786                 rdai->capture.rdai              = rdai;
787                 rsnd_set_slot(rdai, 2, 1); /* default */
788 
789                 for (io_i = 0;; io_i++) {
790                         playback = of_parse_phandle(dai_np, "playback", io_i);
791                         capture  = of_parse_phandle(dai_np, "capture", io_i);
792 
793                         if (!playback && !capture)
794                                 break;
795 
796                         rsnd_parse_connect_ssi(rdai, playback, capture);
797                         rsnd_parse_connect_src(rdai, playback, capture);
798                         rsnd_parse_connect_ctu(rdai, playback, capture);
799                         rsnd_parse_connect_mix(rdai, playback, capture);
800                         rsnd_parse_connect_dvc(rdai, playback, capture);
801 
802                         of_node_put(playback);
803                         of_node_put(capture);
804                 }
805 
806                 dai_i++;
807 
808                 dev_dbg(dev, "%s (%s/%s)\n", rdai->name,
809                         rsnd_io_to_mod_ssi(io_playback) ? "play"    : " -- ",
810                         rsnd_io_to_mod_ssi(io_capture) ? "capture" : "  --   ");
811         }
812 
813         ret = 0;
814 
815 rsnd_dai_probe_done:
816         of_node_put(dai_node);
817 
818         return ret;
819 }
820 
821 /*
822  *              pcm ops
823  */
824 static struct snd_pcm_hardware rsnd_pcm_hardware = {
825         .info =         SNDRV_PCM_INFO_INTERLEAVED      |
826                         SNDRV_PCM_INFO_MMAP             |
827                         SNDRV_PCM_INFO_MMAP_VALID,
828         .buffer_bytes_max       = 64 * 1024,
829         .period_bytes_min       = 32,
830         .period_bytes_max       = 8192,
831         .periods_min            = 1,
832         .periods_max            = 32,
833         .fifo_size              = 256,
834 };
835 
836 static int rsnd_pcm_open(struct snd_pcm_substream *substream)
837 {
838         struct snd_pcm_runtime *runtime = substream->runtime;
839         int ret = 0;
840 
841         snd_soc_set_runtime_hwparams(substream, &rsnd_pcm_hardware);
842 
843         ret = snd_pcm_hw_constraint_integer(runtime,
844                                             SNDRV_PCM_HW_PARAM_PERIODS);
845 
846         return ret;
847 }
848 
849 static int rsnd_hw_params(struct snd_pcm_substream *substream,
850                          struct snd_pcm_hw_params *hw_params)
851 {
852         struct snd_soc_dai *dai = rsnd_substream_to_dai(substream);
853         struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
854         struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
855         int ret;
856 
857         ret = rsnd_dai_call(hw_params, io, substream, hw_params);
858         if (ret)
859                 return ret;
860 
861         return snd_pcm_lib_malloc_pages(substream,
862                                         params_buffer_bytes(hw_params));
863 }
864 
865 static snd_pcm_uframes_t rsnd_pointer(struct snd_pcm_substream *substream)
866 {
867         struct snd_pcm_runtime *runtime = substream->runtime;
868         struct snd_soc_dai *dai = rsnd_substream_to_dai(substream);
869         struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
870         struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
871 
872         return bytes_to_frames(runtime, io->byte_pos);
873 }
874 
875 static struct snd_pcm_ops rsnd_pcm_ops = {
876         .open           = rsnd_pcm_open,
877         .ioctl          = snd_pcm_lib_ioctl,
878         .hw_params      = rsnd_hw_params,
879         .hw_free        = snd_pcm_lib_free_pages,
880         .pointer        = rsnd_pointer,
881 };
882 
883 /*
884  *              snd_kcontrol
885  */
886 #define kcontrol_to_cfg(kctrl) ((struct rsnd_kctrl_cfg *)kctrl->private_value)
887 static int rsnd_kctrl_info(struct snd_kcontrol *kctrl,
888                            struct snd_ctl_elem_info *uinfo)
889 {
890         struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl);
891 
892         if (cfg->texts) {
893                 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
894                 uinfo->count = cfg->size;
895                 uinfo->value.enumerated.items = cfg->max;
896                 if (uinfo->value.enumerated.item >= cfg->max)
897                         uinfo->value.enumerated.item = cfg->max - 1;
898                 strlcpy(uinfo->value.enumerated.name,
899                         cfg->texts[uinfo->value.enumerated.item],
900                         sizeof(uinfo->value.enumerated.name));
901         } else {
902                 uinfo->count = cfg->size;
903                 uinfo->value.integer.min = 0;
904                 uinfo->value.integer.max = cfg->max;
905                 uinfo->type = (cfg->max == 1) ?
906                         SNDRV_CTL_ELEM_TYPE_BOOLEAN :
907                         SNDRV_CTL_ELEM_TYPE_INTEGER;
908         }
909 
910         return 0;
911 }
912 
913 static int rsnd_kctrl_get(struct snd_kcontrol *kctrl,
914                           struct snd_ctl_elem_value *uc)
915 {
916         struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl);
917         int i;
918 
919         for (i = 0; i < cfg->size; i++)
920                 if (cfg->texts)
921                         uc->value.enumerated.item[i] = cfg->val[i];
922                 else
923                         uc->value.integer.value[i] = cfg->val[i];
924 
925         return 0;
926 }
927 
928 static int rsnd_kctrl_put(struct snd_kcontrol *kctrl,
929                           struct snd_ctl_elem_value *uc)
930 {
931         struct rsnd_mod *mod = snd_kcontrol_chip(kctrl);
932         struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl);
933         int i, change = 0;
934 
935         for (i = 0; i < cfg->size; i++) {
936                 if (cfg->texts) {
937                         change |= (uc->value.enumerated.item[i] != cfg->val[i]);
938                         cfg->val[i] = uc->value.enumerated.item[i];
939                 } else {
940                         change |= (uc->value.integer.value[i] != cfg->val[i]);
941                         cfg->val[i] = uc->value.integer.value[i];
942                 }
943         }
944 
945         if (change && cfg->update)
946                 cfg->update(cfg->io, mod);
947 
948         return change;
949 }
950 
951 static int __rsnd_kctrl_new(struct rsnd_mod *mod,
952                             struct rsnd_dai_stream *io,
953                             struct snd_soc_pcm_runtime *rtd,
954                             const unsigned char *name,
955                             struct rsnd_kctrl_cfg *cfg,
956                             void (*update)(struct rsnd_dai_stream *io,
957                                            struct rsnd_mod *mod))
958 {
959         struct snd_card *card = rtd->card->snd_card;
960         struct snd_kcontrol *kctrl;
961         struct snd_kcontrol_new knew = {
962                 .iface          = SNDRV_CTL_ELEM_IFACE_MIXER,
963                 .name           = name,
964                 .info           = rsnd_kctrl_info,
965                 .index          = rtd->num,
966                 .get            = rsnd_kctrl_get,
967                 .put            = rsnd_kctrl_put,
968                 .private_value  = (unsigned long)cfg,
969         };
970         int ret;
971 
972         kctrl = snd_ctl_new1(&knew, mod);
973         if (!kctrl)
974                 return -ENOMEM;
975 
976         ret = snd_ctl_add(card, kctrl);
977         if (ret < 0) {
978                 snd_ctl_free_one(kctrl);
979                 return ret;
980         }
981 
982         cfg->update = update;
983         cfg->card = card;
984         cfg->kctrl = kctrl;
985         cfg->io = io;
986 
987         return 0;
988 }
989 
990 void _rsnd_kctrl_remove(struct rsnd_kctrl_cfg *cfg)
991 {
992         snd_ctl_remove(cfg->card, cfg->kctrl);
993 }
994 
995 int rsnd_kctrl_new_m(struct rsnd_mod *mod,
996                      struct rsnd_dai_stream *io,
997                      struct snd_soc_pcm_runtime *rtd,
998                      const unsigned char *name,
999                      void (*update)(struct rsnd_dai_stream *io,
1000                                     struct rsnd_mod *mod),
1001                      struct rsnd_kctrl_cfg_m *_cfg,
1002                      int ch_size,
1003                      u32 max)
1004 {
1005         if (ch_size > RSND_MAX_CHANNELS)
1006                 return -EINVAL;
1007 
1008         _cfg->cfg.max   = max;
1009         _cfg->cfg.size  = ch_size;
1010         _cfg->cfg.val   = _cfg->val;
1011         return __rsnd_kctrl_new(mod, io, rtd, name, &_cfg->cfg, update);
1012 }
1013 
1014 int rsnd_kctrl_new_s(struct rsnd_mod *mod,
1015                      struct rsnd_dai_stream *io,
1016                      struct snd_soc_pcm_runtime *rtd,
1017                      const unsigned char *name,
1018                      void (*update)(struct rsnd_dai_stream *io,
1019                                     struct rsnd_mod *mod),
1020                      struct rsnd_kctrl_cfg_s *_cfg,
1021                      u32 max)
1022 {
1023         _cfg->cfg.max   = max;
1024         _cfg->cfg.size  = 1;
1025         _cfg->cfg.val   = &_cfg->val;
1026         return __rsnd_kctrl_new(mod, io, rtd, name, &_cfg->cfg, update);
1027 }
1028 
1029 int rsnd_kctrl_new_e(struct rsnd_mod *mod,
1030                      struct rsnd_dai_stream *io,
1031                      struct snd_soc_pcm_runtime *rtd,
1032                      const unsigned char *name,
1033                      struct rsnd_kctrl_cfg_s *_cfg,
1034                      void (*update)(struct rsnd_dai_stream *io,
1035                                     struct rsnd_mod *mod),
1036                      const char * const *texts,
1037                      u32 max)
1038 {
1039         _cfg->cfg.max   = max;
1040         _cfg->cfg.size  = 1;
1041         _cfg->cfg.val   = &_cfg->val;
1042         _cfg->cfg.texts = texts;
1043         return __rsnd_kctrl_new(mod, io, rtd, name, &_cfg->cfg, update);
1044 }
1045 
1046 /*
1047  *              snd_soc_platform
1048  */
1049 
1050 #define PREALLOC_BUFFER         (32 * 1024)
1051 #define PREALLOC_BUFFER_MAX     (32 * 1024)
1052 
1053 static int rsnd_pcm_new(struct snd_soc_pcm_runtime *rtd)
1054 {
1055         struct snd_soc_dai *dai = rtd->cpu_dai;
1056         struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
1057         int ret;
1058 
1059         ret = rsnd_dai_call(pcm_new, &rdai->playback, rtd);
1060         if (ret)
1061                 return ret;
1062 
1063         ret = rsnd_dai_call(pcm_new, &rdai->capture, rtd);
1064         if (ret)
1065                 return ret;
1066 
1067         return snd_pcm_lib_preallocate_pages_for_all(
1068                 rtd->pcm,
1069                 SNDRV_DMA_TYPE_DEV,
1070                 rtd->card->snd_card->dev,
1071                 PREALLOC_BUFFER, PREALLOC_BUFFER_MAX);
1072 }
1073 
1074 static struct snd_soc_platform_driver rsnd_soc_platform = {
1075         .ops            = &rsnd_pcm_ops,
1076         .pcm_new        = rsnd_pcm_new,
1077 };
1078 
1079 static const struct snd_soc_component_driver rsnd_soc_component = {
1080         .name           = "rsnd",
1081 };
1082 
1083 static int rsnd_rdai_continuance_probe(struct rsnd_priv *priv,
1084                                        struct rsnd_dai_stream *io)
1085 {
1086         int ret;
1087 
1088         ret = rsnd_dai_call(probe, io, priv);
1089         if (ret == -EAGAIN) {
1090                 struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
1091                 int i;
1092 
1093                 /*
1094                  * Fallback to PIO mode
1095                  */
1096 
1097                 /*
1098                  * call "remove" for SSI/SRC/DVC
1099                  * SSI will be switch to PIO mode if it was DMA mode
1100                  * see
1101                  *      rsnd_dma_init()
1102                  *      rsnd_ssi_fallback()
1103                  */
1104                 rsnd_dai_call(remove, io, priv);
1105 
1106                 /*
1107                  * remove all mod from io
1108                  * and, re connect ssi
1109                  */
1110                 for (i = 0; i < RSND_MOD_MAX; i++)
1111                         rsnd_dai_disconnect((io)->mod[i], io, i);
1112                 rsnd_dai_connect(ssi_mod, io, RSND_MOD_SSI);
1113 
1114                 /*
1115                  * fallback
1116                  */
1117                 rsnd_dai_call(fallback, io, priv);
1118 
1119                 /*
1120                  * retry to "probe".
1121                  * DAI has SSI which is PIO mode only now.
1122                  */
1123                 ret = rsnd_dai_call(probe, io, priv);
1124         }
1125 
1126         return ret;
1127 }
1128 
1129 /*
1130  *      rsnd probe
1131  */
1132 static int rsnd_probe(struct platform_device *pdev)
1133 {
1134         struct rsnd_priv *priv;
1135         struct device *dev = &pdev->dev;
1136         struct rsnd_dai *rdai;
1137         int (*probe_func[])(struct rsnd_priv *priv) = {
1138                 rsnd_gen_probe,
1139                 rsnd_dma_probe,
1140                 rsnd_ssi_probe,
1141                 rsnd_ssiu_probe,
1142                 rsnd_src_probe,
1143                 rsnd_ctu_probe,
1144                 rsnd_mix_probe,
1145                 rsnd_dvc_probe,
1146                 rsnd_cmd_probe,
1147                 rsnd_adg_probe,
1148                 rsnd_dai_probe,
1149         };
1150         int ret, i;
1151 
1152         /*
1153          *      init priv data
1154          */
1155         priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
1156         if (!priv) {
1157                 dev_err(dev, "priv allocate failed\n");
1158                 return -ENODEV;
1159         }
1160 
1161         priv->pdev      = pdev;
1162         priv->flags     = (unsigned long)of_device_get_match_data(dev);
1163         spin_lock_init(&priv->lock);
1164 
1165         /*
1166          *      init each module
1167          */
1168         for (i = 0; i < ARRAY_SIZE(probe_func); i++) {
1169                 ret = probe_func[i](priv);
1170                 if (ret)
1171                         return ret;
1172         }
1173 
1174         for_each_rsnd_dai(rdai, priv, i) {
1175                 ret = rsnd_rdai_continuance_probe(priv, &rdai->playback);
1176                 if (ret)
1177                         goto exit_snd_probe;
1178 
1179                 ret = rsnd_rdai_continuance_probe(priv, &rdai->capture);
1180                 if (ret)
1181                         goto exit_snd_probe;
1182         }
1183 
1184         dev_set_drvdata(dev, priv);
1185 
1186         /*
1187          *      asoc register
1188          */
1189         ret = snd_soc_register_platform(dev, &rsnd_soc_platform);
1190         if (ret < 0) {
1191                 dev_err(dev, "cannot snd soc register\n");
1192                 return ret;
1193         }
1194 
1195         ret = snd_soc_register_component(dev, &rsnd_soc_component,
1196                                          priv->daidrv, rsnd_rdai_nr(priv));
1197         if (ret < 0) {
1198                 dev_err(dev, "cannot snd dai register\n");
1199                 goto exit_snd_soc;
1200         }
1201 
1202         pm_runtime_enable(dev);
1203 
1204         dev_info(dev, "probed\n");
1205         return ret;
1206 
1207 exit_snd_soc:
1208         snd_soc_unregister_platform(dev);
1209 exit_snd_probe:
1210         for_each_rsnd_dai(rdai, priv, i) {
1211                 rsnd_dai_call(remove, &rdai->playback, priv);
1212                 rsnd_dai_call(remove, &rdai->capture, priv);
1213         }
1214 
1215         return ret;
1216 }
1217 
1218 static int rsnd_remove(struct platform_device *pdev)
1219 {
1220         struct rsnd_priv *priv = dev_get_drvdata(&pdev->dev);
1221         struct rsnd_dai *rdai;
1222         void (*remove_func[])(struct rsnd_priv *priv) = {
1223                 rsnd_ssi_remove,
1224                 rsnd_ssiu_remove,
1225                 rsnd_src_remove,
1226                 rsnd_ctu_remove,
1227                 rsnd_mix_remove,
1228                 rsnd_dvc_remove,
1229                 rsnd_cmd_remove,
1230                 rsnd_adg_remove,
1231         };
1232         int ret = 0, i;
1233 
1234         pm_runtime_disable(&pdev->dev);
1235 
1236         for_each_rsnd_dai(rdai, priv, i) {
1237                 ret |= rsnd_dai_call(remove, &rdai->playback, priv);
1238                 ret |= rsnd_dai_call(remove, &rdai->capture, priv);
1239         }
1240 
1241         for (i = 0; i < ARRAY_SIZE(remove_func); i++)
1242                 remove_func[i](priv);
1243 
1244         snd_soc_unregister_component(&pdev->dev);
1245         snd_soc_unregister_platform(&pdev->dev);
1246 
1247         return ret;
1248 }
1249 
1250 static struct platform_driver rsnd_driver = {
1251         .driver = {
1252                 .name   = "rcar_sound",
1253                 .of_match_table = rsnd_of_match,
1254         },
1255         .probe          = rsnd_probe,
1256         .remove         = rsnd_remove,
1257 };
1258 module_platform_driver(rsnd_driver);
1259 
1260 MODULE_LICENSE("GPL");
1261 MODULE_DESCRIPTION("Renesas R-Car audio driver");
1262 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
1263 MODULE_ALIAS("platform:rcar-pcm-audio");
1264 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us