2 * Renesas R-Car SRC support
4 * Copyright (C) 2013 Renesas Solutions Corp.
5 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
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.
13 #define SRC_NAME "src"
16 struct rsnd_src_platform_info *info; /* rcar_snd.h */
21 #define RSND_SRC_NAME_SIZE 16
23 #define rsnd_src_convert_rate(p) ((p)->info->convert_rate)
24 #define rsnd_mod_to_src(_mod) \
25 container_of((_mod), struct rsnd_src, mod)
26 #define rsnd_src_dma_available(src) \
27 rsnd_dma_available(rsnd_mod_to_dma(&(src)->mod))
29 #define for_each_rsnd_src(pos, priv, i) \
31 ((i) < rsnd_src_nr(priv)) && \
32 ((pos) = (struct rsnd_src *)(priv)->src + i); \
37 * image of SRC (Sampling Rate Converter)
39 * 96kHz <-> +-----+ 48kHz +-----+ 48kHz +-------+
40 * 48kHz <-> | SRC | <------> | SSI | <-----> | codec |
41 * 44.1kHz <-> +-----+ +-----+ +-------+
51 * [mem] -> [SRU] -> [SSI]
56 * [mem] -> [SRC] -> [SSIU] -> [SSI]
61 * How to use SRC bypass mode for debugging
63 * SRC has bypass mode, and it is useful for debugging.
65 * SRCm_MODE controls whether SRC is used or not
66 * SSI_MODE0 controls whether SSIU which receives SRC data
68 * Both SRCm_MODE/SSI_MODE0 settings are needed if you use SRC,
69 * but SRC bypass mode needs SSI_MODE0 only.
72 * struct rsnd_src_platform_info {
77 * rsnd_src_convert_rate() indicates
78 * above convert_rate, and it controls
79 * whether SRC is used or not.
82 * static struct rsnd_dai_platform_info rsnd_dai = {
83 * .playback = { .ssi = &rsnd_ssi[0], },
87 * static struct rsnd_src_platform_info rsnd_src[] = {
91 * static struct rsnd_dai_platform_info rsnd_dai = {
92 * .playback = { .ssi = &rsnd_ssi[0], .src = &rsnd_src[0] },
95 * ex) uses SRC bypass mode
96 * static struct rsnd_src_platform_info rsnd_src[] = {
100 * static struct rsnd_dai_platform_info rsnd_dai = {
101 * .playback = { .ssi = &rsnd_ssi[0], .src = &rsnd_src[0] },
107 * Gen1/Gen2 common functions
109 int rsnd_src_ssi_mode_init(struct rsnd_mod *ssi_mod,
110 struct rsnd_dai *rdai)
112 struct rsnd_dai_stream *io = rsnd_mod_to_io(ssi_mod);
113 struct rsnd_mod *src_mod = rsnd_io_to_mod_src(io);
114 int ssi_id = rsnd_mod_id(ssi_mod);
119 rsnd_mod_bset(ssi_mod, SSI_MODE0, (1 << ssi_id),
120 src_mod ? 0 : (1 << ssi_id));
125 if (rsnd_ssi_is_pin_sharing(ssi_mod)) {
140 rsnd_mod_bset(ssi_mod, SSI_MODE1,
142 rsnd_dai_is_clk_master(rdai) ?
143 0x2 << shift : 0x1 << shift);
149 int rsnd_src_enable_ssi_irq(struct rsnd_mod *ssi_mod,
150 struct rsnd_dai *rdai)
152 struct rsnd_priv *priv = rsnd_mod_to_priv(ssi_mod);
154 /* enable PIO interrupt if Gen2 */
155 if (rsnd_is_gen2(priv))
156 rsnd_mod_write(ssi_mod, INT_ENABLE, 0x0f000000);
161 unsigned int rsnd_src_get_ssi_rate(struct rsnd_priv *priv,
162 struct rsnd_dai_stream *io,
163 struct snd_pcm_runtime *runtime)
165 struct rsnd_mod *src_mod = rsnd_io_to_mod_src(io);
166 struct rsnd_src *src;
167 unsigned int rate = 0;
170 src = rsnd_mod_to_src(src_mod);
173 * return convert rate if SRC is used,
174 * otherwise, return runtime->rate as usual
176 rate = rsnd_src_convert_rate(src);
180 rate = runtime->rate;
185 static int rsnd_src_set_convert_rate(struct rsnd_mod *mod,
186 struct rsnd_dai *rdai)
188 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
189 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
190 struct rsnd_src *src = rsnd_mod_to_src(mod);
191 u32 convert_rate = rsnd_src_convert_rate(src);
195 fsrate = 0x0400000 / convert_rate * runtime->rate;
197 /* set/clear soft reset */
198 rsnd_mod_write(mod, SRC_SWRSR, 0);
199 rsnd_mod_write(mod, SRC_SWRSR, 1);
202 * Initialize the operation of the SRC internal circuits
203 * see rsnd_src_start()
205 rsnd_mod_write(mod, SRC_SRCIR, 1);
207 /* Set channel number and output bit length */
208 rsnd_mod_write(mod, SRC_ADINR, rsnd_get_adinr(mod));
210 /* Enable the initial value of IFS */
212 rsnd_mod_write(mod, SRC_IFSCR, 1);
214 /* Set initial value of IFS */
215 rsnd_mod_write(mod, SRC_IFSVR, fsrate);
218 /* use DMA transfer */
219 rsnd_mod_write(mod, SRC_BUSIF_MODE, 1);
224 static int rsnd_src_init(struct rsnd_mod *mod,
225 struct rsnd_dai *rdai)
227 struct rsnd_src *src = rsnd_mod_to_src(mod);
229 clk_enable(src->clk);
234 static int rsnd_src_quit(struct rsnd_mod *mod,
235 struct rsnd_dai *rdai)
237 struct rsnd_src *src = rsnd_mod_to_src(mod);
239 clk_disable(src->clk);
244 static int rsnd_src_start(struct rsnd_mod *mod,
245 struct rsnd_dai *rdai)
247 struct rsnd_src *src = rsnd_mod_to_src(mod);
250 * Cancel the initialization and operate the SRC function
251 * see rsnd_src_set_convert_rate()
253 rsnd_mod_write(mod, SRC_SRCIR, 0);
255 if (rsnd_src_convert_rate(src))
256 rsnd_mod_write(mod, SRC_ROUTE_MODE0, 1);
262 static int rsnd_src_stop(struct rsnd_mod *mod,
263 struct rsnd_dai *rdai)
265 struct rsnd_src *src = rsnd_mod_to_src(mod);
267 if (rsnd_src_convert_rate(src))
268 rsnd_mod_write(mod, SRC_ROUTE_MODE0, 0);
276 static int rsnd_src_set_route_gen1(struct rsnd_mod *mod,
277 struct rsnd_dai *rdai)
279 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
280 struct src_route_config {
287 { 0x7, 12, }, /* 3 */
288 { 0x7, 16, }, /* 4 */
289 { 0x7, 20, }, /* 5 */
290 { 0x7, 24, }, /* 6 */
291 { 0x3, 28, }, /* 7 */
292 { 0x3, 30, }, /* 8 */
298 id = rsnd_mod_id(mod);
299 if (id < 0 || id >= ARRAY_SIZE(routes))
305 val = rsnd_dai_is_play(rdai, io) ? 0x1 : 0x2;
306 val = val << routes[id].shift;
307 mask = routes[id].mask << routes[id].shift;
309 rsnd_mod_bset(mod, SRC_ROUTE_SEL, mask, val);
314 static int rsnd_src_set_convert_timing_gen1(struct rsnd_mod *mod,
315 struct rsnd_dai *rdai)
317 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
318 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
319 struct rsnd_src *src = rsnd_mod_to_src(mod);
320 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
321 u32 convert_rate = rsnd_src_convert_rate(src);
325 int id = rsnd_mod_id(mod);
331 shift = (id % 4) * 8;
332 mask = 0x1F << shift;
335 * ADG is used as source clock if SRC was used,
336 * then, SSI WS is used as destination clock.
337 * SSI WS is used as source clock if SRC is not used
338 * (when playback, source/destination become reverse when capture)
344 ret = rsnd_adg_set_convert_clk_gen1(priv, mod,
347 } else if (8 == id) {
348 /* use SSI WS, but SRU8 is special */
352 val = (id + 1) << shift;
360 rsnd_mod_bset(mod, SRC_TMG_SEL0, mask, val);
363 rsnd_mod_bset(mod, SRC_TMG_SEL1, mask, val);
366 rsnd_mod_bset(mod, SRC_TMG_SEL2, mask, val);
373 static int rsnd_src_set_convert_rate_gen1(struct rsnd_mod *mod,
374 struct rsnd_dai *rdai)
378 ret = rsnd_src_set_convert_rate(mod, rdai);
382 /* Select SRC mode (fixed value) */
383 rsnd_mod_write(mod, SRC_SRCCR, 0x00010110);
385 /* Set the restriction value of the FS ratio (98%) */
386 rsnd_mod_write(mod, SRC_MNFSR,
387 rsnd_mod_read(mod, SRC_IFSVR) / 100 * 98);
389 /* no SRC_BFSSR settings, since SRC_SRCCR::BUFMD is 0 */
394 static int rsnd_src_probe_gen1(struct rsnd_mod *mod,
395 struct rsnd_dai *rdai)
397 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
398 struct device *dev = rsnd_priv_to_dev(priv);
400 dev_dbg(dev, "%s (Gen1) is probed\n", rsnd_mod_name(mod));
405 static int rsnd_src_init_gen1(struct rsnd_mod *mod,
406 struct rsnd_dai *rdai)
410 ret = rsnd_src_init(mod, rdai);
414 ret = rsnd_src_set_route_gen1(mod, rdai);
418 ret = rsnd_src_set_convert_rate_gen1(mod, rdai);
422 ret = rsnd_src_set_convert_timing_gen1(mod, rdai);
429 static int rsnd_src_start_gen1(struct rsnd_mod *mod,
430 struct rsnd_dai *rdai)
432 int id = rsnd_mod_id(mod);
434 rsnd_mod_bset(mod, SRC_ROUTE_CTRL, (1 << id), (1 << id));
436 return rsnd_src_start(mod, rdai);
439 static int rsnd_src_stop_gen1(struct rsnd_mod *mod,
440 struct rsnd_dai *rdai)
442 int id = rsnd_mod_id(mod);
444 rsnd_mod_bset(mod, SRC_ROUTE_CTRL, (1 << id), 0);
446 return rsnd_src_stop(mod, rdai);
449 static struct rsnd_mod_ops rsnd_src_gen1_ops = {
451 .probe = rsnd_src_probe_gen1,
452 .init = rsnd_src_init_gen1,
453 .quit = rsnd_src_quit,
454 .start = rsnd_src_start_gen1,
455 .stop = rsnd_src_stop_gen1,
461 static int rsnd_src_set_convert_rate_gen2(struct rsnd_mod *mod,
462 struct rsnd_dai *rdai)
466 ret = rsnd_src_set_convert_rate(mod, rdai);
470 rsnd_mod_write(mod, SSI_BUSIF_ADINR, rsnd_get_adinr(mod));
471 rsnd_mod_write(mod, SSI_BUSIF_MODE, 1);
473 rsnd_mod_write(mod, SRC_SRCCR, 0x00011110);
475 rsnd_mod_write(mod, SRC_BSDSR, 0x01800000);
476 rsnd_mod_write(mod, SRC_BSISR, 0x00100060);
481 static int rsnd_src_set_convert_timing_gen2(struct rsnd_mod *mod,
482 struct rsnd_dai *rdai)
484 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
485 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
486 struct rsnd_src *src = rsnd_mod_to_src(mod);
487 u32 convert_rate = rsnd_src_convert_rate(src);
491 ret = rsnd_adg_set_convert_clk_gen2(mod, rdai, io,
495 ret = rsnd_adg_set_convert_timing_gen2(mod, rdai, io);
500 static int rsnd_src_probe_gen2(struct rsnd_mod *mod,
501 struct rsnd_dai *rdai)
503 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
504 struct rsnd_src *src = rsnd_mod_to_src(mod);
505 struct device *dev = rsnd_priv_to_dev(priv);
508 ret = rsnd_dma_init(priv,
509 rsnd_mod_to_dma(mod),
510 rsnd_info_is_playback(priv, src),
513 dev_err(dev, "SRC DMA failed\n");
515 dev_dbg(dev, "%s (Gen2) is probed\n", rsnd_mod_name(mod));
520 static int rsnd_src_remove_gen2(struct rsnd_mod *mod,
521 struct rsnd_dai *rdai)
523 rsnd_dma_quit(rsnd_mod_to_priv(mod), rsnd_mod_to_dma(mod));
528 static int rsnd_src_init_gen2(struct rsnd_mod *mod,
529 struct rsnd_dai *rdai)
533 ret = rsnd_src_init(mod, rdai);
537 ret = rsnd_src_set_convert_rate_gen2(mod, rdai);
541 ret = rsnd_src_set_convert_timing_gen2(mod, rdai);
548 static int rsnd_src_start_gen2(struct rsnd_mod *mod,
549 struct rsnd_dai *rdai)
551 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
552 struct rsnd_src *src = rsnd_mod_to_src(mod);
553 u32 val = rsnd_io_to_mod_dvc(io) ? 0x01 : 0x11;
555 rsnd_dma_start(rsnd_mod_to_dma(&src->mod));
557 rsnd_mod_write(mod, SSI_CTRL, 0x1);
558 rsnd_mod_write(mod, SRC_CTRL, val);
560 return rsnd_src_start(mod, rdai);
563 static int rsnd_src_stop_gen2(struct rsnd_mod *mod,
564 struct rsnd_dai *rdai)
566 struct rsnd_src *src = rsnd_mod_to_src(mod);
568 rsnd_mod_write(mod, SSI_CTRL, 0);
569 rsnd_mod_write(mod, SRC_CTRL, 0);
571 rsnd_dma_stop(rsnd_mod_to_dma(&src->mod));
573 return rsnd_src_stop(mod, rdai);
576 static struct rsnd_mod_ops rsnd_src_gen2_ops = {
578 .probe = rsnd_src_probe_gen2,
579 .remove = rsnd_src_remove_gen2,
580 .init = rsnd_src_init_gen2,
581 .quit = rsnd_src_quit,
582 .start = rsnd_src_start_gen2,
583 .stop = rsnd_src_stop_gen2,
586 struct rsnd_mod *rsnd_src_mod_get(struct rsnd_priv *priv, int id)
588 if (WARN_ON(id < 0 || id >= rsnd_src_nr(priv)))
591 return &((struct rsnd_src *)(priv->src) + id)->mod;
594 static void rsnd_of_parse_src(struct platform_device *pdev,
595 const struct rsnd_of_data *of_data,
596 struct rsnd_priv *priv)
598 struct device_node *src_node;
599 struct rcar_snd_info *info = rsnd_priv_to_info(priv);
600 struct rsnd_src_platform_info *src_info;
601 struct device *dev = &pdev->dev;
607 src_node = of_get_child_by_name(dev->of_node, "rcar_sound,src");
611 nr = of_get_child_count(src_node);
613 goto rsnd_of_parse_src_end;
615 src_info = devm_kzalloc(dev,
616 sizeof(struct rsnd_src_platform_info) * nr,
619 dev_err(dev, "src info allocation error\n");
620 goto rsnd_of_parse_src_end;
623 info->src_info = src_info;
624 info->src_info_nr = nr;
626 rsnd_of_parse_src_end:
627 of_node_put(src_node);
630 int rsnd_src_probe(struct platform_device *pdev,
631 const struct rsnd_of_data *of_data,
632 struct rsnd_priv *priv)
634 struct rcar_snd_info *info = rsnd_priv_to_info(priv);
635 struct device *dev = rsnd_priv_to_dev(priv);
636 struct rsnd_src *src;
637 struct rsnd_mod_ops *ops;
639 char name[RSND_SRC_NAME_SIZE];
643 if (rsnd_is_gen1(priv))
644 ops = &rsnd_src_gen1_ops;
645 if (rsnd_is_gen2(priv))
646 ops = &rsnd_src_gen2_ops;
648 dev_err(dev, "unknown Generation\n");
652 rsnd_of_parse_src(pdev, of_data, priv);
657 nr = info->src_info_nr;
661 src = devm_kzalloc(dev, sizeof(*src) * nr, GFP_KERNEL);
663 dev_err(dev, "SRC allocate failed\n");
670 for_each_rsnd_src(src, priv, i) {
671 snprintf(name, RSND_SRC_NAME_SIZE, "%s.%d",
674 clk = devm_clk_get(dev, name);
678 src->info = &info->src_info[i];
681 rsnd_mod_init(priv, &src->mod, ops, RSND_MOD_SRC, i);
683 dev_dbg(dev, "SRC%d probed\n", i);