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