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