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