]> git.karo-electronics.de Git - karo-tx-linux.git/blob - sound/soc/generic/simple-card.c
Merge branch 'for-linus-v3.20' of git://git.infradead.org/linux-ubifs
[karo-tx-linux.git] / sound / soc / generic / simple-card.c
1 /*
2  * ASoC simple sound card support
3  *
4  * Copyright (C) 2012 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 <linux/clk.h>
12 #include <linux/device.h>
13 #include <linux/gpio.h>
14 #include <linux/module.h>
15 #include <linux/of.h>
16 #include <linux/of_gpio.h>
17 #include <linux/platform_device.h>
18 #include <linux/string.h>
19 #include <sound/jack.h>
20 #include <sound/simple_card.h>
21 #include <sound/soc-dai.h>
22 #include <sound/soc.h>
23
24 struct simple_card_data {
25         struct snd_soc_card snd_card;
26         struct simple_dai_props {
27                 struct asoc_simple_dai cpu_dai;
28                 struct asoc_simple_dai codec_dai;
29         } *dai_props;
30         unsigned int mclk_fs;
31         int gpio_hp_det;
32         int gpio_hp_det_invert;
33         int gpio_mic_det;
34         int gpio_mic_det_invert;
35         struct snd_soc_dai_link dai_link[];     /* dynamically allocated */
36 };
37
38 #define simple_priv_to_dev(priv) ((priv)->snd_card.dev)
39 #define simple_priv_to_link(priv, i) ((priv)->snd_card.dai_link + i)
40 #define simple_priv_to_props(priv, i) ((priv)->dai_props + i)
41
42 static int asoc_simple_card_startup(struct snd_pcm_substream *substream)
43 {
44         struct snd_soc_pcm_runtime *rtd = substream->private_data;
45         struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
46         struct simple_dai_props *dai_props =
47                 &priv->dai_props[rtd - rtd->card->rtd];
48         int ret;
49
50         ret = clk_prepare_enable(dai_props->cpu_dai.clk);
51         if (ret)
52                 return ret;
53         
54         ret = clk_prepare_enable(dai_props->codec_dai.clk);
55         if (ret)
56                 clk_disable_unprepare(dai_props->cpu_dai.clk);
57
58         return ret;
59 }
60
61 static void asoc_simple_card_shutdown(struct snd_pcm_substream *substream)
62 {
63         struct snd_soc_pcm_runtime *rtd = substream->private_data;
64         struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
65         struct simple_dai_props *dai_props =
66                 &priv->dai_props[rtd - rtd->card->rtd];
67
68         clk_disable_unprepare(dai_props->cpu_dai.clk);
69
70         clk_disable_unprepare(dai_props->codec_dai.clk);
71 }
72
73 static int asoc_simple_card_hw_params(struct snd_pcm_substream *substream,
74                                       struct snd_pcm_hw_params *params)
75 {
76         struct snd_soc_pcm_runtime *rtd = substream->private_data;
77         struct snd_soc_dai *codec_dai = rtd->codec_dai;
78         struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
79         unsigned int mclk;
80         int ret = 0;
81
82         if (priv->mclk_fs) {
83                 mclk = params_rate(params) * priv->mclk_fs;
84                 ret = snd_soc_dai_set_sysclk(codec_dai, 0, mclk,
85                                              SND_SOC_CLOCK_IN);
86         }
87
88         return ret;
89 }
90
91 static struct snd_soc_ops asoc_simple_card_ops = {
92         .startup = asoc_simple_card_startup,
93         .shutdown = asoc_simple_card_shutdown,
94         .hw_params = asoc_simple_card_hw_params,
95 };
96
97 static struct snd_soc_jack simple_card_hp_jack;
98 static struct snd_soc_jack_pin simple_card_hp_jack_pins[] = {
99         {
100                 .pin = "Headphones",
101                 .mask = SND_JACK_HEADPHONE,
102         },
103 };
104 static struct snd_soc_jack_gpio simple_card_hp_jack_gpio = {
105         .name = "Headphone detection",
106         .report = SND_JACK_HEADPHONE,
107         .debounce_time = 150,
108 };
109
110 static struct snd_soc_jack simple_card_mic_jack;
111 static struct snd_soc_jack_pin simple_card_mic_jack_pins[] = {
112         {
113                 .pin = "Mic Jack",
114                 .mask = SND_JACK_MICROPHONE,
115         },
116 };
117 static struct snd_soc_jack_gpio simple_card_mic_jack_gpio = {
118         .name = "Mic detection",
119         .report = SND_JACK_MICROPHONE,
120         .debounce_time = 150,
121 };
122
123 static int __asoc_simple_card_dai_init(struct snd_soc_dai *dai,
124                                        struct asoc_simple_dai *set)
125 {
126         int ret;
127
128         if (set->fmt) {
129                 ret = snd_soc_dai_set_fmt(dai, set->fmt);
130                 if (ret && ret != -ENOTSUPP) {
131                         dev_err(dai->dev, "simple-card: set_fmt error\n");
132                         goto err;
133                 }
134         }
135
136         if (set->sysclk) {
137                 ret = snd_soc_dai_set_sysclk(dai, 0, set->sysclk, 0);
138                 if (ret && ret != -ENOTSUPP) {
139                         dev_err(dai->dev, "simple-card: set_sysclk error\n");
140                         goto err;
141                 }
142         }
143
144         if (set->slots) {
145                 ret = snd_soc_dai_set_tdm_slot(dai, 0, 0,
146                                                 set->slots,
147                                                 set->slot_width);
148                 if (ret && ret != -ENOTSUPP) {
149                         dev_err(dai->dev, "simple-card: set_tdm_slot error\n");
150                         goto err;
151                 }
152         }
153
154         ret = 0;
155
156 err:
157         return ret;
158 }
159
160 static int asoc_simple_card_dai_init(struct snd_soc_pcm_runtime *rtd)
161 {
162         struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
163         struct snd_soc_dai *codec = rtd->codec_dai;
164         struct snd_soc_dai *cpu = rtd->cpu_dai;
165         struct simple_dai_props *dai_props;
166         int num, ret;
167
168         num = rtd - rtd->card->rtd;
169         dai_props = &priv->dai_props[num];
170         ret = __asoc_simple_card_dai_init(codec, &dai_props->codec_dai);
171         if (ret < 0)
172                 return ret;
173
174         ret = __asoc_simple_card_dai_init(cpu, &dai_props->cpu_dai);
175         if (ret < 0)
176                 return ret;
177
178         if (gpio_is_valid(priv->gpio_hp_det)) {
179                 snd_soc_jack_new(codec->codec, "Headphones", SND_JACK_HEADPHONE,
180                                  &simple_card_hp_jack);
181                 snd_soc_jack_add_pins(&simple_card_hp_jack,
182                                       ARRAY_SIZE(simple_card_hp_jack_pins),
183                                       simple_card_hp_jack_pins);
184
185                 simple_card_hp_jack_gpio.gpio = priv->gpio_hp_det;
186                 simple_card_hp_jack_gpio.invert = priv->gpio_hp_det_invert;
187                 snd_soc_jack_add_gpios(&simple_card_hp_jack, 1,
188                                        &simple_card_hp_jack_gpio);
189         }
190
191         if (gpio_is_valid(priv->gpio_mic_det)) {
192                 snd_soc_jack_new(codec->codec, "Mic Jack", SND_JACK_MICROPHONE,
193                                  &simple_card_mic_jack);
194                 snd_soc_jack_add_pins(&simple_card_mic_jack,
195                                       ARRAY_SIZE(simple_card_mic_jack_pins),
196                                       simple_card_mic_jack_pins);
197                 simple_card_mic_jack_gpio.gpio = priv->gpio_mic_det;
198                 simple_card_mic_jack_gpio.invert = priv->gpio_mic_det_invert;
199                 snd_soc_jack_add_gpios(&simple_card_mic_jack, 1,
200                                        &simple_card_mic_jack_gpio);
201         }
202         return 0;
203 }
204
205 static int
206 asoc_simple_card_sub_parse_of(struct device_node *np,
207                               struct asoc_simple_dai *dai,
208                               struct device_node **p_node,
209                               const char **name,
210                               int *args_count)
211 {
212         struct of_phandle_args args;
213         struct clk *clk;
214         u32 val;
215         int ret;
216
217         /*
218          * Get node via "sound-dai = <&phandle port>"
219          * it will be used as xxx_of_node on soc_bind_dai_link()
220          */
221         ret = of_parse_phandle_with_args(np, "sound-dai",
222                                          "#sound-dai-cells", 0, &args);
223         if (ret)
224                 return ret;
225
226         *p_node = args.np;
227
228         if (args_count)
229                 *args_count = args.args_count;
230
231         /* Get dai->name */
232         ret = snd_soc_of_get_dai_name(np, name);
233         if (ret < 0)
234                 return ret;
235
236         /* Parse TDM slot */
237         ret = snd_soc_of_parse_tdm_slot(np, &dai->slots, &dai->slot_width);
238         if (ret)
239                 return ret;
240
241         /*
242          * Parse dai->sysclk come from "clocks = <&xxx>"
243          * (if system has common clock)
244          *  or "system-clock-frequency = <xxx>"
245          *  or device's module clock.
246          */
247         if (of_property_read_bool(np, "clocks")) {
248                 clk = of_clk_get(np, 0);
249                 if (IS_ERR(clk)) {
250                         ret = PTR_ERR(clk);
251                         return ret;
252                 }
253
254                 dai->sysclk = clk_get_rate(clk);
255                 dai->clk = clk;
256         } else if (!of_property_read_u32(np, "system-clock-frequency", &val)) {
257                 dai->sysclk = val;
258         } else {
259                 clk = of_clk_get(args.np, 0);
260                 if (!IS_ERR(clk))
261                         dai->sysclk = clk_get_rate(clk);
262         }
263
264         return 0;
265 }
266
267 static int asoc_simple_card_parse_daifmt(struct device_node *node,
268                                          struct simple_card_data *priv,
269                                          struct device_node *codec,
270                                          char *prefix, int idx)
271 {
272         struct device *dev = simple_priv_to_dev(priv);
273         struct device_node *bitclkmaster = NULL;
274         struct device_node *framemaster = NULL;
275         struct simple_dai_props *dai_props = simple_priv_to_props(priv, idx);
276         struct asoc_simple_dai *cpu_dai = &dai_props->cpu_dai;
277         struct asoc_simple_dai *codec_dai = &dai_props->codec_dai;
278         unsigned int daifmt;
279
280         daifmt = snd_soc_of_parse_daifmt(node, prefix,
281                                          &bitclkmaster, &framemaster);
282         daifmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
283
284         if (strlen(prefix) && !bitclkmaster && !framemaster) {
285                 /*
286                  * No dai-link level and master setting was not found from
287                  * sound node level, revert back to legacy DT parsing and
288                  * take the settings from codec node.
289                  */
290                 dev_dbg(dev, "Revert to legacy daifmt parsing\n");
291
292                 cpu_dai->fmt = codec_dai->fmt =
293                         snd_soc_of_parse_daifmt(codec, NULL, NULL, NULL) |
294                         (daifmt & ~SND_SOC_DAIFMT_CLOCK_MASK);
295         } else {
296                 if (codec == bitclkmaster)
297                         daifmt |= (codec == framemaster) ?
298                                 SND_SOC_DAIFMT_CBM_CFM : SND_SOC_DAIFMT_CBM_CFS;
299                 else
300                         daifmt |= (codec == framemaster) ?
301                                 SND_SOC_DAIFMT_CBS_CFM : SND_SOC_DAIFMT_CBS_CFS;
302
303                 cpu_dai->fmt    = daifmt;
304                 codec_dai->fmt  = daifmt;
305         }
306
307         of_node_put(bitclkmaster);
308         of_node_put(framemaster);
309
310         return 0;
311 }
312
313 static int asoc_simple_card_dai_link_of(struct device_node *node,
314                                         struct simple_card_data *priv,
315                                         int idx,
316                                         bool is_top_level_node)
317 {
318         struct device *dev = simple_priv_to_dev(priv);
319         struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, idx);
320         struct simple_dai_props *dai_props = simple_priv_to_props(priv, idx);
321         struct device_node *cpu = NULL;
322         struct device_node *codec = NULL;
323         char *name;
324         char prop[128];
325         char *prefix = "";
326         int ret, cpu_args;
327
328         /* For single DAI link & old style of DT node */
329         if (is_top_level_node)
330                 prefix = "simple-audio-card,";
331
332         snprintf(prop, sizeof(prop), "%scpu", prefix);
333         cpu = of_get_child_by_name(node, prop);
334
335         snprintf(prop, sizeof(prop), "%scodec", prefix);
336         codec = of_get_child_by_name(node, prop);
337
338         if (!cpu || !codec) {
339                 ret = -EINVAL;
340                 dev_err(dev, "%s: Can't find %s DT node\n", __func__, prop);
341                 goto dai_link_of_err;
342         }
343
344         ret = asoc_simple_card_parse_daifmt(node, priv,
345                                             codec, prefix, idx);
346         if (ret < 0)
347                 goto dai_link_of_err;
348
349         ret = asoc_simple_card_sub_parse_of(cpu, &dai_props->cpu_dai,
350                                             &dai_link->cpu_of_node,
351                                             &dai_link->cpu_dai_name,
352                                             &cpu_args);
353         if (ret < 0)
354                 goto dai_link_of_err;
355
356         ret = asoc_simple_card_sub_parse_of(codec, &dai_props->codec_dai,
357                                             &dai_link->codec_of_node,
358                                             &dai_link->codec_dai_name, NULL);
359         if (ret < 0)
360                 goto dai_link_of_err;
361
362         if (!dai_link->cpu_dai_name || !dai_link->codec_dai_name) {
363                 ret = -EINVAL;
364                 goto dai_link_of_err;
365         }
366
367         /* Simple Card assumes platform == cpu */
368         dai_link->platform_of_node = dai_link->cpu_of_node;
369
370         /* DAI link name is created from CPU/CODEC dai name */
371         name = devm_kzalloc(dev,
372                             strlen(dai_link->cpu_dai_name)   +
373                             strlen(dai_link->codec_dai_name) + 2,
374                             GFP_KERNEL);
375         sprintf(name, "%s-%s", dai_link->cpu_dai_name,
376                                 dai_link->codec_dai_name);
377         dai_link->name = dai_link->stream_name = name;
378         dai_link->ops = &asoc_simple_card_ops;
379         dai_link->init = asoc_simple_card_dai_init;
380
381         dev_dbg(dev, "\tname : %s\n", dai_link->stream_name);
382         dev_dbg(dev, "\tcpu : %s / %04x / %d\n",
383                 dai_link->cpu_dai_name,
384                 dai_props->cpu_dai.fmt,
385                 dai_props->cpu_dai.sysclk);
386         dev_dbg(dev, "\tcodec : %s / %04x / %d\n",
387                 dai_link->codec_dai_name,
388                 dai_props->codec_dai.fmt,
389                 dai_props->codec_dai.sysclk);
390
391         /*
392          * In soc_bind_dai_link() will check cpu name after
393          * of_node matching if dai_link has cpu_dai_name.
394          * but, it will never match if name was created by
395          * fmt_single_name() remove cpu_dai_name if cpu_args
396          * was 0. See:
397          *      fmt_single_name()
398          *      fmt_multiple_name()
399          */
400         if (!cpu_args)
401                 dai_link->cpu_dai_name = NULL;
402
403 dai_link_of_err:
404         of_node_put(cpu);
405         of_node_put(codec);
406
407         return ret;
408 }
409
410 static int asoc_simple_card_parse_of(struct device_node *node,
411                                      struct simple_card_data *priv)
412 {
413         struct device *dev = simple_priv_to_dev(priv);
414         enum of_gpio_flags flags;
415         u32 val;
416         int ret;
417
418         if (!node)
419                 return -EINVAL;
420
421         /* Parse the card name from DT */
422         snd_soc_of_parse_card_name(&priv->snd_card, "simple-audio-card,name");
423
424         /* The off-codec widgets */
425         if (of_property_read_bool(node, "simple-audio-card,widgets")) {
426                 ret = snd_soc_of_parse_audio_simple_widgets(&priv->snd_card,
427                                         "simple-audio-card,widgets");
428                 if (ret)
429                         return ret;
430         }
431
432         /* DAPM routes */
433         if (of_property_read_bool(node, "simple-audio-card,routing")) {
434                 ret = snd_soc_of_parse_audio_routing(&priv->snd_card,
435                                         "simple-audio-card,routing");
436                 if (ret)
437                         return ret;
438         }
439
440         /* Factor to mclk, used in hw_params() */
441         ret = of_property_read_u32(node, "simple-audio-card,mclk-fs", &val);
442         if (ret == 0)
443                 priv->mclk_fs = val;
444
445         dev_dbg(dev, "New simple-card: %s\n", priv->snd_card.name ?
446                 priv->snd_card.name : "");
447
448         /* Single/Muti DAI link(s) & New style of DT node */
449         if (of_get_child_by_name(node, "simple-audio-card,dai-link")) {
450                 struct device_node *np = NULL;
451                 int i = 0;
452
453                 for_each_child_of_node(node, np) {
454                         dev_dbg(dev, "\tlink %d:\n", i);
455                         ret = asoc_simple_card_dai_link_of(np, priv,
456                                                            i, false);
457                         if (ret < 0) {
458                                 of_node_put(np);
459                                 return ret;
460                         }
461                         i++;
462                 }
463         } else {
464                 /* For single DAI link & old style of DT node */
465                 ret = asoc_simple_card_dai_link_of(node, priv, 0, true);
466                 if (ret < 0)
467                         return ret;
468         }
469
470         priv->gpio_hp_det = of_get_named_gpio_flags(node,
471                                 "simple-audio-card,hp-det-gpio", 0, &flags);
472         priv->gpio_hp_det_invert = !!(flags & OF_GPIO_ACTIVE_LOW);
473         if (priv->gpio_hp_det == -EPROBE_DEFER)
474                 return -EPROBE_DEFER;
475
476         priv->gpio_mic_det = of_get_named_gpio_flags(node,
477                                 "simple-audio-card,mic-det-gpio", 0, &flags);
478         priv->gpio_mic_det_invert = !!(flags & OF_GPIO_ACTIVE_LOW);
479         if (priv->gpio_mic_det == -EPROBE_DEFER)
480                 return -EPROBE_DEFER;
481
482         if (!priv->snd_card.name)
483                 priv->snd_card.name = priv->snd_card.dai_link->name;
484
485         return 0;
486 }
487
488 /* Decrease the reference count of the device nodes */
489 static int asoc_simple_card_unref(struct snd_soc_card *card)
490 {
491         struct snd_soc_dai_link *dai_link;
492         int num_links;
493
494         for (num_links = 0, dai_link = card->dai_link;
495              num_links < card->num_links;
496              num_links++, dai_link++) {
497                 of_node_put(dai_link->cpu_of_node);
498                 of_node_put(dai_link->codec_of_node);
499         }
500         return 0;
501 }
502
503 static int asoc_simple_card_probe(struct platform_device *pdev)
504 {
505         struct simple_card_data *priv;
506         struct snd_soc_dai_link *dai_link;
507         struct device_node *np = pdev->dev.of_node;
508         struct device *dev = &pdev->dev;
509         int num_links, ret;
510
511         /* Get the number of DAI links */
512         if (np && of_get_child_by_name(np, "simple-audio-card,dai-link"))
513                 num_links = of_get_child_count(np);
514         else
515                 num_links = 1;
516
517         /* Allocate the private data and the DAI link array */
518         priv = devm_kzalloc(dev,
519                         sizeof(*priv) + sizeof(*dai_link) * num_links,
520                         GFP_KERNEL);
521         if (!priv)
522                 return -ENOMEM;
523
524         /* Init snd_soc_card */
525         priv->snd_card.owner = THIS_MODULE;
526         priv->snd_card.dev = dev;
527         dai_link = priv->dai_link;
528         priv->snd_card.dai_link = dai_link;
529         priv->snd_card.num_links = num_links;
530
531         priv->gpio_hp_det = -ENOENT;
532         priv->gpio_mic_det = -ENOENT;
533
534         /* Get room for the other properties */
535         priv->dai_props = devm_kzalloc(dev,
536                         sizeof(*priv->dai_props) * num_links,
537                         GFP_KERNEL);
538         if (!priv->dai_props)
539                 return -ENOMEM;
540
541         if (np && of_device_is_available(np)) {
542
543                 ret = asoc_simple_card_parse_of(np, priv);
544                 if (ret < 0) {
545                         if (ret != -EPROBE_DEFER)
546                                 dev_err(dev, "parse error %d\n", ret);
547                         goto err;
548                 }
549
550         } else {
551                 struct asoc_simple_card_info *cinfo;
552
553                 cinfo = dev->platform_data;
554                 if (!cinfo) {
555                         dev_err(dev, "no info for asoc-simple-card\n");
556                         return -EINVAL;
557                 }
558
559                 if (!cinfo->name ||
560                     !cinfo->codec_dai.name ||
561                     !cinfo->codec ||
562                     !cinfo->platform ||
563                     !cinfo->cpu_dai.name) {
564                         dev_err(dev, "insufficient asoc_simple_card_info settings\n");
565                         return -EINVAL;
566                 }
567
568                 priv->snd_card.name     = (cinfo->card) ? cinfo->card : cinfo->name;
569                 dai_link->name          = cinfo->name;
570                 dai_link->stream_name   = cinfo->name;
571                 dai_link->platform_name = cinfo->platform;
572                 dai_link->codec_name    = cinfo->codec;
573                 dai_link->cpu_dai_name  = cinfo->cpu_dai.name;
574                 dai_link->codec_dai_name = cinfo->codec_dai.name;
575                 dai_link->init          = asoc_simple_card_dai_init;
576                 memcpy(&priv->dai_props->cpu_dai, &cinfo->cpu_dai,
577                                         sizeof(priv->dai_props->cpu_dai));
578                 memcpy(&priv->dai_props->codec_dai, &cinfo->codec_dai,
579                                         sizeof(priv->dai_props->codec_dai));
580
581                 priv->dai_props->cpu_dai.fmt    |= cinfo->daifmt;
582                 priv->dai_props->codec_dai.fmt  |= cinfo->daifmt;
583         }
584
585         snd_soc_card_set_drvdata(&priv->snd_card, priv);
586
587         ret = devm_snd_soc_register_card(&pdev->dev, &priv->snd_card);
588         if (ret >= 0)
589                 return ret;
590
591 err:
592         asoc_simple_card_unref(&priv->snd_card);
593         return ret;
594 }
595
596 static int asoc_simple_card_remove(struct platform_device *pdev)
597 {
598         struct snd_soc_card *card = platform_get_drvdata(pdev);
599         struct simple_card_data *priv = snd_soc_card_get_drvdata(card);
600
601         if (gpio_is_valid(priv->gpio_hp_det))
602                 snd_soc_jack_free_gpios(&simple_card_hp_jack, 1,
603                                         &simple_card_hp_jack_gpio);
604         if (gpio_is_valid(priv->gpio_mic_det))
605                 snd_soc_jack_free_gpios(&simple_card_mic_jack, 1,
606                                         &simple_card_mic_jack_gpio);
607
608         return asoc_simple_card_unref(card);
609 }
610
611 static const struct of_device_id asoc_simple_of_match[] = {
612         { .compatible = "simple-audio-card", },
613         {},
614 };
615 MODULE_DEVICE_TABLE(of, asoc_simple_of_match);
616
617 static struct platform_driver asoc_simple_card = {
618         .driver = {
619                 .name = "asoc-simple-card",
620                 .of_match_table = asoc_simple_of_match,
621         },
622         .probe = asoc_simple_card_probe,
623         .remove = asoc_simple_card_remove,
624 };
625
626 module_platform_driver(asoc_simple_card);
627
628 MODULE_ALIAS("platform:asoc-simple-card");
629 MODULE_LICENSE("GPL");
630 MODULE_DESCRIPTION("ASoC Simple Sound Card");
631 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");