sound:starfive:pwmdac:Add runtime pm operation
[platform/kernel/linux-starfive.git] / sound / soc / soc-core.c
1 // SPDX-License-Identifier: GPL-2.0+
2 //
3 // soc-core.c  --  ALSA SoC Audio Layer
4 //
5 // Copyright 2005 Wolfson Microelectronics PLC.
6 // Copyright 2005 Openedhand Ltd.
7 // Copyright (C) 2010 Slimlogic Ltd.
8 // Copyright (C) 2010 Texas Instruments Inc.
9 //
10 // Author: Liam Girdwood <lrg@slimlogic.co.uk>
11 //         with code, comments and ideas from :-
12 //         Richard Purdie <richard@openedhand.com>
13 //
14 //  TODO:
15 //   o Add hw rules to enforce rates, etc.
16 //   o More testing with other codecs/machines.
17 //   o Add more codecs and platforms to ensure good API coverage.
18 //   o Support TDM on PCM and I2S
19
20 #include <linux/module.h>
21 #include <linux/moduleparam.h>
22 #include <linux/init.h>
23 #include <linux/delay.h>
24 #include <linux/pm.h>
25 #include <linux/bitops.h>
26 #include <linux/debugfs.h>
27 #include <linux/platform_device.h>
28 #include <linux/pinctrl/consumer.h>
29 #include <linux/ctype.h>
30 #include <linux/slab.h>
31 #include <linux/of.h>
32 #include <linux/of_graph.h>
33 #include <linux/dmi.h>
34 #include <linux/acpi.h>
35 #include <sound/core.h>
36 #include <sound/pcm.h>
37 #include <sound/pcm_params.h>
38 #include <sound/soc.h>
39 #include <sound/soc-dpcm.h>
40 #include <sound/soc-topology.h>
41 #include <sound/soc-link.h>
42 #include <sound/initval.h>
43
44 #define CREATE_TRACE_POINTS
45 #include <trace/events/asoc.h>
46
47 static DEFINE_MUTEX(client_mutex);
48 static LIST_HEAD(component_list);
49 static LIST_HEAD(unbind_card_list);
50
51 #define for_each_component(component)                   \
52         list_for_each_entry(component, &component_list, list)
53
54 /*
55  * This is used if driver don't need to have CPU/Codec/Platform
56  * dai_link. see soc.h
57  */
58 struct snd_soc_dai_link_component null_dailink_component[0];
59 EXPORT_SYMBOL_GPL(null_dailink_component);
60
61 /*
62  * This is a timeout to do a DAPM powerdown after a stream is closed().
63  * It can be used to eliminate pops between different playback streams, e.g.
64  * between two audio tracks.
65  */
66 static int pmdown_time = 5000;
67 module_param(pmdown_time, int, 0);
68 MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
69
70 static ssize_t pmdown_time_show(struct device *dev,
71                                 struct device_attribute *attr, char *buf)
72 {
73         struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
74
75         return sprintf(buf, "%ld\n", rtd->pmdown_time);
76 }
77
78 static ssize_t pmdown_time_store(struct device *dev,
79                                  struct device_attribute *attr,
80                                  const char *buf, size_t count)
81 {
82         struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
83         int ret;
84
85         ret = kstrtol(buf, 10, &rtd->pmdown_time);
86         if (ret)
87                 return ret;
88
89         return count;
90 }
91
92 static DEVICE_ATTR_RW(pmdown_time);
93
94 static struct attribute *soc_dev_attrs[] = {
95         &dev_attr_pmdown_time.attr,
96         NULL
97 };
98
99 static umode_t soc_dev_attr_is_visible(struct kobject *kobj,
100                                        struct attribute *attr, int idx)
101 {
102         struct device *dev = kobj_to_dev(kobj);
103         struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
104
105         if (!rtd)
106                 return 0;
107
108         if (attr == &dev_attr_pmdown_time.attr)
109                 return attr->mode; /* always visible */
110         return rtd->num_codecs ? attr->mode : 0; /* enabled only with codec */
111 }
112
113 static const struct attribute_group soc_dapm_dev_group = {
114         .attrs = soc_dapm_dev_attrs,
115         .is_visible = soc_dev_attr_is_visible,
116 };
117
118 static const struct attribute_group soc_dev_group = {
119         .attrs = soc_dev_attrs,
120         .is_visible = soc_dev_attr_is_visible,
121 };
122
123 static const struct attribute_group *soc_dev_attr_groups[] = {
124         &soc_dapm_dev_group,
125         &soc_dev_group,
126         NULL
127 };
128
129 #ifdef CONFIG_DEBUG_FS
130 struct dentry *snd_soc_debugfs_root;
131 EXPORT_SYMBOL_GPL(snd_soc_debugfs_root);
132
133 static void soc_init_component_debugfs(struct snd_soc_component *component)
134 {
135         if (!component->card->debugfs_card_root)
136                 return;
137
138         if (component->debugfs_prefix) {
139                 char *name;
140
141                 name = kasprintf(GFP_KERNEL, "%s:%s",
142                         component->debugfs_prefix, component->name);
143                 if (name) {
144                         component->debugfs_root = debugfs_create_dir(name,
145                                 component->card->debugfs_card_root);
146                         kfree(name);
147                 }
148         } else {
149                 component->debugfs_root = debugfs_create_dir(component->name,
150                                 component->card->debugfs_card_root);
151         }
152
153         snd_soc_dapm_debugfs_init(snd_soc_component_get_dapm(component),
154                 component->debugfs_root);
155 }
156
157 static void soc_cleanup_component_debugfs(struct snd_soc_component *component)
158 {
159         if (!component->debugfs_root)
160                 return;
161         debugfs_remove_recursive(component->debugfs_root);
162         component->debugfs_root = NULL;
163 }
164
165 static int dai_list_show(struct seq_file *m, void *v)
166 {
167         struct snd_soc_component *component;
168         struct snd_soc_dai *dai;
169
170         mutex_lock(&client_mutex);
171
172         for_each_component(component)
173                 for_each_component_dais(component, dai)
174                         seq_printf(m, "%s\n", dai->name);
175
176         mutex_unlock(&client_mutex);
177
178         return 0;
179 }
180 DEFINE_SHOW_ATTRIBUTE(dai_list);
181
182 static int component_list_show(struct seq_file *m, void *v)
183 {
184         struct snd_soc_component *component;
185
186         mutex_lock(&client_mutex);
187
188         for_each_component(component)
189                 seq_printf(m, "%s\n", component->name);
190
191         mutex_unlock(&client_mutex);
192
193         return 0;
194 }
195 DEFINE_SHOW_ATTRIBUTE(component_list);
196
197 static void soc_init_card_debugfs(struct snd_soc_card *card)
198 {
199         card->debugfs_card_root = debugfs_create_dir(card->name,
200                                                      snd_soc_debugfs_root);
201
202         debugfs_create_u32("dapm_pop_time", 0644, card->debugfs_card_root,
203                            &card->pop_time);
204
205         snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
206 }
207
208 static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
209 {
210         debugfs_remove_recursive(card->debugfs_card_root);
211         card->debugfs_card_root = NULL;
212 }
213
214 static void snd_soc_debugfs_init(void)
215 {
216         snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
217
218         debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
219                             &dai_list_fops);
220
221         debugfs_create_file("components", 0444, snd_soc_debugfs_root, NULL,
222                             &component_list_fops);
223 }
224
225 static void snd_soc_debugfs_exit(void)
226 {
227         debugfs_remove_recursive(snd_soc_debugfs_root);
228 }
229
230 #else
231
232 static inline void soc_init_component_debugfs(
233         struct snd_soc_component *component)
234 {
235 }
236
237 static inline void soc_cleanup_component_debugfs(
238         struct snd_soc_component *component)
239 {
240 }
241
242 static inline void soc_init_card_debugfs(struct snd_soc_card *card)
243 {
244 }
245
246 static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
247 {
248 }
249
250 static inline void snd_soc_debugfs_init(void)
251 {
252 }
253
254 static inline void snd_soc_debugfs_exit(void)
255 {
256 }
257
258 #endif
259
260 static int snd_soc_rtd_add_component(struct snd_soc_pcm_runtime *rtd,
261                                      struct snd_soc_component *component)
262 {
263         struct snd_soc_component *comp;
264         int i;
265
266         for_each_rtd_components(rtd, i, comp) {
267                 /* already connected */
268                 if (comp == component)
269                         return 0;
270         }
271
272         /* see for_each_rtd_components */
273         rtd->components[rtd->num_components] = component;
274         rtd->num_components++;
275
276         return 0;
277 }
278
279 struct snd_soc_component *snd_soc_rtdcom_lookup(struct snd_soc_pcm_runtime *rtd,
280                                                 const char *driver_name)
281 {
282         struct snd_soc_component *component;
283         int i;
284
285         if (!driver_name)
286                 return NULL;
287
288         /*
289          * NOTE
290          *
291          * snd_soc_rtdcom_lookup() will find component from rtd by using
292          * specified driver name.
293          * But, if many components which have same driver name are connected
294          * to 1 rtd, this function will return 1st found component.
295          */
296         for_each_rtd_components(rtd, i, component) {
297                 const char *component_name = component->driver->name;
298
299                 if (!component_name)
300                         continue;
301
302                 if ((component_name == driver_name) ||
303                     strcmp(component_name, driver_name) == 0)
304                         return component;
305         }
306
307         return NULL;
308 }
309 EXPORT_SYMBOL_GPL(snd_soc_rtdcom_lookup);
310
311 struct snd_soc_component
312 *snd_soc_lookup_component_nolocked(struct device *dev, const char *driver_name)
313 {
314         struct snd_soc_component *component;
315         struct snd_soc_component *found_component;
316
317         found_component = NULL;
318         for_each_component(component) {
319                 if ((dev == component->dev) &&
320                     (!driver_name ||
321                      (driver_name == component->driver->name) ||
322                      (strcmp(component->driver->name, driver_name) == 0))) {
323                         found_component = component;
324                         break;
325                 }
326         }
327
328         return found_component;
329 }
330 EXPORT_SYMBOL_GPL(snd_soc_lookup_component_nolocked);
331
332 struct snd_soc_component *snd_soc_lookup_component(struct device *dev,
333                                                    const char *driver_name)
334 {
335         struct snd_soc_component *component;
336
337         mutex_lock(&client_mutex);
338         component = snd_soc_lookup_component_nolocked(dev, driver_name);
339         mutex_unlock(&client_mutex);
340
341         return component;
342 }
343 EXPORT_SYMBOL_GPL(snd_soc_lookup_component);
344
345 struct snd_soc_pcm_runtime
346 *snd_soc_get_pcm_runtime(struct snd_soc_card *card,
347                          struct snd_soc_dai_link *dai_link)
348 {
349         struct snd_soc_pcm_runtime *rtd;
350
351         for_each_card_rtds(card, rtd) {
352                 if (rtd->dai_link == dai_link)
353                         return rtd;
354         }
355         dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link->name);
356         return NULL;
357 }
358 EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime);
359
360 /*
361  * Power down the audio subsystem pmdown_time msecs after close is called.
362  * This is to ensure there are no pops or clicks in between any music tracks
363  * due to DAPM power cycling.
364  */
365 void snd_soc_close_delayed_work(struct snd_soc_pcm_runtime *rtd)
366 {
367         struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
368         int playback = SNDRV_PCM_STREAM_PLAYBACK;
369
370         mutex_lock_nested(&rtd->card->pcm_mutex, rtd->card->pcm_subclass);
371
372         dev_dbg(rtd->dev,
373                 "ASoC: pop wq checking: %s status: %s waiting: %s\n",
374                 codec_dai->driver->playback.stream_name,
375                 snd_soc_dai_stream_active(codec_dai, playback) ?
376                 "active" : "inactive",
377                 rtd->pop_wait ? "yes" : "no");
378
379         /* are we waiting on this codec DAI stream */
380         if (rtd->pop_wait == 1) {
381                 rtd->pop_wait = 0;
382                 snd_soc_dapm_stream_event(rtd, playback,
383                                           SND_SOC_DAPM_STREAM_STOP);
384         }
385
386         mutex_unlock(&rtd->card->pcm_mutex);
387 }
388 EXPORT_SYMBOL_GPL(snd_soc_close_delayed_work);
389
390 static void soc_release_rtd_dev(struct device *dev)
391 {
392         /* "dev" means "rtd->dev" */
393         kfree(dev);
394 }
395
396 static void soc_free_pcm_runtime(struct snd_soc_pcm_runtime *rtd)
397 {
398         if (!rtd)
399                 return;
400
401         list_del(&rtd->list);
402
403         if (delayed_work_pending(&rtd->delayed_work))
404                 flush_delayed_work(&rtd->delayed_work);
405         snd_soc_pcm_component_free(rtd);
406
407         /*
408          * we don't need to call kfree() for rtd->dev
409          * see
410          *      soc_release_rtd_dev()
411          *
412          * We don't need rtd->dev NULL check, because
413          * it is alloced *before* rtd.
414          * see
415          *      soc_new_pcm_runtime()
416          *
417          * We don't need to mind freeing for rtd,
418          * because it was created from dev (= rtd->dev)
419          * see
420          *      soc_new_pcm_runtime()
421          *
422          *              rtd = devm_kzalloc(dev, ...);
423          *              rtd->dev = dev
424          */
425         device_unregister(rtd->dev);
426 }
427
428 static void close_delayed_work(struct work_struct *work) {
429         struct snd_soc_pcm_runtime *rtd =
430                         container_of(work, struct snd_soc_pcm_runtime,
431                                      delayed_work.work);
432
433         if (rtd->close_delayed_work_func)
434                 rtd->close_delayed_work_func(rtd);
435 }
436
437 static struct snd_soc_pcm_runtime *soc_new_pcm_runtime(
438         struct snd_soc_card *card, struct snd_soc_dai_link *dai_link)
439 {
440         struct snd_soc_pcm_runtime *rtd;
441         struct snd_soc_component *component;
442         struct device *dev;
443         int ret;
444         int stream;
445
446         /*
447          * for rtd->dev
448          */
449         dev = kzalloc(sizeof(struct device), GFP_KERNEL);
450         if (!dev)
451                 return NULL;
452
453         dev->parent     = card->dev;
454         dev->release    = soc_release_rtd_dev;
455
456         dev_set_name(dev, "%s", dai_link->name);
457
458         ret = device_register(dev);
459         if (ret < 0) {
460                 put_device(dev); /* soc_release_rtd_dev */
461                 return NULL;
462         }
463
464         /*
465          * for rtd
466          */
467         rtd = devm_kzalloc(dev,
468                            sizeof(*rtd) +
469                            sizeof(*component) * (dai_link->num_cpus +
470                                                  dai_link->num_codecs +
471                                                  dai_link->num_platforms),
472                            GFP_KERNEL);
473         if (!rtd) {
474                 device_unregister(dev);
475                 return NULL;
476         }
477
478         rtd->dev = dev;
479         INIT_LIST_HEAD(&rtd->list);
480         for_each_pcm_streams(stream) {
481                 INIT_LIST_HEAD(&rtd->dpcm[stream].be_clients);
482                 INIT_LIST_HEAD(&rtd->dpcm[stream].fe_clients);
483         }
484         dev_set_drvdata(dev, rtd);
485         INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
486
487         /*
488          * for rtd->dais
489          */
490         rtd->dais = devm_kcalloc(dev, dai_link->num_cpus + dai_link->num_codecs,
491                                         sizeof(struct snd_soc_dai *),
492                                         GFP_KERNEL);
493         if (!rtd->dais)
494                 goto free_rtd;
495
496         /*
497          * dais = [][][][][][][][][][][][][][][][][][]
498          *        ^cpu_dais         ^codec_dais
499          *        |--- num_cpus ---|--- num_codecs --|
500          * see
501          *      asoc_rtd_to_cpu()
502          *      asoc_rtd_to_codec()
503          */
504         rtd->num_cpus   = dai_link->num_cpus;
505         rtd->num_codecs = dai_link->num_codecs;
506         rtd->card       = card;
507         rtd->dai_link   = dai_link;
508         rtd->num        = card->num_rtd++;
509
510         /* see for_each_card_rtds */
511         list_add_tail(&rtd->list, &card->rtd_list);
512
513         ret = device_add_groups(dev, soc_dev_attr_groups);
514         if (ret < 0)
515                 goto free_rtd;
516
517         return rtd;
518
519 free_rtd:
520         soc_free_pcm_runtime(rtd);
521         return NULL;
522 }
523
524 static void snd_soc_flush_all_delayed_work(struct snd_soc_card *card)
525 {
526         struct snd_soc_pcm_runtime *rtd;
527
528         for_each_card_rtds(card, rtd)
529                 flush_delayed_work(&rtd->delayed_work);
530 }
531
532 #ifdef CONFIG_PM_SLEEP
533 static void soc_playback_digital_mute(struct snd_soc_card *card, int mute)
534 {
535         struct snd_soc_pcm_runtime *rtd;
536         struct snd_soc_dai *dai;
537         int playback = SNDRV_PCM_STREAM_PLAYBACK;
538         int i;
539
540         for_each_card_rtds(card, rtd) {
541
542                 if (rtd->dai_link->ignore_suspend)
543                         continue;
544
545                 for_each_rtd_dais(rtd, i, dai) {
546                         if (snd_soc_dai_stream_active(dai, playback))
547                                 snd_soc_dai_digital_mute(dai, mute, playback);
548                 }
549         }
550 }
551
552 static void soc_dapm_suspend_resume(struct snd_soc_card *card, int event)
553 {
554         struct snd_soc_pcm_runtime *rtd;
555         int stream;
556
557         for_each_card_rtds(card, rtd) {
558
559                 if (rtd->dai_link->ignore_suspend)
560                         continue;
561
562                 for_each_pcm_streams(stream)
563                         snd_soc_dapm_stream_event(rtd, stream, event);
564         }
565 }
566
567 /* powers down audio subsystem for suspend */
568 int snd_soc_suspend(struct device *dev)
569 {
570         struct snd_soc_card *card = dev_get_drvdata(dev);
571         struct snd_soc_component *component;
572         struct snd_soc_pcm_runtime *rtd;
573         int i;
574
575         /* If the card is not initialized yet there is nothing to do */
576         if (!card->instantiated)
577                 return 0;
578
579         /*
580          * Due to the resume being scheduled into a workqueue we could
581          * suspend before that's finished - wait for it to complete.
582          */
583         snd_power_wait(card->snd_card);
584
585         /* we're going to block userspace touching us until resume completes */
586         snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
587
588         /* mute any active DACs */
589         soc_playback_digital_mute(card, 1);
590
591         /* suspend all pcms */
592         for_each_card_rtds(card, rtd) {
593                 if (rtd->dai_link->ignore_suspend)
594                         continue;
595
596                 snd_pcm_suspend_all(rtd->pcm);
597         }
598
599         snd_soc_card_suspend_pre(card);
600
601         /* close any waiting streams */
602         snd_soc_flush_all_delayed_work(card);
603
604         soc_dapm_suspend_resume(card, SND_SOC_DAPM_STREAM_SUSPEND);
605
606         /* Recheck all endpoints too, their state is affected by suspend */
607         dapm_mark_endpoints_dirty(card);
608         snd_soc_dapm_sync(&card->dapm);
609
610         /* suspend all COMPONENTs */
611         for_each_card_rtds(card, rtd) {
612
613                 if (rtd->dai_link->ignore_suspend)
614                         continue;
615
616                 for_each_rtd_components(rtd, i, component) {
617                         struct snd_soc_dapm_context *dapm =
618                                 snd_soc_component_get_dapm(component);
619
620                         /*
621                          * ignore if component was already suspended
622                          */
623                         if (snd_soc_component_is_suspended(component))
624                                 continue;
625
626                         /*
627                          * If there are paths active then the COMPONENT will be
628                          * held with bias _ON and should not be suspended.
629                          */
630                         switch (snd_soc_dapm_get_bias_level(dapm)) {
631                         case SND_SOC_BIAS_STANDBY:
632                                 /*
633                                  * If the COMPONENT is capable of idle
634                                  * bias off then being in STANDBY
635                                  * means it's doing something,
636                                  * otherwise fall through.
637                                  */
638                                 if (dapm->idle_bias_off) {
639                                         dev_dbg(component->dev,
640                                                 "ASoC: idle_bias_off CODEC on over suspend\n");
641                                         break;
642                                 }
643                                 fallthrough;
644
645                         case SND_SOC_BIAS_OFF:
646                                 snd_soc_component_suspend(component);
647                                 if (component->regmap)
648                                         regcache_mark_dirty(component->regmap);
649                                 /* deactivate pins to sleep state */
650                                 pinctrl_pm_select_sleep_state(component->dev);
651                                 break;
652                         default:
653                                 dev_dbg(component->dev,
654                                         "ASoC: COMPONENT is on over suspend\n");
655                                 break;
656                         }
657                 }
658         }
659
660         snd_soc_card_suspend_post(card);
661
662         return 0;
663 }
664 EXPORT_SYMBOL_GPL(snd_soc_suspend);
665
666 /*
667  * deferred resume work, so resume can complete before we finished
668  * setting our codec back up, which can be very slow on I2C
669  */
670 static void soc_resume_deferred(struct work_struct *work)
671 {
672         struct snd_soc_card *card =
673                         container_of(work, struct snd_soc_card,
674                                      deferred_resume_work);
675         struct snd_soc_component *component;
676
677         /*
678          * our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
679          * so userspace apps are blocked from touching us
680          */
681
682         dev_dbg(card->dev, "ASoC: starting resume work\n");
683
684         /* Bring us up into D2 so that DAPM starts enabling things */
685         snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
686
687         snd_soc_card_resume_pre(card);
688
689         for_each_card_components(card, component) {
690                 if (snd_soc_component_is_suspended(component))
691                         snd_soc_component_resume(component);
692         }
693
694         soc_dapm_suspend_resume(card, SND_SOC_DAPM_STREAM_RESUME);
695
696         /* unmute any active DACs */
697         soc_playback_digital_mute(card, 0);
698
699         snd_soc_card_resume_post(card);
700
701         dev_dbg(card->dev, "ASoC: resume work completed\n");
702
703         /* Recheck all endpoints too, their state is affected by suspend */
704         dapm_mark_endpoints_dirty(card);
705         snd_soc_dapm_sync(&card->dapm);
706
707         /* userspace can access us now we are back as we were before */
708         snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
709 }
710
711 /* powers up audio subsystem after a suspend */
712 int snd_soc_resume(struct device *dev)
713 {
714         struct snd_soc_card *card = dev_get_drvdata(dev);
715         struct snd_soc_component *component;
716
717         /* If the card is not initialized yet there is nothing to do */
718         if (!card->instantiated)
719                 return 0;
720
721         /* activate pins from sleep state */
722         for_each_card_components(card, component)
723                 if (snd_soc_component_active(component))
724                         pinctrl_pm_select_default_state(component->dev);
725
726         dev_dbg(dev, "ASoC: Scheduling resume work\n");
727         if (!schedule_work(&card->deferred_resume_work))
728                 dev_err(dev, "ASoC: resume work item may be lost\n");
729
730         return 0;
731 }
732 EXPORT_SYMBOL_GPL(snd_soc_resume);
733
734 static void soc_resume_init(struct snd_soc_card *card)
735 {
736         /* deferred resume work */
737         INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
738 }
739 #else
740 #define snd_soc_suspend NULL
741 #define snd_soc_resume NULL
742 static inline void soc_resume_init(struct snd_soc_card *card)
743 {
744 }
745 #endif
746
747 static struct device_node
748 *soc_component_to_node(struct snd_soc_component *component)
749 {
750         struct device_node *of_node;
751
752         of_node = component->dev->of_node;
753         if (!of_node && component->dev->parent)
754                 of_node = component->dev->parent->of_node;
755
756         return of_node;
757 }
758
759 static int snd_soc_is_matching_component(
760         const struct snd_soc_dai_link_component *dlc,
761         struct snd_soc_component *component)
762 {
763         struct device_node *component_of_node;
764
765         if (!dlc)
766                 return 0;
767
768         component_of_node = soc_component_to_node(component);
769
770         if (dlc->of_node && component_of_node != dlc->of_node)
771                 return 0;
772         if (dlc->name && strcmp(component->name, dlc->name))
773                 return 0;
774
775         return 1;
776 }
777
778 static struct snd_soc_component *soc_find_component(
779         const struct snd_soc_dai_link_component *dlc)
780 {
781         struct snd_soc_component *component;
782
783         lockdep_assert_held(&client_mutex);
784
785         /*
786          * NOTE
787          *
788          * It returns *1st* found component, but some driver
789          * has few components by same of_node/name
790          * ex)
791          *      CPU component and generic DMAEngine component
792          */
793         for_each_component(component)
794                 if (snd_soc_is_matching_component(dlc, component))
795                         return component;
796
797         return NULL;
798 }
799
800 /**
801  * snd_soc_find_dai - Find a registered DAI
802  *
803  * @dlc: name of the DAI or the DAI driver and optional component info to match
804  *
805  * This function will search all registered components and their DAIs to
806  * find the DAI of the same name. The component's of_node and name
807  * should also match if being specified.
808  *
809  * Return: pointer of DAI, or NULL if not found.
810  */
811 struct snd_soc_dai *snd_soc_find_dai(
812         const struct snd_soc_dai_link_component *dlc)
813 {
814         struct snd_soc_component *component;
815         struct snd_soc_dai *dai;
816
817         lockdep_assert_held(&client_mutex);
818
819         /* Find CPU DAI from registered DAIs */
820         for_each_component(component) {
821                 if (!snd_soc_is_matching_component(dlc, component))
822                         continue;
823                 for_each_component_dais(component, dai) {
824                         if (dlc->dai_name && strcmp(dai->name, dlc->dai_name)
825                             && (!dai->driver->name
826                                 || strcmp(dai->driver->name, dlc->dai_name)))
827                                 continue;
828
829                         return dai;
830                 }
831         }
832
833         return NULL;
834 }
835 EXPORT_SYMBOL_GPL(snd_soc_find_dai);
836
837 struct snd_soc_dai *snd_soc_find_dai_with_mutex(
838         const struct snd_soc_dai_link_component *dlc)
839 {
840         struct snd_soc_dai *dai;
841
842         mutex_lock(&client_mutex);
843         dai = snd_soc_find_dai(dlc);
844         mutex_unlock(&client_mutex);
845
846         return dai;
847 }
848 EXPORT_SYMBOL_GPL(snd_soc_find_dai_with_mutex);
849
850 static int soc_dai_link_sanity_check(struct snd_soc_card *card,
851                                      struct snd_soc_dai_link *link)
852 {
853         int i;
854         struct snd_soc_dai_link_component *cpu, *codec, *platform;
855
856         for_each_link_codecs(link, i, codec) {
857                 /*
858                  * Codec must be specified by 1 of name or OF node,
859                  * not both or neither.
860                  */
861                 if (!!codec->name == !!codec->of_node) {
862                         dev_err(card->dev, "ASoC: Neither/both codec name/of_node are set for %s\n",
863                                 link->name);
864                         return -EINVAL;
865                 }
866
867                 /* Codec DAI name must be specified */
868                 if (!codec->dai_name) {
869                         dev_err(card->dev, "ASoC: codec_dai_name not set for %s\n",
870                                 link->name);
871                         return -EINVAL;
872                 }
873
874                 /*
875                  * Defer card registration if codec component is not added to
876                  * component list.
877                  */
878                 if (!soc_find_component(codec)) {
879                         dev_dbg(card->dev,
880                                 "ASoC: codec component %s not found for link %s\n",
881                                 codec->name, link->name);
882                         return -EPROBE_DEFER;
883                 }
884         }
885
886         for_each_link_platforms(link, i, platform) {
887                 /*
888                  * Platform may be specified by either name or OF node, but it
889                  * can be left unspecified, then no components will be inserted
890                  * in the rtdcom list
891                  */
892                 if (!!platform->name == !!platform->of_node) {
893                         dev_err(card->dev,
894                                 "ASoC: Neither/both platform name/of_node are set for %s\n",
895                                 link->name);
896                         return -EINVAL;
897                 }
898
899                 /*
900                  * Defer card registration if platform component is not added to
901                  * component list.
902                  */
903                 if (!soc_find_component(platform)) {
904                         dev_dbg(card->dev,
905                                 "ASoC: platform component %s not found for link %s\n",
906                                 platform->name, link->name);
907                         return -EPROBE_DEFER;
908                 }
909         }
910
911         for_each_link_cpus(link, i, cpu) {
912                 /*
913                  * CPU device may be specified by either name or OF node, but
914                  * can be left unspecified, and will be matched based on DAI
915                  * name alone..
916                  */
917                 if (cpu->name && cpu->of_node) {
918                         dev_err(card->dev,
919                                 "ASoC: Neither/both cpu name/of_node are set for %s\n",
920                                 link->name);
921                         return -EINVAL;
922                 }
923
924                 /*
925                  * Defer card registration if cpu dai component is not added to
926                  * component list.
927                  */
928                 if ((cpu->of_node || cpu->name) &&
929                     !soc_find_component(cpu)) {
930                         dev_dbg(card->dev,
931                                 "ASoC: cpu component %s not found for link %s\n",
932                                 cpu->name, link->name);
933                         return -EPROBE_DEFER;
934                 }
935
936                 /*
937                  * At least one of CPU DAI name or CPU device name/node must be
938                  * specified
939                  */
940                 if (!cpu->dai_name &&
941                     !(cpu->name || cpu->of_node)) {
942                         dev_err(card->dev,
943                                 "ASoC: Neither cpu_dai_name nor cpu_name/of_node are set for %s\n",
944                                 link->name);
945                         return -EINVAL;
946                 }
947         }
948
949         return 0;
950 }
951
952 /**
953  * snd_soc_remove_pcm_runtime - Remove a pcm_runtime from card
954  * @card: The ASoC card to which the pcm_runtime has
955  * @rtd: The pcm_runtime to remove
956  *
957  * This function removes a pcm_runtime from the ASoC card.
958  */
959 void snd_soc_remove_pcm_runtime(struct snd_soc_card *card,
960                                 struct snd_soc_pcm_runtime *rtd)
961 {
962         lockdep_assert_held(&client_mutex);
963
964         /* release machine specific resources */
965         snd_soc_link_exit(rtd);
966
967         /*
968          * Notify the machine driver for extra destruction
969          */
970         snd_soc_card_remove_dai_link(card, rtd->dai_link);
971
972         soc_free_pcm_runtime(rtd);
973 }
974 EXPORT_SYMBOL_GPL(snd_soc_remove_pcm_runtime);
975
976 /**
977  * snd_soc_add_pcm_runtime - Add a pcm_runtime dynamically via dai_link
978  * @card: The ASoC card to which the pcm_runtime is added
979  * @dai_link: The DAI link to find pcm_runtime
980  *
981  * This function adds a pcm_runtime ASoC card by using dai_link.
982  *
983  * Note: Topology can use this API to add pcm_runtime when probing the
984  * topology component. And machine drivers can still define static
985  * DAI links in dai_link array.
986  */
987 int snd_soc_add_pcm_runtime(struct snd_soc_card *card,
988                             struct snd_soc_dai_link *dai_link)
989 {
990         struct snd_soc_pcm_runtime *rtd;
991         struct snd_soc_dai_link_component *codec, *platform, *cpu;
992         struct snd_soc_component *component;
993         int i, ret;
994
995         lockdep_assert_held(&client_mutex);
996
997         /*
998          * Notify the machine driver for extra initialization
999          */
1000         ret = snd_soc_card_add_dai_link(card, dai_link);
1001         if (ret < 0)
1002                 return ret;
1003
1004         if (dai_link->ignore)
1005                 return 0;
1006
1007         dev_dbg(card->dev, "ASoC: binding %s\n", dai_link->name);
1008
1009         ret = soc_dai_link_sanity_check(card, dai_link);
1010         if (ret < 0)
1011                 return ret;
1012
1013         rtd = soc_new_pcm_runtime(card, dai_link);
1014         if (!rtd)
1015                 return -ENOMEM;
1016
1017         for_each_link_cpus(dai_link, i, cpu) {
1018                 asoc_rtd_to_cpu(rtd, i) = snd_soc_find_dai(cpu);
1019                 if (!asoc_rtd_to_cpu(rtd, i)) {
1020                         dev_info(card->dev, "ASoC: CPU DAI %s not registered\n",
1021                                  cpu->dai_name);
1022                         goto _err_defer;
1023                 }
1024                 snd_soc_rtd_add_component(rtd, asoc_rtd_to_cpu(rtd, i)->component);
1025         }
1026
1027         /* Find CODEC from registered CODECs */
1028         for_each_link_codecs(dai_link, i, codec) {
1029                 asoc_rtd_to_codec(rtd, i) = snd_soc_find_dai(codec);
1030                 if (!asoc_rtd_to_codec(rtd, i)) {
1031                         dev_info(card->dev, "ASoC: CODEC DAI %s not registered\n",
1032                                  codec->dai_name);
1033                         goto _err_defer;
1034                 }
1035
1036                 snd_soc_rtd_add_component(rtd, asoc_rtd_to_codec(rtd, i)->component);
1037         }
1038
1039         /* Find PLATFORM from registered PLATFORMs */
1040         for_each_link_platforms(dai_link, i, platform) {
1041                 for_each_component(component) {
1042                         if (!snd_soc_is_matching_component(platform, component))
1043                                 continue;
1044
1045                         snd_soc_rtd_add_component(rtd, component);
1046                 }
1047         }
1048
1049         return 0;
1050
1051 _err_defer:
1052         snd_soc_remove_pcm_runtime(card, rtd);
1053         return -EPROBE_DEFER;
1054 }
1055 EXPORT_SYMBOL_GPL(snd_soc_add_pcm_runtime);
1056
1057 static void snd_soc_runtime_get_dai_fmt(struct snd_soc_pcm_runtime *rtd)
1058 {
1059         struct snd_soc_dai_link *dai_link = rtd->dai_link;
1060         struct snd_soc_dai *dai, *not_used;
1061         struct device *dev = rtd->dev;
1062         u64 pos, possible_fmt;
1063         unsigned int mask = 0, dai_fmt = 0;
1064         int i, j, priority, pri, until;
1065
1066         /*
1067          * Get selectable format from each DAIs.
1068          *
1069          ****************************
1070          *            NOTE
1071          * Using .auto_selectable_formats is not mandatory,
1072          * we can select format manually from Sound Card.
1073          * When use it, driver should list well tested format only.
1074          ****************************
1075          *
1076          * ex)
1077          *      auto_selectable_formats (= SND_SOC_POSSIBLE_xxx)
1078          *               (A)     (B)     (C)
1079          *      DAI0_: { 0x000F, 0x00F0, 0x0F00 };
1080          *      DAI1 : { 0xF000, 0x0F00 };
1081          *               (X)     (Y)
1082          *
1083          * "until" will be 3 in this case (MAX array size from DAI0 and DAI1)
1084          * Here is dev_dbg() message and comments
1085          *
1086          * priority = 1
1087          * DAI0: (pri, fmt) = (1, 000000000000000F) // 1st check (A) DAI1 is not selected
1088          * DAI1: (pri, fmt) = (0, 0000000000000000) //               Necessary Waste
1089          * DAI0: (pri, fmt) = (1, 000000000000000F) // 2nd check (A)
1090          * DAI1: (pri, fmt) = (1, 000000000000F000) //           (X)
1091          * priority = 2
1092          * DAI0: (pri, fmt) = (2, 00000000000000FF) // 3rd check (A) + (B)
1093          * DAI1: (pri, fmt) = (1, 000000000000F000) //           (X)
1094          * DAI0: (pri, fmt) = (2, 00000000000000FF) // 4th check (A) + (B)
1095          * DAI1: (pri, fmt) = (2, 000000000000FF00) //           (X) + (Y)
1096          * priority = 3
1097          * DAI0: (pri, fmt) = (3, 0000000000000FFF) // 5th check (A) + (B) + (C)
1098          * DAI1: (pri, fmt) = (2, 000000000000FF00) //           (X) + (Y)
1099          * found auto selected format: 0000000000000F00
1100          */
1101         until = snd_soc_dai_get_fmt_max_priority(rtd);
1102         for (priority = 1; priority <= until; priority++) {
1103
1104                 dev_dbg(dev, "priority = %d\n", priority);
1105                 for_each_rtd_dais(rtd, j, not_used) {
1106
1107                         possible_fmt = ULLONG_MAX;
1108                         for_each_rtd_dais(rtd, i, dai) {
1109                                 u64 fmt = 0;
1110
1111                                 pri = (j >= i) ? priority : priority - 1;
1112                                 fmt = snd_soc_dai_get_fmt(dai, pri);
1113                                 dev_dbg(dev, "%s: (pri, fmt) = (%d, %016llX)\n", dai->name, pri, fmt);
1114                                 possible_fmt &= fmt;
1115                         }
1116                         if (possible_fmt)
1117                                 goto found;
1118                 }
1119         }
1120         /* Not Found */
1121         return;
1122 found:
1123         dev_dbg(dev, "found auto selected format: %016llX\n", possible_fmt);
1124
1125         /*
1126          * convert POSSIBLE_DAIFMT to DAIFMT
1127          *
1128          * Some basic/default settings on each is defined as 0.
1129          * see
1130          *      SND_SOC_DAIFMT_NB_NF
1131          *      SND_SOC_DAIFMT_GATED
1132          *
1133          * SND_SOC_DAIFMT_xxx_MASK can't notice it if Sound Card specify
1134          * these value, and will be overwrite to auto selected value.
1135          *
1136          * To avoid such issue, loop from 63 to 0 here.
1137          * Small number of SND_SOC_POSSIBLE_xxx will be Hi priority.
1138          * Basic/Default settings of each part and aboves are defined
1139          * as Hi priority (= small number) of SND_SOC_POSSIBLE_xxx.
1140          */
1141         for (i = 63; i >= 0; i--) {
1142                 pos = 1ULL << i;
1143                 switch (possible_fmt & pos) {
1144                 /*
1145                  * for format
1146                  */
1147                 case SND_SOC_POSSIBLE_DAIFMT_I2S:
1148                 case SND_SOC_POSSIBLE_DAIFMT_RIGHT_J:
1149                 case SND_SOC_POSSIBLE_DAIFMT_LEFT_J:
1150                 case SND_SOC_POSSIBLE_DAIFMT_DSP_A:
1151                 case SND_SOC_POSSIBLE_DAIFMT_DSP_B:
1152                 case SND_SOC_POSSIBLE_DAIFMT_AC97:
1153                 case SND_SOC_POSSIBLE_DAIFMT_PDM:
1154                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_FORMAT_MASK) | i;
1155                         break;
1156                 /*
1157                  * for clock
1158                  */
1159                 case SND_SOC_POSSIBLE_DAIFMT_CONT:
1160                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_CLOCK_MASK) | SND_SOC_DAIFMT_CONT;
1161                         break;
1162                 case SND_SOC_POSSIBLE_DAIFMT_GATED:
1163                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_CLOCK_MASK) | SND_SOC_DAIFMT_GATED;
1164                         break;
1165                 /*
1166                  * for clock invert
1167                  */
1168                 case SND_SOC_POSSIBLE_DAIFMT_NB_NF:
1169                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_INV_MASK) | SND_SOC_DAIFMT_NB_NF;
1170                         break;
1171                 case SND_SOC_POSSIBLE_DAIFMT_NB_IF:
1172                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_INV_MASK) | SND_SOC_DAIFMT_NB_IF;
1173                         break;
1174                 case SND_SOC_POSSIBLE_DAIFMT_IB_NF:
1175                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_INV_MASK) | SND_SOC_DAIFMT_IB_NF;
1176                         break;
1177                 case SND_SOC_POSSIBLE_DAIFMT_IB_IF:
1178                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_INV_MASK) | SND_SOC_DAIFMT_IB_IF;
1179                         break;
1180                 /*
1181                  * for clock provider / consumer
1182                  */
1183                 case SND_SOC_POSSIBLE_DAIFMT_CBP_CFP:
1184                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) | SND_SOC_DAIFMT_CBP_CFP;
1185                         break;
1186                 case SND_SOC_POSSIBLE_DAIFMT_CBC_CFP:
1187                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) | SND_SOC_DAIFMT_CBC_CFP;
1188                         break;
1189                 case SND_SOC_POSSIBLE_DAIFMT_CBP_CFC:
1190                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) | SND_SOC_DAIFMT_CBP_CFC;
1191                         break;
1192                 case SND_SOC_POSSIBLE_DAIFMT_CBC_CFC:
1193                         dai_fmt = (dai_fmt & ~SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) | SND_SOC_DAIFMT_CBC_CFC;
1194                         break;
1195                 }
1196         }
1197
1198         /*
1199          * Some driver might have very complex limitation.
1200          * In such case, user want to auto-select non-limitation part,
1201          * and want to manually specify complex part.
1202          *
1203          * Or for example, if both CPU and Codec can be clock provider,
1204          * but because of its quality, user want to specify it manually.
1205          *
1206          * Use manually specified settings if sound card did.
1207          */
1208         if (!(dai_link->dai_fmt & SND_SOC_DAIFMT_FORMAT_MASK))
1209                 mask |= SND_SOC_DAIFMT_FORMAT_MASK;
1210         if (!(dai_link->dai_fmt & SND_SOC_DAIFMT_CLOCK_MASK))
1211                 mask |= SND_SOC_DAIFMT_CLOCK_MASK;
1212         if (!(dai_link->dai_fmt & SND_SOC_DAIFMT_INV_MASK))
1213                 mask |= SND_SOC_DAIFMT_INV_MASK;
1214         if (!(dai_link->dai_fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK))
1215                 mask |= SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK;
1216
1217         dai_link->dai_fmt |= (dai_fmt & mask);
1218 }
1219
1220 /**
1221  * snd_soc_runtime_set_dai_fmt() - Change DAI link format for a ASoC runtime
1222  * @rtd: The runtime for which the DAI link format should be changed
1223  * @dai_fmt: The new DAI link format
1224  *
1225  * This function updates the DAI link format for all DAIs connected to the DAI
1226  * link for the specified runtime.
1227  *
1228  * Note: For setups with a static format set the dai_fmt field in the
1229  * corresponding snd_dai_link struct instead of using this function.
1230  *
1231  * Returns 0 on success, otherwise a negative error code.
1232  */
1233 int snd_soc_runtime_set_dai_fmt(struct snd_soc_pcm_runtime *rtd,
1234                                 unsigned int dai_fmt)
1235 {
1236         struct snd_soc_dai *cpu_dai;
1237         struct snd_soc_dai *codec_dai;
1238         unsigned int inv_dai_fmt;
1239         unsigned int i;
1240         int ret;
1241
1242         for_each_rtd_codec_dais(rtd, i, codec_dai) {
1243                 ret = snd_soc_dai_set_fmt(codec_dai, dai_fmt);
1244                 if (ret != 0 && ret != -ENOTSUPP)
1245                         return ret;
1246         }
1247
1248         /*
1249          * Flip the polarity for the "CPU" end of a CODEC<->CODEC link
1250          * the component which has non_legacy_dai_naming is Codec
1251          */
1252         inv_dai_fmt = snd_soc_daifmt_clock_provider_fliped(dai_fmt);
1253
1254         for_each_rtd_cpu_dais(rtd, i, cpu_dai) {
1255                 unsigned int fmt = dai_fmt;
1256
1257                 if (cpu_dai->component->driver->non_legacy_dai_naming)
1258                         fmt = inv_dai_fmt;
1259
1260                 ret = snd_soc_dai_set_fmt(cpu_dai, fmt);
1261                 if (ret != 0 && ret != -ENOTSUPP)
1262                         return ret;
1263         }
1264
1265         return 0;
1266 }
1267 EXPORT_SYMBOL_GPL(snd_soc_runtime_set_dai_fmt);
1268
1269 static int soc_init_pcm_runtime(struct snd_soc_card *card,
1270                                 struct snd_soc_pcm_runtime *rtd)
1271 {
1272         struct snd_soc_dai_link *dai_link = rtd->dai_link;
1273         struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
1274         struct snd_soc_component *component;
1275         int ret, num, i;
1276
1277         /* set default power off timeout */
1278         rtd->pmdown_time = pmdown_time;
1279
1280         /* do machine specific initialization */
1281         ret = snd_soc_link_init(rtd);
1282         if (ret < 0)
1283                 return ret;
1284
1285         snd_soc_runtime_get_dai_fmt(rtd);
1286         if (dai_link->dai_fmt) {
1287                 ret = snd_soc_runtime_set_dai_fmt(rtd, dai_link->dai_fmt);
1288                 if (ret)
1289                         return ret;
1290         }
1291
1292         /* add DPCM sysfs entries */
1293         soc_dpcm_debugfs_add(rtd);
1294
1295         num = rtd->num;
1296
1297         /*
1298          * most drivers will register their PCMs using DAI link ordering but
1299          * topology based drivers can use the DAI link id field to set PCM
1300          * device number and then use rtd + a base offset of the BEs.
1301          */
1302         for_each_rtd_components(rtd, i, component) {
1303                 if (!component->driver->use_dai_pcm_id)
1304                         continue;
1305
1306                 if (rtd->dai_link->no_pcm)
1307                         num += component->driver->be_pcm_base;
1308                 else
1309                         num = rtd->dai_link->id;
1310         }
1311
1312         /* create compress_device if possible */
1313         ret = snd_soc_dai_compress_new(cpu_dai, rtd, num);
1314         if (ret != -ENOTSUPP)
1315                 return ret;
1316
1317         /* create the pcm */
1318         ret = soc_new_pcm(rtd, num);
1319         if (ret < 0) {
1320                 dev_err(card->dev, "ASoC: can't create pcm %s :%d\n",
1321                         dai_link->stream_name, ret);
1322                 return ret;
1323         }
1324
1325         return snd_soc_pcm_dai_new(rtd);
1326 }
1327
1328 static void soc_set_name_prefix(struct snd_soc_card *card,
1329                                 struct snd_soc_component *component)
1330 {
1331         struct device_node *of_node = soc_component_to_node(component);
1332         const char *str;
1333         int ret, i;
1334
1335         for (i = 0; i < card->num_configs; i++) {
1336                 struct snd_soc_codec_conf *map = &card->codec_conf[i];
1337
1338                 if (snd_soc_is_matching_component(&map->dlc, component) &&
1339                     map->name_prefix) {
1340                         component->name_prefix = map->name_prefix;
1341                         return;
1342                 }
1343         }
1344
1345         /*
1346          * If there is no configuration table or no match in the table,
1347          * check if a prefix is provided in the node
1348          */
1349         ret = of_property_read_string(of_node, "sound-name-prefix", &str);
1350         if (ret < 0)
1351                 return;
1352
1353         component->name_prefix = str;
1354 }
1355
1356 static void soc_remove_component(struct snd_soc_component *component,
1357                                  int probed)
1358 {
1359
1360         if (!component->card)
1361                 return;
1362
1363         if (probed)
1364                 snd_soc_component_remove(component);
1365
1366         /* For framework level robustness */
1367         snd_soc_component_set_jack(component, NULL, NULL);
1368
1369         list_del_init(&component->card_list);
1370         snd_soc_dapm_free(snd_soc_component_get_dapm(component));
1371         soc_cleanup_component_debugfs(component);
1372         component->card = NULL;
1373         snd_soc_component_module_put_when_remove(component);
1374 }
1375
1376 static int soc_probe_component(struct snd_soc_card *card,
1377                                struct snd_soc_component *component)
1378 {
1379         struct snd_soc_dapm_context *dapm =
1380                 snd_soc_component_get_dapm(component);
1381         struct snd_soc_dai *dai;
1382         int probed = 0;
1383         int ret;
1384
1385         if (snd_soc_component_is_dummy(component))
1386                 return 0;
1387
1388         if (component->card) {
1389                 if (component->card != card) {
1390                         dev_err(component->dev,
1391                                 "Trying to bind component to card \"%s\" but is already bound to card \"%s\"\n",
1392                                 card->name, component->card->name);
1393                         return -ENODEV;
1394                 }
1395                 return 0;
1396         }
1397
1398         ret = snd_soc_component_module_get_when_probe(component);
1399         if (ret < 0)
1400                 return ret;
1401
1402         component->card = card;
1403         soc_set_name_prefix(card, component);
1404
1405         soc_init_component_debugfs(component);
1406
1407         snd_soc_dapm_init(dapm, card, component);
1408
1409         ret = snd_soc_dapm_new_controls(dapm,
1410                                         component->driver->dapm_widgets,
1411                                         component->driver->num_dapm_widgets);
1412
1413         if (ret != 0) {
1414                 dev_err(component->dev,
1415                         "Failed to create new controls %d\n", ret);
1416                 goto err_probe;
1417         }
1418
1419         for_each_component_dais(component, dai) {
1420                 ret = snd_soc_dapm_new_dai_widgets(dapm, dai);
1421                 if (ret != 0) {
1422                         dev_err(component->dev,
1423                                 "Failed to create DAI widgets %d\n", ret);
1424                         goto err_probe;
1425                 }
1426         }
1427
1428         ret = snd_soc_component_probe(component);
1429         if (ret < 0)
1430                 goto err_probe;
1431
1432         WARN(dapm->idle_bias_off &&
1433              dapm->bias_level != SND_SOC_BIAS_OFF,
1434              "codec %s can not start from non-off bias with idle_bias_off==1\n",
1435              component->name);
1436         probed = 1;
1437
1438         /*
1439          * machine specific init
1440          * see
1441          *      snd_soc_component_set_aux()
1442          */
1443         ret = snd_soc_component_init(component);
1444         if (ret < 0)
1445                 goto err_probe;
1446
1447         ret = snd_soc_add_component_controls(component,
1448                                              component->driver->controls,
1449                                              component->driver->num_controls);
1450         if (ret < 0)
1451                 goto err_probe;
1452
1453         ret = snd_soc_dapm_add_routes(dapm,
1454                                       component->driver->dapm_routes,
1455                                       component->driver->num_dapm_routes);
1456         if (ret < 0) {
1457                 if (card->disable_route_checks) {
1458                         dev_info(card->dev,
1459                                  "%s: disable_route_checks set, ignoring errors on add_routes\n",
1460                                  __func__);
1461                 } else {
1462                         dev_err(card->dev,
1463                                 "%s: snd_soc_dapm_add_routes failed: %d\n",
1464                                 __func__, ret);
1465                         goto err_probe;
1466                 }
1467         }
1468
1469         /* see for_each_card_components */
1470         list_add(&component->card_list, &card->component_dev_list);
1471
1472 err_probe:
1473         if (ret < 0)
1474                 soc_remove_component(component, probed);
1475
1476         return ret;
1477 }
1478
1479 static void soc_remove_link_dais(struct snd_soc_card *card)
1480 {
1481         struct snd_soc_pcm_runtime *rtd;
1482         int order;
1483
1484         for_each_comp_order(order) {
1485                 for_each_card_rtds(card, rtd) {
1486                         /* remove all rtd connected DAIs in good order */
1487                         snd_soc_pcm_dai_remove(rtd, order);
1488                 }
1489         }
1490 }
1491
1492 static int soc_probe_link_dais(struct snd_soc_card *card)
1493 {
1494         struct snd_soc_pcm_runtime *rtd;
1495         int order, ret;
1496
1497         for_each_comp_order(order) {
1498                 for_each_card_rtds(card, rtd) {
1499
1500                         dev_dbg(card->dev,
1501                                 "ASoC: probe %s dai link %d late %d\n",
1502                                 card->name, rtd->num, order);
1503
1504                         /* probe all rtd connected DAIs in good order */
1505                         ret = snd_soc_pcm_dai_probe(rtd, order);
1506                         if (ret)
1507                                 return ret;
1508                 }
1509         }
1510
1511         return 0;
1512 }
1513
1514 static void soc_remove_link_components(struct snd_soc_card *card)
1515 {
1516         struct snd_soc_component *component;
1517         struct snd_soc_pcm_runtime *rtd;
1518         int i, order;
1519
1520         for_each_comp_order(order) {
1521                 for_each_card_rtds(card, rtd) {
1522                         for_each_rtd_components(rtd, i, component) {
1523                                 if (component->driver->remove_order != order)
1524                                         continue;
1525
1526                                 soc_remove_component(component, 1);
1527                         }
1528                 }
1529         }
1530 }
1531
1532 static int soc_probe_link_components(struct snd_soc_card *card)
1533 {
1534         struct snd_soc_component *component;
1535         struct snd_soc_pcm_runtime *rtd;
1536         int i, ret, order;
1537
1538         for_each_comp_order(order) {
1539                 for_each_card_rtds(card, rtd) {
1540                         for_each_rtd_components(rtd, i, component) {
1541                                 if (component->driver->probe_order != order)
1542                                         continue;
1543
1544                                 ret = soc_probe_component(card, component);
1545                                 if (ret < 0)
1546                                         return ret;
1547                         }
1548                 }
1549         }
1550
1551         return 0;
1552 }
1553
1554 static void soc_unbind_aux_dev(struct snd_soc_card *card)
1555 {
1556         struct snd_soc_component *component, *_component;
1557
1558         for_each_card_auxs_safe(card, component, _component) {
1559                 /* for snd_soc_component_init() */
1560                 snd_soc_component_set_aux(component, NULL);
1561                 list_del(&component->card_aux_list);
1562         }
1563 }
1564
1565 static int soc_bind_aux_dev(struct snd_soc_card *card)
1566 {
1567         struct snd_soc_component *component;
1568         struct snd_soc_aux_dev *aux;
1569         int i;
1570
1571         for_each_card_pre_auxs(card, i, aux) {
1572                 /* codecs, usually analog devices */
1573                 component = soc_find_component(&aux->dlc);
1574                 if (!component)
1575                         return -EPROBE_DEFER;
1576
1577                 /* for snd_soc_component_init() */
1578                 snd_soc_component_set_aux(component, aux);
1579                 /* see for_each_card_auxs */
1580                 list_add(&component->card_aux_list, &card->aux_comp_list);
1581         }
1582         return 0;
1583 }
1584
1585 static int soc_probe_aux_devices(struct snd_soc_card *card)
1586 {
1587         struct snd_soc_component *component;
1588         int order;
1589         int ret;
1590
1591         for_each_comp_order(order) {
1592                 for_each_card_auxs(card, component) {
1593                         if (component->driver->probe_order != order)
1594                                 continue;
1595
1596                         ret = soc_probe_component(card, component);
1597                         if (ret < 0)
1598                                 return ret;
1599                 }
1600         }
1601
1602         return 0;
1603 }
1604
1605 static void soc_remove_aux_devices(struct snd_soc_card *card)
1606 {
1607         struct snd_soc_component *comp, *_comp;
1608         int order;
1609
1610         for_each_comp_order(order) {
1611                 for_each_card_auxs_safe(card, comp, _comp) {
1612                         if (comp->driver->remove_order == order)
1613                                 soc_remove_component(comp, 1);
1614                 }
1615         }
1616 }
1617
1618 #ifdef CONFIG_DMI
1619 /*
1620  * If a DMI filed contain strings in this blacklist (e.g.
1621  * "Type2 - Board Manufacturer" or "Type1 - TBD by OEM"), it will be taken
1622  * as invalid and dropped when setting the card long name from DMI info.
1623  */
1624 static const char * const dmi_blacklist[] = {
1625         "To be filled by OEM",
1626         "TBD by OEM",
1627         "Default String",
1628         "Board Manufacturer",
1629         "Board Vendor Name",
1630         "Board Product Name",
1631         NULL,   /* terminator */
1632 };
1633
1634 /*
1635  * Trim special characters, and replace '-' with '_' since '-' is used to
1636  * separate different DMI fields in the card long name. Only number and
1637  * alphabet characters and a few separator characters are kept.
1638  */
1639 static void cleanup_dmi_name(char *name)
1640 {
1641         int i, j = 0;
1642
1643         for (i = 0; name[i]; i++) {
1644                 if (isalnum(name[i]) || (name[i] == '.')
1645                     || (name[i] == '_'))
1646                         name[j++] = name[i];
1647                 else if (name[i] == '-')
1648                         name[j++] = '_';
1649         }
1650
1651         name[j] = '\0';
1652 }
1653
1654 /*
1655  * Check if a DMI field is valid, i.e. not containing any string
1656  * in the black list.
1657  */
1658 static int is_dmi_valid(const char *field)
1659 {
1660         int i = 0;
1661
1662         while (dmi_blacklist[i]) {
1663                 if (strstr(field, dmi_blacklist[i]))
1664                         return 0;
1665                 i++;
1666         }
1667
1668         return 1;
1669 }
1670
1671 /*
1672  * Append a string to card->dmi_longname with character cleanups.
1673  */
1674 static void append_dmi_string(struct snd_soc_card *card, const char *str)
1675 {
1676         char *dst = card->dmi_longname;
1677         size_t dst_len = sizeof(card->dmi_longname);
1678         size_t len;
1679
1680         len = strlen(dst);
1681         snprintf(dst + len, dst_len - len, "-%s", str);
1682
1683         len++;  /* skip the separator "-" */
1684         if (len < dst_len)
1685                 cleanup_dmi_name(dst + len);
1686 }
1687
1688 /**
1689  * snd_soc_set_dmi_name() - Register DMI names to card
1690  * @card: The card to register DMI names
1691  * @flavour: The flavour "differentiator" for the card amongst its peers.
1692  *
1693  * An Intel machine driver may be used by many different devices but are
1694  * difficult for userspace to differentiate, since machine drivers ususally
1695  * use their own name as the card short name and leave the card long name
1696  * blank. To differentiate such devices and fix bugs due to lack of
1697  * device-specific configurations, this function allows DMI info to be used
1698  * as the sound card long name, in the format of
1699  * "vendor-product-version-board"
1700  * (Character '-' is used to separate different DMI fields here).
1701  * This will help the user space to load the device-specific Use Case Manager
1702  * (UCM) configurations for the card.
1703  *
1704  * Possible card long names may be:
1705  * DellInc.-XPS139343-01-0310JH
1706  * ASUSTeKCOMPUTERINC.-T100TA-1.0-T100TA
1707  * Circuitco-MinnowboardMaxD0PLATFORM-D0-MinnowBoardMAX
1708  *
1709  * This function also supports flavoring the card longname to provide
1710  * the extra differentiation, like "vendor-product-version-board-flavor".
1711  *
1712  * We only keep number and alphabet characters and a few separator characters
1713  * in the card long name since UCM in the user space uses the card long names
1714  * as card configuration directory names and AudoConf cannot support special
1715  * charactors like SPACE.
1716  *
1717  * Returns 0 on success, otherwise a negative error code.
1718  */
1719 int snd_soc_set_dmi_name(struct snd_soc_card *card, const char *flavour)
1720 {
1721         const char *vendor, *product, *board;
1722
1723         if (card->long_name)
1724                 return 0; /* long name already set by driver or from DMI */
1725
1726         if (!dmi_available)
1727                 return 0;
1728
1729         /* make up dmi long name as: vendor-product-version-board */
1730         vendor = dmi_get_system_info(DMI_BOARD_VENDOR);
1731         if (!vendor || !is_dmi_valid(vendor)) {
1732                 dev_warn(card->dev, "ASoC: no DMI vendor name!\n");
1733                 return 0;
1734         }
1735
1736         snprintf(card->dmi_longname, sizeof(card->dmi_longname), "%s", vendor);
1737         cleanup_dmi_name(card->dmi_longname);
1738
1739         product = dmi_get_system_info(DMI_PRODUCT_NAME);
1740         if (product && is_dmi_valid(product)) {
1741                 const char *product_version = dmi_get_system_info(DMI_PRODUCT_VERSION);
1742
1743                 append_dmi_string(card, product);
1744
1745                 /*
1746                  * some vendors like Lenovo may only put a self-explanatory
1747                  * name in the product version field
1748                  */
1749                 if (product_version && is_dmi_valid(product_version))
1750                         append_dmi_string(card, product_version);
1751         }
1752
1753         board = dmi_get_system_info(DMI_BOARD_NAME);
1754         if (board && is_dmi_valid(board)) {
1755                 if (!product || strcasecmp(board, product))
1756                         append_dmi_string(card, board);
1757         } else if (!product) {
1758                 /* fall back to using legacy name */
1759                 dev_warn(card->dev, "ASoC: no DMI board/product name!\n");
1760                 return 0;
1761         }
1762
1763         /* Add flavour to dmi long name */
1764         if (flavour)
1765                 append_dmi_string(card, flavour);
1766
1767         /* set the card long name */
1768         card->long_name = card->dmi_longname;
1769
1770         return 0;
1771 }
1772 EXPORT_SYMBOL_GPL(snd_soc_set_dmi_name);
1773 #endif /* CONFIG_DMI */
1774
1775 static void soc_check_tplg_fes(struct snd_soc_card *card)
1776 {
1777         struct snd_soc_component *component;
1778         const struct snd_soc_component_driver *comp_drv;
1779         struct snd_soc_dai_link *dai_link;
1780         int i;
1781
1782         for_each_component(component) {
1783
1784                 /* does this component override BEs ? */
1785                 if (!component->driver->ignore_machine)
1786                         continue;
1787
1788                 /* for this machine ? */
1789                 if (!strcmp(component->driver->ignore_machine,
1790                             card->dev->driver->name))
1791                         goto match;
1792                 if (strcmp(component->driver->ignore_machine,
1793                            dev_name(card->dev)))
1794                         continue;
1795 match:
1796                 /* machine matches, so override the rtd data */
1797                 for_each_card_prelinks(card, i, dai_link) {
1798
1799                         /* ignore this FE */
1800                         if (dai_link->dynamic) {
1801                                 dai_link->ignore = true;
1802                                 continue;
1803                         }
1804
1805                         dev_dbg(card->dev, "info: override BE DAI link %s\n",
1806                                 card->dai_link[i].name);
1807
1808                         /* override platform component */
1809                         if (!dai_link->platforms) {
1810                                 dev_err(card->dev, "init platform error");
1811                                 continue;
1812                         }
1813
1814                         if (component->dev->of_node)
1815                                 dai_link->platforms->of_node = component->dev->of_node;
1816                         else
1817                                 dai_link->platforms->name = component->name;
1818
1819                         /* convert non BE into BE */
1820                         if (!dai_link->no_pcm) {
1821                                 dai_link->no_pcm = 1;
1822
1823                                 if (dai_link->dpcm_playback)
1824                                         dev_warn(card->dev,
1825                                                  "invalid configuration, dailink %s has flags no_pcm=0 and dpcm_playback=1\n",
1826                                                  dai_link->name);
1827                                 if (dai_link->dpcm_capture)
1828                                         dev_warn(card->dev,
1829                                                  "invalid configuration, dailink %s has flags no_pcm=0 and dpcm_capture=1\n",
1830                                                  dai_link->name);
1831
1832                                 /* convert normal link into DPCM one */
1833                                 if (!(dai_link->dpcm_playback ||
1834                                       dai_link->dpcm_capture)) {
1835                                         dai_link->dpcm_playback = !dai_link->capture_only;
1836                                         dai_link->dpcm_capture = !dai_link->playback_only;
1837                                 }
1838                         }
1839
1840                         /*
1841                          * override any BE fixups
1842                          * see
1843                          *      snd_soc_link_be_hw_params_fixup()
1844                          */
1845                         dai_link->be_hw_params_fixup =
1846                                 component->driver->be_hw_params_fixup;
1847
1848                         /*
1849                          * most BE links don't set stream name, so set it to
1850                          * dai link name if it's NULL to help bind widgets.
1851                          */
1852                         if (!dai_link->stream_name)
1853                                 dai_link->stream_name = dai_link->name;
1854                 }
1855
1856                 /* Inform userspace we are using alternate topology */
1857                 if (component->driver->topology_name_prefix) {
1858
1859                         /* topology shortname created? */
1860                         if (!card->topology_shortname_created) {
1861                                 comp_drv = component->driver;
1862
1863                                 snprintf(card->topology_shortname, 32, "%s-%s",
1864                                          comp_drv->topology_name_prefix,
1865                                          card->name);
1866                                 card->topology_shortname_created = true;
1867                         }
1868
1869                         /* use topology shortname */
1870                         card->name = card->topology_shortname;
1871                 }
1872         }
1873 }
1874
1875 #define soc_setup_card_name(name, name1, name2, norm)           \
1876         __soc_setup_card_name(name, sizeof(name), name1, name2, norm)
1877 static void __soc_setup_card_name(char *name, int len,
1878                                   const char *name1, const char *name2,
1879                                   int normalization)
1880 {
1881         int i;
1882
1883         snprintf(name, len, "%s", name1 ? name1 : name2);
1884
1885         if (!normalization)
1886                 return;
1887
1888         /*
1889          * Name normalization
1890          *
1891          * The driver name is somewhat special, as it's used as a key for
1892          * searches in the user-space.
1893          *
1894          * ex)
1895          *      "abcd??efg" -> "abcd__efg"
1896          */
1897         for (i = 0; i < len; i++) {
1898                 switch (name[i]) {
1899                 case '_':
1900                 case '-':
1901                 case '\0':
1902                         break;
1903                 default:
1904                         if (!isalnum(name[i]))
1905                                 name[i] = '_';
1906                         break;
1907                 }
1908         }
1909 }
1910
1911 static void soc_cleanup_card_resources(struct snd_soc_card *card)
1912 {
1913         struct snd_soc_pcm_runtime *rtd, *n;
1914
1915         if (card->snd_card)
1916                 snd_card_disconnect_sync(card->snd_card);
1917
1918         snd_soc_dapm_shutdown(card);
1919
1920         /* remove and free each DAI */
1921         soc_remove_link_dais(card);
1922         soc_remove_link_components(card);
1923
1924         for_each_card_rtds_safe(card, rtd, n)
1925                 snd_soc_remove_pcm_runtime(card, rtd);
1926
1927         /* remove auxiliary devices */
1928         soc_remove_aux_devices(card);
1929         soc_unbind_aux_dev(card);
1930
1931         snd_soc_dapm_free(&card->dapm);
1932         soc_cleanup_card_debugfs(card);
1933
1934         /* remove the card */
1935         snd_soc_card_remove(card);
1936
1937         if (card->snd_card) {
1938                 snd_card_free(card->snd_card);
1939                 card->snd_card = NULL;
1940         }
1941 }
1942
1943 static void snd_soc_unbind_card(struct snd_soc_card *card, bool unregister)
1944 {
1945         if (card->instantiated) {
1946                 card->instantiated = false;
1947                 snd_soc_flush_all_delayed_work(card);
1948
1949                 soc_cleanup_card_resources(card);
1950                 if (!unregister)
1951                         list_add(&card->list, &unbind_card_list);
1952         } else {
1953                 if (unregister)
1954                         list_del(&card->list);
1955         }
1956 }
1957
1958 static int snd_soc_bind_card(struct snd_soc_card *card)
1959 {
1960         struct snd_soc_pcm_runtime *rtd;
1961         struct snd_soc_component *component;
1962         struct snd_soc_dai_link *dai_link;
1963         int ret, i;
1964
1965         mutex_lock(&client_mutex);
1966         mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT);
1967
1968         snd_soc_dapm_init(&card->dapm, card, NULL);
1969
1970         /* check whether any platform is ignore machine FE and using topology */
1971         soc_check_tplg_fes(card);
1972
1973         /* bind aux_devs too */
1974         ret = soc_bind_aux_dev(card);
1975         if (ret < 0)
1976                 goto probe_end;
1977
1978         /* add predefined DAI links to the list */
1979         card->num_rtd = 0;
1980         for_each_card_prelinks(card, i, dai_link) {
1981                 ret = snd_soc_add_pcm_runtime(card, dai_link);
1982                 if (ret < 0)
1983                         goto probe_end;
1984         }
1985
1986         /* card bind complete so register a sound card */
1987         ret = snd_card_new(card->dev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1988                         card->owner, 0, &card->snd_card);
1989         if (ret < 0) {
1990                 dev_err(card->dev,
1991                         "ASoC: can't create sound card for card %s: %d\n",
1992                         card->name, ret);
1993                 goto probe_end;
1994         }
1995
1996         soc_init_card_debugfs(card);
1997
1998         soc_resume_init(card);
1999
2000         ret = snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
2001                                         card->num_dapm_widgets);
2002         if (ret < 0)
2003                 goto probe_end;
2004
2005         ret = snd_soc_dapm_new_controls(&card->dapm, card->of_dapm_widgets,
2006                                         card->num_of_dapm_widgets);
2007         if (ret < 0)
2008                 goto probe_end;
2009
2010         /* initialise the sound card only once */
2011         ret = snd_soc_card_probe(card);
2012         if (ret < 0)
2013                 goto probe_end;
2014
2015         /* probe all components used by DAI links on this card */
2016         ret = soc_probe_link_components(card);
2017         if (ret < 0) {
2018                 dev_err(card->dev,
2019                         "ASoC: failed to instantiate card %d\n", ret);
2020                 goto probe_end;
2021         }
2022
2023         /* probe auxiliary components */
2024         ret = soc_probe_aux_devices(card);
2025         if (ret < 0) {
2026                 dev_err(card->dev,
2027                         "ASoC: failed to probe aux component %d\n", ret);
2028                 goto probe_end;
2029         }
2030
2031         /* probe all DAI links on this card */
2032         ret = soc_probe_link_dais(card);
2033         if (ret < 0) {
2034                 dev_err(card->dev,
2035                         "ASoC: failed to instantiate card %d\n", ret);
2036                 goto probe_end;
2037         }
2038
2039         for_each_card_rtds(card, rtd) {
2040                 ret = soc_init_pcm_runtime(card, rtd);
2041                 if (ret < 0)
2042                         goto probe_end;
2043         }
2044
2045         snd_soc_dapm_link_dai_widgets(card);
2046         snd_soc_dapm_connect_dai_link_widgets(card);
2047
2048         ret = snd_soc_add_card_controls(card, card->controls,
2049                                         card->num_controls);
2050         if (ret < 0)
2051                 goto probe_end;
2052
2053         ret = snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
2054                                       card->num_dapm_routes);
2055         if (ret < 0) {
2056                 if (card->disable_route_checks) {
2057                         dev_info(card->dev,
2058                                  "%s: disable_route_checks set, ignoring errors on add_routes\n",
2059                                  __func__);
2060                 } else {
2061                         dev_err(card->dev,
2062                                  "%s: snd_soc_dapm_add_routes failed: %d\n",
2063                                  __func__, ret);
2064                         goto probe_end;
2065                 }
2066         }
2067
2068         ret = snd_soc_dapm_add_routes(&card->dapm, card->of_dapm_routes,
2069                                       card->num_of_dapm_routes);
2070         if (ret < 0)
2071                 goto probe_end;
2072
2073         /* try to set some sane longname if DMI is available */
2074         snd_soc_set_dmi_name(card, NULL);
2075
2076         soc_setup_card_name(card->snd_card->shortname,
2077                             card->name, NULL, 0);
2078         soc_setup_card_name(card->snd_card->longname,
2079                             card->long_name, card->name, 0);
2080         soc_setup_card_name(card->snd_card->driver,
2081                             card->driver_name, card->name, 1);
2082
2083         if (card->components) {
2084                 /* the current implementation of snd_component_add() accepts */
2085                 /* multiple components in the string separated by space, */
2086                 /* but the string collision (identical string) check might */
2087                 /* not work correctly */
2088                 ret = snd_component_add(card->snd_card, card->components);
2089                 if (ret < 0) {
2090                         dev_err(card->dev, "ASoC: %s snd_component_add() failed: %d\n",
2091                                 card->name, ret);
2092                         goto probe_end;
2093                 }
2094         }
2095
2096         ret = snd_soc_card_late_probe(card);
2097         if (ret < 0)
2098                 goto probe_end;
2099
2100         snd_soc_dapm_new_widgets(card);
2101
2102         ret = snd_card_register(card->snd_card);
2103         if (ret < 0) {
2104                 dev_err(card->dev, "ASoC: failed to register soundcard %d\n",
2105                                 ret);
2106                 goto probe_end;
2107         }
2108
2109         card->instantiated = 1;
2110         dapm_mark_endpoints_dirty(card);
2111         snd_soc_dapm_sync(&card->dapm);
2112
2113         /* deactivate pins to sleep state */
2114         for_each_card_components(card, component)
2115                 if (!snd_soc_component_active(component))
2116                         pinctrl_pm_select_sleep_state(component->dev);
2117
2118 probe_end:
2119         if (ret < 0)
2120                 soc_cleanup_card_resources(card);
2121
2122         mutex_unlock(&card->mutex);
2123         mutex_unlock(&client_mutex);
2124
2125         return ret;
2126 }
2127
2128 /* probes a new socdev */
2129 static int soc_probe(struct platform_device *pdev)
2130 {
2131         struct snd_soc_card *card = platform_get_drvdata(pdev);
2132
2133         /*
2134          * no card, so machine driver should be registering card
2135          * we should not be here in that case so ret error
2136          */
2137         if (!card)
2138                 return -EINVAL;
2139
2140         dev_warn(&pdev->dev,
2141                  "ASoC: machine %s should use snd_soc_register_card()\n",
2142                  card->name);
2143
2144         /* Bodge while we unpick instantiation */
2145         card->dev = &pdev->dev;
2146
2147         return devm_snd_soc_register_card(&pdev->dev, card);
2148 }
2149
2150 int snd_soc_poweroff(struct device *dev)
2151 {
2152         struct snd_soc_card *card = dev_get_drvdata(dev);
2153         struct snd_soc_component *component;
2154
2155         if (!card->instantiated)
2156                 return 0;
2157
2158         /*
2159          * Flush out pmdown_time work - we actually do want to run it
2160          * now, we're shutting down so no imminent restart.
2161          */
2162         snd_soc_flush_all_delayed_work(card);
2163
2164         snd_soc_dapm_shutdown(card);
2165
2166         /* deactivate pins to sleep state */
2167         for_each_card_components(card, component)
2168                 pinctrl_pm_select_sleep_state(component->dev);
2169
2170         return 0;
2171 }
2172 EXPORT_SYMBOL_GPL(snd_soc_poweroff);
2173
2174 const struct dev_pm_ops snd_soc_pm_ops = {
2175         .suspend = snd_soc_suspend,
2176         .resume = snd_soc_resume,
2177         .freeze = snd_soc_suspend,
2178         .thaw = snd_soc_resume,
2179         .poweroff = snd_soc_poweroff,
2180         .restore = snd_soc_resume,
2181 };
2182 EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
2183
2184 /* ASoC platform driver */
2185 static struct platform_driver soc_driver = {
2186         .driver         = {
2187                 .name           = "soc-audio",
2188                 .pm             = &snd_soc_pm_ops,
2189         },
2190         .probe          = soc_probe,
2191 };
2192
2193 /**
2194  * snd_soc_cnew - create new control
2195  * @_template: control template
2196  * @data: control private data
2197  * @long_name: control long name
2198  * @prefix: control name prefix
2199  *
2200  * Create a new mixer control from a template control.
2201  *
2202  * Returns 0 for success, else error.
2203  */
2204 struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
2205                                   void *data, const char *long_name,
2206                                   const char *prefix)
2207 {
2208         struct snd_kcontrol_new template;
2209         struct snd_kcontrol *kcontrol;
2210         char *name = NULL;
2211
2212         memcpy(&template, _template, sizeof(template));
2213         template.index = 0;
2214
2215         if (!long_name)
2216                 long_name = template.name;
2217
2218         if (prefix) {
2219                 name = kasprintf(GFP_KERNEL, "%s %s", prefix, long_name);
2220                 if (!name)
2221                         return NULL;
2222
2223                 template.name = name;
2224         } else {
2225                 template.name = long_name;
2226         }
2227
2228         kcontrol = snd_ctl_new1(&template, data);
2229
2230         kfree(name);
2231
2232         return kcontrol;
2233 }
2234 EXPORT_SYMBOL_GPL(snd_soc_cnew);
2235
2236 static int snd_soc_add_controls(struct snd_card *card, struct device *dev,
2237         const struct snd_kcontrol_new *controls, int num_controls,
2238         const char *prefix, void *data)
2239 {
2240         int i;
2241
2242         for (i = 0; i < num_controls; i++) {
2243                 const struct snd_kcontrol_new *control = &controls[i];
2244                 int err = snd_ctl_add(card, snd_soc_cnew(control, data,
2245                                                          control->name, prefix));
2246                 if (err < 0) {
2247                         dev_err(dev, "ASoC: Failed to add %s: %d\n",
2248                                 control->name, err);
2249                         return err;
2250                 }
2251         }
2252
2253         return 0;
2254 }
2255
2256 /**
2257  * snd_soc_add_component_controls - Add an array of controls to a component.
2258  *
2259  * @component: Component to add controls to
2260  * @controls: Array of controls to add
2261  * @num_controls: Number of elements in the array
2262  *
2263  * Return: 0 for success, else error.
2264  */
2265 int snd_soc_add_component_controls(struct snd_soc_component *component,
2266         const struct snd_kcontrol_new *controls, unsigned int num_controls)
2267 {
2268         struct snd_card *card = component->card->snd_card;
2269
2270         return snd_soc_add_controls(card, component->dev, controls,
2271                         num_controls, component->name_prefix, component);
2272 }
2273 EXPORT_SYMBOL_GPL(snd_soc_add_component_controls);
2274
2275 /**
2276  * snd_soc_add_card_controls - add an array of controls to a SoC card.
2277  * Convenience function to add a list of controls.
2278  *
2279  * @soc_card: SoC card to add controls to
2280  * @controls: array of controls to add
2281  * @num_controls: number of elements in the array
2282  *
2283  * Return 0 for success, else error.
2284  */
2285 int snd_soc_add_card_controls(struct snd_soc_card *soc_card,
2286         const struct snd_kcontrol_new *controls, int num_controls)
2287 {
2288         struct snd_card *card = soc_card->snd_card;
2289
2290         return snd_soc_add_controls(card, soc_card->dev, controls, num_controls,
2291                         NULL, soc_card);
2292 }
2293 EXPORT_SYMBOL_GPL(snd_soc_add_card_controls);
2294
2295 /**
2296  * snd_soc_add_dai_controls - add an array of controls to a DAI.
2297  * Convienience function to add a list of controls.
2298  *
2299  * @dai: DAI to add controls to
2300  * @controls: array of controls to add
2301  * @num_controls: number of elements in the array
2302  *
2303  * Return 0 for success, else error.
2304  */
2305 int snd_soc_add_dai_controls(struct snd_soc_dai *dai,
2306         const struct snd_kcontrol_new *controls, int num_controls)
2307 {
2308         struct snd_card *card = dai->component->card->snd_card;
2309
2310         return snd_soc_add_controls(card, dai->dev, controls, num_controls,
2311                         NULL, dai);
2312 }
2313 EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls);
2314
2315 /**
2316  * snd_soc_register_card - Register a card with the ASoC core
2317  *
2318  * @card: Card to register
2319  *
2320  */
2321 int snd_soc_register_card(struct snd_soc_card *card)
2322 {
2323         if (!card->name || !card->dev)
2324                 return -EINVAL;
2325
2326         dev_set_drvdata(card->dev, card);
2327
2328         INIT_LIST_HEAD(&card->widgets);
2329         INIT_LIST_HEAD(&card->paths);
2330         INIT_LIST_HEAD(&card->dapm_list);
2331         INIT_LIST_HEAD(&card->aux_comp_list);
2332         INIT_LIST_HEAD(&card->component_dev_list);
2333         INIT_LIST_HEAD(&card->list);
2334         INIT_LIST_HEAD(&card->rtd_list);
2335         INIT_LIST_HEAD(&card->dapm_dirty);
2336         INIT_LIST_HEAD(&card->dobj_list);
2337
2338         card->instantiated = 0;
2339         mutex_init(&card->mutex);
2340         mutex_init(&card->dapm_mutex);
2341         mutex_init(&card->pcm_mutex);
2342         spin_lock_init(&card->dpcm_lock);
2343
2344         return snd_soc_bind_card(card);
2345 }
2346 EXPORT_SYMBOL_GPL(snd_soc_register_card);
2347
2348 /**
2349  * snd_soc_unregister_card - Unregister a card with the ASoC core
2350  *
2351  * @card: Card to unregister
2352  *
2353  */
2354 int snd_soc_unregister_card(struct snd_soc_card *card)
2355 {
2356         mutex_lock(&client_mutex);
2357         snd_soc_unbind_card(card, true);
2358         mutex_unlock(&client_mutex);
2359         dev_dbg(card->dev, "ASoC: Unregistered card '%s'\n", card->name);
2360
2361         return 0;
2362 }
2363 EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
2364
2365 /*
2366  * Simplify DAI link configuration by removing ".-1" from device names
2367  * and sanitizing names.
2368  */
2369 static char *fmt_single_name(struct device *dev, int *id)
2370 {
2371         const char *devname = dev_name(dev);
2372         char *found, *name;
2373         unsigned int id1, id2;
2374
2375         if (devname == NULL)
2376                 return NULL;
2377
2378         name = devm_kstrdup(dev, devname, GFP_KERNEL);
2379         if (!name)
2380                 return NULL;
2381
2382         /* are we a "%s.%d" name (platform and SPI components) */
2383         found = strstr(name, dev->driver->name);
2384         if (found) {
2385                 /* get ID */
2386                 if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
2387
2388                         /* discard ID from name if ID == -1 */
2389                         if (*id == -1)
2390                                 found[strlen(dev->driver->name)] = '\0';
2391                 }
2392
2393         /* I2C component devices are named "bus-addr" */
2394         } else if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
2395
2396                 /* create unique ID number from I2C addr and bus */
2397                 *id = ((id1 & 0xffff) << 16) + id2;
2398
2399                 devm_kfree(dev, name);
2400
2401                 /* sanitize component name for DAI link creation */
2402                 name = devm_kasprintf(dev, GFP_KERNEL, "%s.%s", dev->driver->name, devname);
2403         } else {
2404                 *id = 0;
2405         }
2406
2407         return name;
2408 }
2409
2410 /*
2411  * Simplify DAI link naming for single devices with multiple DAIs by removing
2412  * any ".-1" and using the DAI name (instead of device name).
2413  */
2414 static inline char *fmt_multiple_name(struct device *dev,
2415                 struct snd_soc_dai_driver *dai_drv)
2416 {
2417         if (dai_drv->name == NULL) {
2418                 dev_err(dev,
2419                         "ASoC: error - multiple DAI %s registered with no name\n",
2420                         dev_name(dev));
2421                 return NULL;
2422         }
2423
2424         return devm_kstrdup(dev, dai_drv->name, GFP_KERNEL);
2425 }
2426
2427 void snd_soc_unregister_dai(struct snd_soc_dai *dai)
2428 {
2429         dev_dbg(dai->dev, "ASoC: Unregistered DAI '%s'\n", dai->name);
2430         list_del(&dai->list);
2431 }
2432 EXPORT_SYMBOL_GPL(snd_soc_unregister_dai);
2433
2434 /**
2435  * snd_soc_register_dai - Register a DAI dynamically & create its widgets
2436  *
2437  * @component: The component the DAIs are registered for
2438  * @dai_drv: DAI driver to use for the DAI
2439  * @legacy_dai_naming: if %true, use legacy single-name format;
2440  *      if %false, use multiple-name format;
2441  *
2442  * Topology can use this API to register DAIs when probing a component.
2443  * These DAIs's widgets will be freed in the card cleanup and the DAIs
2444  * will be freed in the component cleanup.
2445  */
2446 struct snd_soc_dai *snd_soc_register_dai(struct snd_soc_component *component,
2447                                          struct snd_soc_dai_driver *dai_drv,
2448                                          bool legacy_dai_naming)
2449 {
2450         struct device *dev = component->dev;
2451         struct snd_soc_dai *dai;
2452
2453         dev_dbg(dev, "ASoC: dynamically register DAI %s\n", dev_name(dev));
2454
2455         lockdep_assert_held(&client_mutex);
2456
2457         dai = devm_kzalloc(dev, sizeof(*dai), GFP_KERNEL);
2458         if (dai == NULL)
2459                 return NULL;
2460
2461         /*
2462          * Back in the old days when we still had component-less DAIs,
2463          * instead of having a static name, component-less DAIs would
2464          * inherit the name of the parent device so it is possible to
2465          * register multiple instances of the DAI. We still need to keep
2466          * the same naming style even though those DAIs are not
2467          * component-less anymore.
2468          */
2469         if (legacy_dai_naming &&
2470             (dai_drv->id == 0 || dai_drv->name == NULL)) {
2471                 dai->name = fmt_single_name(dev, &dai->id);
2472         } else {
2473                 dai->name = fmt_multiple_name(dev, dai_drv);
2474                 if (dai_drv->id)
2475                         dai->id = dai_drv->id;
2476                 else
2477                         dai->id = component->num_dai;
2478         }
2479         if (!dai->name)
2480                 return NULL;
2481
2482         dai->component = component;
2483         dai->dev = dev;
2484         dai->driver = dai_drv;
2485
2486         /* see for_each_component_dais */
2487         list_add_tail(&dai->list, &component->dai_list);
2488         component->num_dai++;
2489
2490         dev_dbg(dev, "ASoC: Registered DAI '%s'\n", dai->name);
2491         return dai;
2492 }
2493
2494 /**
2495  * snd_soc_unregister_dais - Unregister DAIs from the ASoC core
2496  *
2497  * @component: The component for which the DAIs should be unregistered
2498  */
2499 static void snd_soc_unregister_dais(struct snd_soc_component *component)
2500 {
2501         struct snd_soc_dai *dai, *_dai;
2502
2503         for_each_component_dais_safe(component, dai, _dai)
2504                 snd_soc_unregister_dai(dai);
2505 }
2506
2507 /**
2508  * snd_soc_register_dais - Register a DAI with the ASoC core
2509  *
2510  * @component: The component the DAIs are registered for
2511  * @dai_drv: DAI driver to use for the DAIs
2512  * @count: Number of DAIs
2513  */
2514 static int snd_soc_register_dais(struct snd_soc_component *component,
2515                                  struct snd_soc_dai_driver *dai_drv,
2516                                  size_t count)
2517 {
2518         struct snd_soc_dai *dai;
2519         unsigned int i;
2520         int ret;
2521
2522         for (i = 0; i < count; i++) {
2523                 dai = snd_soc_register_dai(component, dai_drv + i, count == 1 &&
2524                                   !component->driver->non_legacy_dai_naming);
2525                 if (dai == NULL) {
2526                         ret = -ENOMEM;
2527                         goto err;
2528                 }
2529         }
2530
2531         return 0;
2532
2533 err:
2534         snd_soc_unregister_dais(component);
2535
2536         return ret;
2537 }
2538
2539 #define ENDIANNESS_MAP(name) \
2540         (SNDRV_PCM_FMTBIT_##name##LE | SNDRV_PCM_FMTBIT_##name##BE)
2541 static u64 endianness_format_map[] = {
2542         ENDIANNESS_MAP(S16_),
2543         ENDIANNESS_MAP(U16_),
2544         ENDIANNESS_MAP(S24_),
2545         ENDIANNESS_MAP(U24_),
2546         ENDIANNESS_MAP(S32_),
2547         ENDIANNESS_MAP(U32_),
2548         ENDIANNESS_MAP(S24_3),
2549         ENDIANNESS_MAP(U24_3),
2550         ENDIANNESS_MAP(S20_3),
2551         ENDIANNESS_MAP(U20_3),
2552         ENDIANNESS_MAP(S18_3),
2553         ENDIANNESS_MAP(U18_3),
2554         ENDIANNESS_MAP(FLOAT_),
2555         ENDIANNESS_MAP(FLOAT64_),
2556         ENDIANNESS_MAP(IEC958_SUBFRAME_),
2557 };
2558
2559 /*
2560  * Fix up the DAI formats for endianness: codecs don't actually see
2561  * the endianness of the data but we're using the CPU format
2562  * definitions which do need to include endianness so we ensure that
2563  * codec DAIs always have both big and little endian variants set.
2564  */
2565 static void convert_endianness_formats(struct snd_soc_pcm_stream *stream)
2566 {
2567         int i;
2568
2569         for (i = 0; i < ARRAY_SIZE(endianness_format_map); i++)
2570                 if (stream->formats & endianness_format_map[i])
2571                         stream->formats |= endianness_format_map[i];
2572 }
2573
2574 static void snd_soc_try_rebind_card(void)
2575 {
2576         struct snd_soc_card *card, *c;
2577
2578         list_for_each_entry_safe(card, c, &unbind_card_list, list)
2579                 if (!snd_soc_bind_card(card))
2580                         list_del(&card->list);
2581 }
2582
2583 static void snd_soc_del_component_unlocked(struct snd_soc_component *component)
2584 {
2585         struct snd_soc_card *card = component->card;
2586
2587         snd_soc_unregister_dais(component);
2588
2589         if (card)
2590                 snd_soc_unbind_card(card, false);
2591
2592         list_del(&component->list);
2593 }
2594
2595 int snd_soc_component_initialize(struct snd_soc_component *component,
2596                                  const struct snd_soc_component_driver *driver,
2597                                  struct device *dev)
2598 {
2599         INIT_LIST_HEAD(&component->dai_list);
2600         INIT_LIST_HEAD(&component->dobj_list);
2601         INIT_LIST_HEAD(&component->card_list);
2602         INIT_LIST_HEAD(&component->list);
2603         mutex_init(&component->io_mutex);
2604
2605         component->name = fmt_single_name(dev, &component->id);
2606         if (!component->name) {
2607                 dev_err(dev, "ASoC: Failed to allocate name\n");
2608                 return -ENOMEM;
2609         }
2610
2611         component->dev          = dev;
2612         component->driver       = driver;
2613
2614         return 0;
2615 }
2616 EXPORT_SYMBOL_GPL(snd_soc_component_initialize);
2617
2618 int snd_soc_add_component(struct snd_soc_component *component,
2619                           struct snd_soc_dai_driver *dai_drv,
2620                           int num_dai)
2621 {
2622         int ret;
2623         int i;
2624
2625         mutex_lock(&client_mutex);
2626
2627         if (component->driver->endianness) {
2628                 for (i = 0; i < num_dai; i++) {
2629                         convert_endianness_formats(&dai_drv[i].playback);
2630                         convert_endianness_formats(&dai_drv[i].capture);
2631                 }
2632         }
2633
2634         ret = snd_soc_register_dais(component, dai_drv, num_dai);
2635         if (ret < 0) {
2636                 dev_err(component->dev, "ASoC: Failed to register DAIs: %d\n",
2637                         ret);
2638                 goto err_cleanup;
2639         }
2640
2641         if (!component->driver->write && !component->driver->read) {
2642                 if (!component->regmap)
2643                         component->regmap = dev_get_regmap(component->dev,
2644                                                            NULL);
2645                 if (component->regmap)
2646                         snd_soc_component_setup_regmap(component);
2647         }
2648
2649         /* see for_each_component */
2650         list_add(&component->list, &component_list);
2651
2652 err_cleanup:
2653         if (ret < 0)
2654                 snd_soc_del_component_unlocked(component);
2655
2656         mutex_unlock(&client_mutex);
2657
2658         if (ret == 0)
2659                 snd_soc_try_rebind_card();
2660
2661         return ret;
2662 }
2663 EXPORT_SYMBOL_GPL(snd_soc_add_component);
2664
2665 int snd_soc_register_component(struct device *dev,
2666                         const struct snd_soc_component_driver *component_driver,
2667                         struct snd_soc_dai_driver *dai_drv,
2668                         int num_dai)
2669 {
2670         struct snd_soc_component *component;
2671         int ret;
2672
2673         component = devm_kzalloc(dev, sizeof(*component), GFP_KERNEL);
2674         if (!component)
2675                 return -ENOMEM;
2676
2677         ret = snd_soc_component_initialize(component, component_driver, dev);
2678         if (ret < 0)
2679                 return ret;
2680
2681         return snd_soc_add_component(component, dai_drv, num_dai);
2682 }
2683 EXPORT_SYMBOL_GPL(snd_soc_register_component);
2684
2685 /**
2686  * snd_soc_unregister_component_by_driver - Unregister component using a given driver
2687  * from the ASoC core
2688  *
2689  * @dev: The device to unregister
2690  * @component_driver: The component driver to unregister
2691  */
2692 void snd_soc_unregister_component_by_driver(struct device *dev,
2693                                             const struct snd_soc_component_driver *component_driver)
2694 {
2695         struct snd_soc_component *component;
2696
2697         if (!component_driver)
2698                 return;
2699
2700         mutex_lock(&client_mutex);
2701         component = snd_soc_lookup_component_nolocked(dev, component_driver->name);
2702         if (!component)
2703                 goto out;
2704
2705         snd_soc_del_component_unlocked(component);
2706
2707 out:
2708         mutex_unlock(&client_mutex);
2709 }
2710 EXPORT_SYMBOL_GPL(snd_soc_unregister_component_by_driver);
2711
2712 /**
2713  * snd_soc_unregister_component - Unregister all related component
2714  * from the ASoC core
2715  *
2716  * @dev: The device to unregister
2717  */
2718 void snd_soc_unregister_component(struct device *dev)
2719 {
2720         mutex_lock(&client_mutex);
2721         while (1) {
2722                 struct snd_soc_component *component = snd_soc_lookup_component_nolocked(dev, NULL);
2723
2724                 if (!component)
2725                         break;
2726
2727                 snd_soc_del_component_unlocked(component);
2728         }
2729         mutex_unlock(&client_mutex);
2730 }
2731 EXPORT_SYMBOL_GPL(snd_soc_unregister_component);
2732
2733 /* Retrieve a card's name from device tree */
2734 int snd_soc_of_parse_card_name(struct snd_soc_card *card,
2735                                const char *propname)
2736 {
2737         struct device_node *np;
2738         int ret;
2739
2740         if (!card->dev) {
2741                 pr_err("card->dev is not set before calling %s\n", __func__);
2742                 return -EINVAL;
2743         }
2744
2745         np = card->dev->of_node;
2746
2747         ret = of_property_read_string_index(np, propname, 0, &card->name);
2748         /*
2749          * EINVAL means the property does not exist. This is fine providing
2750          * card->name was previously set, which is checked later in
2751          * snd_soc_register_card.
2752          */
2753         if (ret < 0 && ret != -EINVAL) {
2754                 dev_err(card->dev,
2755                         "ASoC: Property '%s' could not be read: %d\n",
2756                         propname, ret);
2757                 return ret;
2758         }
2759
2760         return 0;
2761 }
2762 EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
2763
2764 static const struct snd_soc_dapm_widget simple_widgets[] = {
2765         SND_SOC_DAPM_MIC("Microphone", NULL),
2766         SND_SOC_DAPM_LINE("Line", NULL),
2767         SND_SOC_DAPM_HP("Headphone", NULL),
2768         SND_SOC_DAPM_SPK("Speaker", NULL),
2769 };
2770
2771 int snd_soc_of_parse_audio_simple_widgets(struct snd_soc_card *card,
2772                                           const char *propname)
2773 {
2774         struct device_node *np = card->dev->of_node;
2775         struct snd_soc_dapm_widget *widgets;
2776         const char *template, *wname;
2777         int i, j, num_widgets;
2778
2779         num_widgets = of_property_count_strings(np, propname);
2780         if (num_widgets < 0) {
2781                 dev_err(card->dev,
2782                         "ASoC: Property '%s' does not exist\n", propname);
2783                 return -EINVAL;
2784         }
2785         if (num_widgets & 1) {
2786                 dev_err(card->dev,
2787                         "ASoC: Property '%s' length is not even\n", propname);
2788                 return -EINVAL;
2789         }
2790
2791         num_widgets /= 2;
2792         if (!num_widgets) {
2793                 dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
2794                         propname);
2795                 return -EINVAL;
2796         }
2797
2798         widgets = devm_kcalloc(card->dev, num_widgets, sizeof(*widgets),
2799                                GFP_KERNEL);
2800         if (!widgets) {
2801                 dev_err(card->dev,
2802                         "ASoC: Could not allocate memory for widgets\n");
2803                 return -ENOMEM;
2804         }
2805
2806         for (i = 0; i < num_widgets; i++) {
2807                 int ret = of_property_read_string_index(np, propname,
2808                                                         2 * i, &template);
2809                 if (ret) {
2810                         dev_err(card->dev,
2811                                 "ASoC: Property '%s' index %d read error:%d\n",
2812                                 propname, 2 * i, ret);
2813                         return -EINVAL;
2814                 }
2815
2816                 for (j = 0; j < ARRAY_SIZE(simple_widgets); j++) {
2817                         if (!strncmp(template, simple_widgets[j].name,
2818                                      strlen(simple_widgets[j].name))) {
2819                                 widgets[i] = simple_widgets[j];
2820                                 break;
2821                         }
2822                 }
2823
2824                 if (j >= ARRAY_SIZE(simple_widgets)) {
2825                         dev_err(card->dev,
2826                                 "ASoC: DAPM widget '%s' is not supported\n",
2827                                 template);
2828                         return -EINVAL;
2829                 }
2830
2831                 ret = of_property_read_string_index(np, propname,
2832                                                     (2 * i) + 1,
2833                                                     &wname);
2834                 if (ret) {
2835                         dev_err(card->dev,
2836                                 "ASoC: Property '%s' index %d read error:%d\n",
2837                                 propname, (2 * i) + 1, ret);
2838                         return -EINVAL;
2839                 }
2840
2841                 widgets[i].name = wname;
2842         }
2843
2844         card->of_dapm_widgets = widgets;
2845         card->num_of_dapm_widgets = num_widgets;
2846
2847         return 0;
2848 }
2849 EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_simple_widgets);
2850
2851 int snd_soc_of_get_slot_mask(struct device_node *np,
2852                              const char *prop_name,
2853                              unsigned int *mask)
2854 {
2855         u32 val;
2856         const __be32 *of_slot_mask = of_get_property(np, prop_name, &val);
2857         int i;
2858
2859         if (!of_slot_mask)
2860                 return 0;
2861         val /= sizeof(u32);
2862         for (i = 0; i < val; i++)
2863                 if (be32_to_cpup(&of_slot_mask[i]))
2864                         *mask |= (1 << i);
2865
2866         return val;
2867 }
2868 EXPORT_SYMBOL_GPL(snd_soc_of_get_slot_mask);
2869
2870 int snd_soc_of_parse_tdm_slot(struct device_node *np,
2871                               unsigned int *tx_mask,
2872                               unsigned int *rx_mask,
2873                               unsigned int *slots,
2874                               unsigned int *slot_width)
2875 {
2876         u32 val;
2877         int ret;
2878
2879         if (tx_mask)
2880                 snd_soc_of_get_slot_mask(np, "dai-tdm-slot-tx-mask", tx_mask);
2881         if (rx_mask)
2882                 snd_soc_of_get_slot_mask(np, "dai-tdm-slot-rx-mask", rx_mask);
2883
2884         if (of_property_read_bool(np, "dai-tdm-slot-num")) {
2885                 ret = of_property_read_u32(np, "dai-tdm-slot-num", &val);
2886                 if (ret)
2887                         return ret;
2888
2889                 if (slots)
2890                         *slots = val;
2891         }
2892
2893         if (of_property_read_bool(np, "dai-tdm-slot-width")) {
2894                 ret = of_property_read_u32(np, "dai-tdm-slot-width", &val);
2895                 if (ret)
2896                         return ret;
2897
2898                 if (slot_width)
2899                         *slot_width = val;
2900         }
2901
2902         return 0;
2903 }
2904 EXPORT_SYMBOL_GPL(snd_soc_of_parse_tdm_slot);
2905
2906 void snd_soc_of_parse_node_prefix(struct device_node *np,
2907                                   struct snd_soc_codec_conf *codec_conf,
2908                                   struct device_node *of_node,
2909                                   const char *propname)
2910 {
2911         const char *str;
2912         int ret;
2913
2914         ret = of_property_read_string(np, propname, &str);
2915         if (ret < 0) {
2916                 /* no prefix is not error */
2917                 return;
2918         }
2919
2920         codec_conf->dlc.of_node = of_node;
2921         codec_conf->name_prefix = str;
2922 }
2923 EXPORT_SYMBOL_GPL(snd_soc_of_parse_node_prefix);
2924
2925 int snd_soc_of_parse_audio_routing(struct snd_soc_card *card,
2926                                    const char *propname)
2927 {
2928         struct device_node *np = card->dev->of_node;
2929         int num_routes;
2930         struct snd_soc_dapm_route *routes;
2931         int i;
2932
2933         num_routes = of_property_count_strings(np, propname);
2934         if (num_routes < 0 || num_routes & 1) {
2935                 dev_err(card->dev,
2936                         "ASoC: Property '%s' does not exist or its length is not even\n",
2937                         propname);
2938                 return -EINVAL;
2939         }
2940         num_routes /= 2;
2941
2942         routes = devm_kcalloc(card->dev, num_routes, sizeof(*routes),
2943                               GFP_KERNEL);
2944         if (!routes) {
2945                 dev_err(card->dev,
2946                         "ASoC: Could not allocate DAPM route table\n");
2947                 return -ENOMEM;
2948         }
2949
2950         for (i = 0; i < num_routes; i++) {
2951                 int ret = of_property_read_string_index(np, propname,
2952                                                         2 * i, &routes[i].sink);
2953                 if (ret) {
2954                         dev_err(card->dev,
2955                                 "ASoC: Property '%s' index %d could not be read: %d\n",
2956                                 propname, 2 * i, ret);
2957                         return -EINVAL;
2958                 }
2959                 ret = of_property_read_string_index(np, propname,
2960                         (2 * i) + 1, &routes[i].source);
2961                 if (ret) {
2962                         dev_err(card->dev,
2963                                 "ASoC: Property '%s' index %d could not be read: %d\n",
2964                                 propname, (2 * i) + 1, ret);
2965                         return -EINVAL;
2966                 }
2967         }
2968
2969         card->num_of_dapm_routes = num_routes;
2970         card->of_dapm_routes = routes;
2971
2972         return 0;
2973 }
2974 EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
2975
2976 int snd_soc_of_parse_aux_devs(struct snd_soc_card *card, const char *propname)
2977 {
2978         struct device_node *node = card->dev->of_node;
2979         struct snd_soc_aux_dev *aux;
2980         int num, i;
2981
2982         num = of_count_phandle_with_args(node, propname, NULL);
2983         if (num == -ENOENT) {
2984                 return 0;
2985         } else if (num < 0) {
2986                 dev_err(card->dev, "ASOC: Property '%s' could not be read: %d\n",
2987                         propname, num);
2988                 return num;
2989         }
2990
2991         aux = devm_kcalloc(card->dev, num, sizeof(*aux), GFP_KERNEL);
2992         if (!aux)
2993                 return -ENOMEM;
2994         card->aux_dev = aux;
2995         card->num_aux_devs = num;
2996
2997         for_each_card_pre_auxs(card, i, aux) {
2998                 aux->dlc.of_node = of_parse_phandle(node, propname, i);
2999                 if (!aux->dlc.of_node)
3000                         return -EINVAL;
3001         }
3002
3003         return 0;
3004 }
3005 EXPORT_SYMBOL_GPL(snd_soc_of_parse_aux_devs);
3006
3007 unsigned int snd_soc_daifmt_clock_provider_fliped(unsigned int dai_fmt)
3008 {
3009         unsigned int inv_dai_fmt = dai_fmt & ~SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK;
3010
3011         switch (dai_fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
3012         case SND_SOC_DAIFMT_CBP_CFP:
3013                 inv_dai_fmt |= SND_SOC_DAIFMT_CBC_CFC;
3014                 break;
3015         case SND_SOC_DAIFMT_CBP_CFC:
3016                 inv_dai_fmt |= SND_SOC_DAIFMT_CBC_CFP;
3017                 break;
3018         case SND_SOC_DAIFMT_CBC_CFP:
3019                 inv_dai_fmt |= SND_SOC_DAIFMT_CBP_CFC;
3020                 break;
3021         case SND_SOC_DAIFMT_CBC_CFC:
3022                 inv_dai_fmt |= SND_SOC_DAIFMT_CBP_CFP;
3023                 break;
3024         }
3025
3026         return inv_dai_fmt;
3027 }
3028 EXPORT_SYMBOL_GPL(snd_soc_daifmt_clock_provider_fliped);
3029
3030 unsigned int snd_soc_daifmt_clock_provider_from_bitmap(unsigned int bit_frame)
3031 {
3032         /*
3033          * bit_frame is return value from
3034          *      snd_soc_daifmt_parse_clock_provider_raw()
3035          */
3036
3037         /* Codec base */
3038         switch (bit_frame) {
3039         case 0x11:
3040                 return SND_SOC_DAIFMT_CBP_CFP;
3041         case 0x10:
3042                 return SND_SOC_DAIFMT_CBP_CFC;
3043         case 0x01:
3044                 return SND_SOC_DAIFMT_CBC_CFP;
3045         default:
3046                 return SND_SOC_DAIFMT_CBC_CFC;
3047         }
3048
3049         return 0;
3050 }
3051 EXPORT_SYMBOL_GPL(snd_soc_daifmt_clock_provider_from_bitmap);
3052
3053 unsigned int snd_soc_daifmt_parse_format(struct device_node *np,
3054                                          const char *prefix)
3055 {
3056         int ret;
3057         char prop[128];
3058         unsigned int format = 0;
3059         int bit, frame;
3060         const char *str;
3061         struct {
3062                 char *name;
3063                 unsigned int val;
3064         } of_fmt_table[] = {
3065                 { "i2s",        SND_SOC_DAIFMT_I2S },
3066                 { "right_j",    SND_SOC_DAIFMT_RIGHT_J },
3067                 { "left_j",     SND_SOC_DAIFMT_LEFT_J },
3068                 { "dsp_a",      SND_SOC_DAIFMT_DSP_A },
3069                 { "dsp_b",      SND_SOC_DAIFMT_DSP_B },
3070                 { "ac97",       SND_SOC_DAIFMT_AC97 },
3071                 { "pdm",        SND_SOC_DAIFMT_PDM},
3072                 { "msb",        SND_SOC_DAIFMT_MSB },
3073                 { "lsb",        SND_SOC_DAIFMT_LSB },
3074         };
3075
3076         if (!prefix)
3077                 prefix = "";
3078
3079         /*
3080          * check "dai-format = xxx"
3081          * or    "[prefix]format = xxx"
3082          * SND_SOC_DAIFMT_FORMAT_MASK area
3083          */
3084         ret = of_property_read_string(np, "dai-format", &str);
3085         if (ret < 0) {
3086                 snprintf(prop, sizeof(prop), "%sformat", prefix);
3087                 ret = of_property_read_string(np, prop, &str);
3088         }
3089         if (ret == 0) {
3090                 int i;
3091
3092                 for (i = 0; i < ARRAY_SIZE(of_fmt_table); i++) {
3093                         if (strcmp(str, of_fmt_table[i].name) == 0) {
3094                                 format |= of_fmt_table[i].val;
3095                                 break;
3096                         }
3097                 }
3098         }
3099
3100         /*
3101          * check "[prefix]continuous-clock"
3102          * SND_SOC_DAIFMT_CLOCK_MASK area
3103          */
3104         snprintf(prop, sizeof(prop), "%scontinuous-clock", prefix);
3105         if (of_property_read_bool(np, prop))
3106                 format |= SND_SOC_DAIFMT_CONT;
3107         else
3108                 format |= SND_SOC_DAIFMT_GATED;
3109
3110         /*
3111          * check "[prefix]bitclock-inversion"
3112          * check "[prefix]frame-inversion"
3113          * SND_SOC_DAIFMT_INV_MASK area
3114          */
3115         snprintf(prop, sizeof(prop), "%sbitclock-inversion", prefix);
3116         bit = !!of_get_property(np, prop, NULL);
3117
3118         snprintf(prop, sizeof(prop), "%sframe-inversion", prefix);
3119         frame = !!of_get_property(np, prop, NULL);
3120
3121         switch ((bit << 4) + frame) {
3122         case 0x11:
3123                 format |= SND_SOC_DAIFMT_IB_IF;
3124                 break;
3125         case 0x10:
3126                 format |= SND_SOC_DAIFMT_IB_NF;
3127                 break;
3128         case 0x01:
3129                 format |= SND_SOC_DAIFMT_NB_IF;
3130                 break;
3131         default:
3132                 /* SND_SOC_DAIFMT_NB_NF is default */
3133                 break;
3134         }
3135
3136         return format;
3137 }
3138 EXPORT_SYMBOL_GPL(snd_soc_daifmt_parse_format);
3139
3140 unsigned int snd_soc_daifmt_parse_clock_provider_raw(struct device_node *np,
3141                                                      const char *prefix,
3142                                                      struct device_node **bitclkmaster,
3143                                                      struct device_node **framemaster)
3144 {
3145         char prop[128];
3146         unsigned int bit, frame;
3147
3148         if (!prefix)
3149                 prefix = "";
3150
3151         /*
3152          * check "[prefix]bitclock-master"
3153          * check "[prefix]frame-master"
3154          */
3155         snprintf(prop, sizeof(prop), "%sbitclock-master", prefix);
3156         bit = !!of_get_property(np, prop, NULL);
3157         if (bit && bitclkmaster)
3158                 *bitclkmaster = of_parse_phandle(np, prop, 0);
3159
3160         snprintf(prop, sizeof(prop), "%sframe-master", prefix);
3161         frame = !!of_get_property(np, prop, NULL);
3162         if (frame && framemaster)
3163                 *framemaster = of_parse_phandle(np, prop, 0);
3164
3165         /*
3166          * return bitmap.
3167          * It will be parameter of
3168          *      snd_soc_daifmt_clock_provider_from_bitmap()
3169          */
3170         return (bit << 4) + frame;
3171 }
3172 EXPORT_SYMBOL_GPL(snd_soc_daifmt_parse_clock_provider_raw);
3173
3174 int snd_soc_get_dai_id(struct device_node *ep)
3175 {
3176         struct snd_soc_component *component;
3177         struct snd_soc_dai_link_component dlc;
3178         int ret;
3179
3180         dlc.of_node     = of_graph_get_port_parent(ep);
3181         dlc.name        = NULL;
3182         /*
3183          * For example HDMI case, HDMI has video/sound port,
3184          * but ALSA SoC needs sound port number only.
3185          * Thus counting HDMI DT port/endpoint doesn't work.
3186          * Then, it should have .of_xlate_dai_id
3187          */
3188         ret = -ENOTSUPP;
3189         mutex_lock(&client_mutex);
3190         component = soc_find_component(&dlc);
3191         if (component)
3192                 ret = snd_soc_component_of_xlate_dai_id(component, ep);
3193         mutex_unlock(&client_mutex);
3194
3195         of_node_put(dlc.of_node);
3196
3197         return ret;
3198 }
3199 EXPORT_SYMBOL_GPL(snd_soc_get_dai_id);
3200
3201 int snd_soc_get_dai_name(const struct of_phandle_args *args,
3202                                 const char **dai_name)
3203 {
3204         struct snd_soc_component *pos;
3205         int ret = -EPROBE_DEFER;
3206
3207         mutex_lock(&client_mutex);
3208         for_each_component(pos) {
3209                 struct device_node *component_of_node = soc_component_to_node(pos);
3210
3211                 if (component_of_node != args->np)
3212                         continue;
3213
3214                 ret = snd_soc_component_of_xlate_dai_name(pos, args, dai_name);
3215                 if (ret == -ENOTSUPP) {
3216                         struct snd_soc_dai *dai;
3217                         int id = -1;
3218
3219                         switch (args->args_count) {
3220                         case 0:
3221                                 id = 0; /* same as dai_drv[0] */
3222                                 break;
3223                         case 1:
3224                                 id = args->args[0];
3225                                 break;
3226                         default:
3227                                 /* not supported */
3228                                 break;
3229                         }
3230
3231                         if (id < 0 || id >= pos->num_dai) {
3232                                 ret = -EINVAL;
3233                                 continue;
3234                         }
3235
3236                         ret = 0;
3237
3238                         /* find target DAI */
3239                         for_each_component_dais(pos, dai) {
3240                                 if (id == 0)
3241                                         break;
3242                                 id--;
3243                         }
3244
3245                         *dai_name = dai->driver->name;
3246                         if (!*dai_name)
3247                                 *dai_name = pos->name;
3248                 } else if (ret) {
3249                         /*
3250                          * if another error than ENOTSUPP is returned go on and
3251                          * check if another component is provided with the same
3252                          * node. This may happen if a device provides several
3253                          * components
3254                          */
3255                         continue;
3256                 }
3257
3258                 break;
3259         }
3260         mutex_unlock(&client_mutex);
3261         return ret;
3262 }
3263 EXPORT_SYMBOL_GPL(snd_soc_get_dai_name);
3264
3265 int snd_soc_of_get_dai_name(struct device_node *of_node,
3266                             const char **dai_name)
3267 {
3268         struct of_phandle_args args;
3269         int ret;
3270
3271         ret = of_parse_phandle_with_args(of_node, "sound-dai",
3272                                          "#sound-dai-cells", 0, &args);
3273         if (ret)
3274                 return ret;
3275
3276         ret = snd_soc_get_dai_name(&args, dai_name);
3277
3278         of_node_put(args.np);
3279
3280         return ret;
3281 }
3282 EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_name);
3283
3284 /*
3285  * snd_soc_of_put_dai_link_codecs - Dereference device nodes in the codecs array
3286  * @dai_link: DAI link
3287  *
3288  * Dereference device nodes acquired by snd_soc_of_get_dai_link_codecs().
3289  */
3290 void snd_soc_of_put_dai_link_codecs(struct snd_soc_dai_link *dai_link)
3291 {
3292         struct snd_soc_dai_link_component *component;
3293         int index;
3294
3295         for_each_link_codecs(dai_link, index, component) {
3296                 if (!component->of_node)
3297                         break;
3298                 of_node_put(component->of_node);
3299                 component->of_node = NULL;
3300         }
3301 }
3302 EXPORT_SYMBOL_GPL(snd_soc_of_put_dai_link_codecs);
3303
3304 /*
3305  * snd_soc_of_get_dai_link_codecs - Parse a list of CODECs in the devicetree
3306  * @dev: Card device
3307  * @of_node: Device node
3308  * @dai_link: DAI link
3309  *
3310  * Builds an array of CODEC DAI components from the DAI link property
3311  * 'sound-dai'.
3312  * The array is set in the DAI link and the number of DAIs is set accordingly.
3313  * The device nodes in the array (of_node) must be dereferenced by calling
3314  * snd_soc_of_put_dai_link_codecs() on @dai_link.
3315  *
3316  * Returns 0 for success
3317  */
3318 int snd_soc_of_get_dai_link_codecs(struct device *dev,
3319                                    struct device_node *of_node,
3320                                    struct snd_soc_dai_link *dai_link)
3321 {
3322         struct of_phandle_args args;
3323         struct snd_soc_dai_link_component *component;
3324         char *name;
3325         int index, num_codecs, ret;
3326
3327         /* Count the number of CODECs */
3328         name = "sound-dai";
3329         num_codecs = of_count_phandle_with_args(of_node, name,
3330                                                 "#sound-dai-cells");
3331         if (num_codecs <= 0) {
3332                 if (num_codecs == -ENOENT)
3333                         dev_err(dev, "No 'sound-dai' property\n");
3334                 else
3335                         dev_err(dev, "Bad phandle in 'sound-dai'\n");
3336                 return num_codecs;
3337         }
3338         component = devm_kcalloc(dev,
3339                                  num_codecs, sizeof(*component),
3340                                  GFP_KERNEL);
3341         if (!component)
3342                 return -ENOMEM;
3343         dai_link->codecs = component;
3344         dai_link->num_codecs = num_codecs;
3345
3346         /* Parse the list */
3347         for_each_link_codecs(dai_link, index, component) {
3348                 ret = of_parse_phandle_with_args(of_node, name,
3349                                                  "#sound-dai-cells",
3350                                                  index, &args);
3351                 if (ret)
3352                         goto err;
3353                 component->of_node = args.np;
3354                 ret = snd_soc_get_dai_name(&args, &component->dai_name);
3355                 if (ret < 0)
3356                         goto err;
3357         }
3358         return 0;
3359 err:
3360         snd_soc_of_put_dai_link_codecs(dai_link);
3361         dai_link->codecs = NULL;
3362         dai_link->num_codecs = 0;
3363         return ret;
3364 }
3365 EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_link_codecs);
3366
3367 static int __init snd_soc_init(void)
3368 {
3369         snd_soc_debugfs_init();
3370         snd_soc_util_init();
3371
3372         return platform_driver_register(&soc_driver);
3373 }
3374 module_init(snd_soc_init);
3375
3376 static void __exit snd_soc_exit(void)
3377 {
3378         snd_soc_util_exit();
3379         snd_soc_debugfs_exit();
3380
3381         platform_driver_unregister(&soc_driver);
3382 }
3383 module_exit(snd_soc_exit);
3384
3385 /* Module information */
3386 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
3387 MODULE_DESCRIPTION("ALSA SoC Core");
3388 MODULE_LICENSE("GPL");
3389 MODULE_ALIAS("platform:soc-audio");