Linux Audio

Check our new training course

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