Linux Audio

Check our new training course

Loading...
v5.4
   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 <sound/core.h>
  35#include <sound/jack.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/initval.h>
  42
  43#define CREATE_TRACE_POINTS
  44#include <trace/events/asoc.h>
  45
  46#define NAME_SIZE	32
  47
  48#ifdef CONFIG_DEBUG_FS
  49struct dentry *snd_soc_debugfs_root;
  50EXPORT_SYMBOL_GPL(snd_soc_debugfs_root);
  51#endif
  52
  53static DEFINE_MUTEX(client_mutex);
 
 
  54static LIST_HEAD(component_list);
  55static LIST_HEAD(unbind_card_list);
  56
  57#define for_each_component(component)			\
  58	list_for_each_entry(component, &component_list, list)
  59
  60/*
  61 * This is used if driver don't need to have CPU/Codec/Platform
  62 * dai_link. see soc.h
  63 */
  64struct snd_soc_dai_link_component null_dailink_component[0];
  65EXPORT_SYMBOL_GPL(null_dailink_component);
  66
  67/*
  68 * This is a timeout to do a DAPM powerdown after a stream is closed().
  69 * It can be used to eliminate pops between different playback streams, e.g.
  70 * between two audio tracks.
  71 */
  72static int pmdown_time = 5000;
  73module_param(pmdown_time, int, 0);
  74MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
  75
  76#ifdef CONFIG_DMI
  77/*
  78 * If a DMI filed contain strings in this blacklist (e.g.
  79 * "Type2 - Board Manufacturer" or "Type1 - TBD by OEM"), it will be taken
  80 * as invalid and dropped when setting the card long name from DMI info.
  81 */
  82static const char * const dmi_blacklist[] = {
  83	"To be filled by OEM",
  84	"TBD by OEM",
  85	"Default String",
  86	"Board Manufacturer",
  87	"Board Vendor Name",
  88	"Board Product Name",
  89	NULL,	/* terminator */
  90};
  91#endif
  92
  93static ssize_t pmdown_time_show(struct device *dev,
  94				struct device_attribute *attr, char *buf)
 
  95{
  96	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
 
  97
  98	return sprintf(buf, "%ld\n", rtd->pmdown_time);
 
 
 
 
 
 
 
 
  99}
 100
 101static ssize_t pmdown_time_set(struct device *dev,
 102			       struct device_attribute *attr,
 103			       const char *buf, size_t count)
 
 104{
 105	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
 
 106	int ret;
 
 
 107
 108	ret = kstrtol(buf, 10, &rtd->pmdown_time);
 109	if (ret)
 110		return ret;
 111
 112	return count;
 113}
 114
 115static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
 
 
 116
 117static struct attribute *soc_dev_attrs[] = {
 118	&dev_attr_pmdown_time.attr,
 119	NULL
 120};
 
 
 
 121
 122static umode_t soc_dev_attr_is_visible(struct kobject *kobj,
 123				       struct attribute *attr, int idx)
 124{
 125	struct device *dev = kobj_to_dev(kobj);
 126	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
 127
 128	if (attr == &dev_attr_pmdown_time.attr)
 129		return attr->mode; /* always visible */
 130	return rtd->num_codecs ? attr->mode : 0; /* enabled only with codec */
 131}
 132
 133static const struct attribute_group soc_dapm_dev_group = {
 134	.attrs = soc_dapm_dev_attrs,
 135	.is_visible = soc_dev_attr_is_visible,
 136};
 
 
 
 
 
 137
 138static const struct attribute_group soc_dev_group = {
 139	.attrs = soc_dev_attrs,
 140	.is_visible = soc_dev_attr_is_visible,
 141};
 142
 143static const struct attribute_group *soc_dev_attr_groups[] = {
 144	&soc_dapm_dev_group,
 145	&soc_dev_group,
 146	NULL
 147};
 148
 149#ifdef CONFIG_DEBUG_FS
 150static void soc_init_component_debugfs(struct snd_soc_component *component)
 151{
 152	if (!component->card->debugfs_card_root)
 153		return;
 154
 155	if (component->debugfs_prefix) {
 156		char *name;
 157
 158		name = kasprintf(GFP_KERNEL, "%s:%s",
 159			component->debugfs_prefix, component->name);
 160		if (name) {
 161			component->debugfs_root = debugfs_create_dir(name,
 162				component->card->debugfs_card_root);
 163			kfree(name);
 
 
 
 
 
 
 
 
 
 
 164		}
 165	} else {
 166		component->debugfs_root = debugfs_create_dir(component->name,
 167				component->card->debugfs_card_root);
 168	}
 169
 170	snd_soc_dapm_debugfs_init(snd_soc_component_get_dapm(component),
 171		component->debugfs_root);
 
 172}
 173
 174static void soc_cleanup_component_debugfs(struct snd_soc_component *component)
 
 175{
 176	if (!component->debugfs_root)
 177		return;
 178	debugfs_remove_recursive(component->debugfs_root);
 179	component->debugfs_root = NULL;
 180}
 181
 182static int dai_list_show(struct seq_file *m, void *v)
 
 
 
 183{
 184	struct snd_soc_component *component;
 185	struct snd_soc_dai *dai;
 186
 187	mutex_lock(&client_mutex);
 
 188
 189	for_each_component(component)
 190		for_each_component_dais(component, dai)
 191			seq_printf(m, "%s\n", dai->name);
 
 
 
 192
 193	mutex_unlock(&client_mutex);
 
 
 194
 195	return 0;
 196}
 197DEFINE_SHOW_ATTRIBUTE(dai_list);
 198
 199static int component_list_show(struct seq_file *m, void *v)
 
 
 
 
 200{
 201	struct snd_soc_component *component;
 
 
 202
 203	mutex_lock(&client_mutex);
 
 204
 205	for_each_component(component)
 206		seq_printf(m, "%s\n", component->name);
 
 207
 208	mutex_unlock(&client_mutex);
 
 
 
 
 
 
 
 209
 210	return 0;
 
 211}
 212DEFINE_SHOW_ATTRIBUTE(component_list);
 213
 214static void soc_init_card_debugfs(struct snd_soc_card *card)
 
 215{
 216	card->debugfs_card_root = debugfs_create_dir(card->name,
 217						     snd_soc_debugfs_root);
 
 
 
 
 218
 219	debugfs_create_u32("dapm_pop_time", 0644, card->debugfs_card_root,
 220			   &card->pop_time);
 
 
 
 
 
 
 
 
 
 
 
 221
 222	snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
 223}
 224
 225static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
 226{
 227	debugfs_remove_recursive(card->debugfs_card_root);
 228	card->debugfs_card_root = NULL;
 229}
 230
 231static void snd_soc_debugfs_init(void)
 232{
 233	snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
 
 
 
 234
 235	debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
 236			    &dai_list_fops);
 
 237
 238	debugfs_create_file("components", 0444, snd_soc_debugfs_root, NULL,
 239			    &component_list_fops);
 240}
 
 
 
 
 241
 242static void snd_soc_debugfs_exit(void)
 243{
 244	debugfs_remove_recursive(snd_soc_debugfs_root);
 245}
 246
 247#else
 
 
 
 
 
 248
 249static inline void soc_init_component_debugfs(
 250	struct snd_soc_component *component)
 251{
 252}
 253
 254static inline void soc_cleanup_component_debugfs(
 255	struct snd_soc_component *component)
 256{
 
 257}
 258
 259static inline void soc_init_card_debugfs(struct snd_soc_card *card)
 260{
 261}
 262
 263static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
 264{
 
 
 
 
 
 
 
 
 265}
 266
 267static inline void snd_soc_debugfs_init(void)
 268{
 
 269}
 270
 271static inline void snd_soc_debugfs_exit(void)
 
 272{
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 273}
 274
 275#endif
 
 
 
 276
 277static int snd_soc_rtdcom_add(struct snd_soc_pcm_runtime *rtd,
 278			      struct snd_soc_component *component)
 279{
 280	struct snd_soc_rtdcom_list *rtdcom;
 281
 282	for_each_rtdcom(rtd, rtdcom) {
 283		/* already connected */
 284		if (rtdcom->component == component)
 285			return 0;
 286	}
 287
 288	rtdcom = kmalloc(sizeof(*rtdcom), GFP_KERNEL);
 289	if (!rtdcom)
 290		return -ENOMEM;
 291
 292	rtdcom->component = component;
 293	INIT_LIST_HEAD(&rtdcom->list);
 
 
 
 
 
 
 
 
 
 
 294
 295	list_add_tail(&rtdcom->list, &rtd->component_list);
 296
 297	return 0;
 
 
 298}
 299
 300static void snd_soc_rtdcom_del_all(struct snd_soc_pcm_runtime *rtd)
 301{
 302	struct snd_soc_rtdcom_list *rtdcom1, *rtdcom2;
 
 303
 304	for_each_rtdcom_safe(rtd, rtdcom1, rtdcom2)
 305		kfree(rtdcom1);
 
 
 
 
 
 306
 307	INIT_LIST_HEAD(&rtd->component_list);
 308}
 309
 310struct snd_soc_component *snd_soc_rtdcom_lookup(struct snd_soc_pcm_runtime *rtd,
 311						const char *driver_name)
 312{
 313	struct snd_soc_rtdcom_list *rtdcom;
 
 
 
 
 
 
 314
 315	if (!driver_name)
 316		return NULL;
 317
 318	/*
 319	 * NOTE
 320	 *
 321	 * snd_soc_rtdcom_lookup() will find component from rtd by using
 322	 * specified driver name.
 323	 * But, if many components which have same driver name are connected
 324	 * to 1 rtd, this function will return 1st found component.
 325	 */
 326	for_each_rtdcom(rtd, rtdcom) {
 327		const char *component_name = rtdcom->component->driver->name;
 328
 329		if (!component_name)
 330			continue;
 331
 332		if ((component_name == driver_name) ||
 333		    strcmp(component_name, driver_name) == 0)
 334			return rtdcom->component;
 
 
 
 
 
 
 
 
 
 
 335	}
 336
 337	return NULL;
 
 
 
 
 
 338}
 339EXPORT_SYMBOL_GPL(snd_soc_rtdcom_lookup);
 340
 341struct snd_pcm_substream *snd_soc_get_dai_substream(struct snd_soc_card *card,
 342		const char *dai_link, int stream)
 343{
 344	struct snd_soc_pcm_runtime *rtd;
 345
 346	for_each_card_rtds(card, rtd) {
 347		if (rtd->dai_link->no_pcm &&
 348			!strcmp(rtd->dai_link->name, dai_link))
 349			return rtd->pcm->streams[stream].substream;
 350	}
 351	dev_dbg(card->dev, "ASoC: failed to find dai link %s\n", dai_link);
 352	return NULL;
 353}
 354EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream);
 355
 356static const struct snd_soc_ops null_snd_soc_ops;
 357
 358static struct snd_soc_pcm_runtime *soc_new_pcm_runtime(
 359	struct snd_soc_card *card, struct snd_soc_dai_link *dai_link)
 360{
 361	struct snd_soc_pcm_runtime *rtd;
 362
 363	rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime), GFP_KERNEL);
 364	if (!rtd)
 365		return NULL;
 366
 367	INIT_LIST_HEAD(&rtd->component_list);
 368	rtd->card = card;
 369	rtd->dai_link = dai_link;
 370	if (!rtd->dai_link->ops)
 371		rtd->dai_link->ops = &null_snd_soc_ops;
 372
 373	rtd->codec_dais = kcalloc(dai_link->num_codecs,
 374					sizeof(struct snd_soc_dai *),
 375					GFP_KERNEL);
 376	if (!rtd->codec_dais) {
 377		kfree(rtd);
 378		return NULL;
 379	}
 380
 381	return rtd;
 
 382}
 383
 384static void soc_free_pcm_runtime(struct snd_soc_pcm_runtime *rtd)
 385{
 386	kfree(rtd->codec_dais);
 387	snd_soc_rtdcom_del_all(rtd);
 388	kfree(rtd);
 389}
 390
 391static void soc_add_pcm_runtime(struct snd_soc_card *card,
 392		struct snd_soc_pcm_runtime *rtd)
 393{
 394	/* see for_each_card_rtds */
 395	list_add_tail(&rtd->list, &card->rtd_list);
 396	rtd->num = card->num_rtd;
 397	card->num_rtd++;
 398}
 
 399
 400static void soc_remove_pcm_runtimes(struct snd_soc_card *card)
 
 401{
 402	struct snd_soc_pcm_runtime *rtd, *_rtd;
 403
 404	for_each_card_rtds_safe(card, rtd, _rtd) {
 405		list_del(&rtd->list);
 406		soc_free_pcm_runtime(rtd);
 
 407	}
 408
 409	card->num_rtd = 0;
 410}
 
 411
 412struct snd_soc_pcm_runtime *snd_soc_get_pcm_runtime(struct snd_soc_card *card,
 413		const char *dai_link)
 414{
 415	struct snd_soc_pcm_runtime *rtd;
 416
 417	for_each_card_rtds(card, rtd) {
 418		if (!strcmp(rtd->dai_link->name, dai_link))
 419			return rtd;
 420	}
 421	dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link);
 422	return NULL;
 423}
 424EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime);
 425
 426static void snd_soc_flush_all_delayed_work(struct snd_soc_card *card)
 
 
 427{
 428	struct snd_soc_pcm_runtime *rtd;
 
 
 
 429
 430	for_each_card_rtds(card, rtd)
 431		flush_delayed_work(&rtd->delayed_work);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 432}
 433
 434#ifdef CONFIG_PM_SLEEP
 435/* powers down audio subsystem for suspend */
 436int snd_soc_suspend(struct device *dev)
 437{
 438	struct snd_soc_card *card = dev_get_drvdata(dev);
 439	struct snd_soc_component *component;
 440	struct snd_soc_pcm_runtime *rtd;
 441	int i;
 442
 443	/* If the card is not initialized yet there is nothing to do */
 444	if (!card->instantiated)
 
 
 445		return 0;
 446
 447	/*
 448	 * Due to the resume being scheduled into a workqueue we could
 449	 * suspend before that's finished - wait for it to complete.
 450	 */
 
 451	snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
 
 452
 453	/* we're going to block userspace touching us until resume completes */
 454	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
 455
 456	/* mute any active DACs */
 457	for_each_card_rtds(card, rtd) {
 458		struct snd_soc_dai *dai;
 
 459
 460		if (rtd->dai_link->ignore_suspend)
 461			continue;
 462
 463		for_each_rtd_codec_dai(rtd, i, dai) {
 464			if (dai->playback_active)
 465				snd_soc_dai_digital_mute(dai, 1,
 466						SNDRV_PCM_STREAM_PLAYBACK);
 467		}
 468	}
 469
 470	/* suspend all pcms */
 471	for_each_card_rtds(card, rtd) {
 472		if (rtd->dai_link->ignore_suspend)
 473			continue;
 474
 475		snd_pcm_suspend_all(rtd->pcm);
 476	}
 477
 478	if (card->suspend_pre)
 479		card->suspend_pre(card);
 480
 481	for_each_card_rtds(card, rtd) {
 482		struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 
 483
 484		if (rtd->dai_link->ignore_suspend)
 485			continue;
 486
 487		if (!cpu_dai->driver->bus_control)
 488			snd_soc_dai_suspend(cpu_dai);
 
 
 
 
 489	}
 490
 491	/* close any waiting streams */
 492	snd_soc_flush_all_delayed_work(card);
 
 
 
 493
 494	for_each_card_rtds(card, rtd) {
 495
 496		if (rtd->dai_link->ignore_suspend)
 497			continue;
 498
 499		snd_soc_dapm_stream_event(rtd,
 500					  SNDRV_PCM_STREAM_PLAYBACK,
 501					  SND_SOC_DAPM_STREAM_SUSPEND);
 502
 503		snd_soc_dapm_stream_event(rtd,
 504					  SNDRV_PCM_STREAM_CAPTURE,
 505					  SND_SOC_DAPM_STREAM_SUSPEND);
 506	}
 507
 508	/* Recheck all endpoints too, their state is affected by suspend */
 509	dapm_mark_endpoints_dirty(card);
 510	snd_soc_dapm_sync(&card->dapm);
 511
 512	/* suspend all COMPONENTs */
 513	for_each_card_components(card, component) {
 514		struct snd_soc_dapm_context *dapm =
 515				snd_soc_component_get_dapm(component);
 516
 517		/*
 518		 * If there are paths active then the COMPONENT will be held
 519		 * with bias _ON and should not be suspended.
 520		 */
 521		if (!snd_soc_component_is_suspended(component)) {
 522			switch (snd_soc_dapm_get_bias_level(dapm)) {
 523			case SND_SOC_BIAS_STANDBY:
 524				/*
 525				 * If the COMPONENT is capable of idle
 526				 * bias off then being in STANDBY
 527				 * means it's doing something,
 528				 * otherwise fall through.
 529				 */
 530				if (dapm->idle_bias_off) {
 531					dev_dbg(component->dev,
 532						"ASoC: idle_bias_off CODEC on over suspend\n");
 533					break;
 534				}
 535				/* fall through */
 536
 537			case SND_SOC_BIAS_OFF:
 538				snd_soc_component_suspend(component);
 539				if (component->regmap)
 540					regcache_mark_dirty(component->regmap);
 
 
 541				/* deactivate pins to sleep state */
 542				pinctrl_pm_select_sleep_state(component->dev);
 543				break;
 544			default:
 545				dev_dbg(component->dev,
 546					"ASoC: COMPONENT is on over suspend\n");
 547				break;
 548			}
 549		}
 550	}
 551
 552	for_each_card_rtds(card, rtd) {
 553		struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 554
 555		if (rtd->dai_link->ignore_suspend)
 556			continue;
 557
 558		if (cpu_dai->driver->bus_control)
 559			snd_soc_dai_suspend(cpu_dai);
 560
 561		/* deactivate pins to sleep state */
 562		pinctrl_pm_select_sleep_state(cpu_dai->dev);
 563	}
 564
 565	if (card->suspend_post)
 566		card->suspend_post(card);
 567
 568	return 0;
 569}
 570EXPORT_SYMBOL_GPL(snd_soc_suspend);
 571
 572/*
 573 * deferred resume work, so resume can complete before we finished
 574 * setting our codec back up, which can be very slow on I2C
 575 */
 576static void soc_resume_deferred(struct work_struct *work)
 577{
 578	struct snd_soc_card *card =
 579			container_of(work, struct snd_soc_card,
 580				     deferred_resume_work);
 581	struct snd_soc_pcm_runtime *rtd;
 582	struct snd_soc_component *component;
 583	int i;
 584
 585	/*
 586	 * our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
 587	 * so userspace apps are blocked from touching us
 588	 */
 589
 590	dev_dbg(card->dev, "ASoC: starting resume work\n");
 591
 592	/* Bring us up into D2 so that DAPM starts enabling things */
 593	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
 594
 595	if (card->resume_pre)
 596		card->resume_pre(card);
 597
 598	/* resume control bus DAIs */
 599	for_each_card_rtds(card, rtd) {
 600		struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 601
 602		if (rtd->dai_link->ignore_suspend)
 603			continue;
 604
 605		if (cpu_dai->driver->bus_control)
 606			snd_soc_dai_resume(cpu_dai);
 607	}
 608
 609	for_each_card_components(card, component) {
 610		if (snd_soc_component_is_suspended(component))
 611			snd_soc_component_resume(component);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 612	}
 613
 614	for_each_card_rtds(card, rtd) {
 615
 616		if (rtd->dai_link->ignore_suspend)
 617			continue;
 618
 619		snd_soc_dapm_stream_event(rtd,
 620					  SNDRV_PCM_STREAM_PLAYBACK,
 621					  SND_SOC_DAPM_STREAM_RESUME);
 622
 623		snd_soc_dapm_stream_event(rtd,
 624					  SNDRV_PCM_STREAM_CAPTURE,
 625					  SND_SOC_DAPM_STREAM_RESUME);
 626	}
 627
 628	/* unmute any active DACs */
 629	for_each_card_rtds(card, rtd) {
 630		struct snd_soc_dai *dai;
 
 631
 632		if (rtd->dai_link->ignore_suspend)
 633			continue;
 634
 635		for_each_rtd_codec_dai(rtd, i, dai) {
 636			if (dai->playback_active)
 637				snd_soc_dai_digital_mute(dai, 0,
 638						SNDRV_PCM_STREAM_PLAYBACK);
 639		}
 640	}
 641
 642	for_each_card_rtds(card, rtd) {
 643		struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 
 644
 645		if (rtd->dai_link->ignore_suspend)
 646			continue;
 647
 648		if (!cpu_dai->driver->bus_control)
 649			snd_soc_dai_resume(cpu_dai);
 
 
 
 
 650	}
 651
 652	if (card->resume_post)
 653		card->resume_post(card);
 654
 655	dev_dbg(card->dev, "ASoC: resume work completed\n");
 656
 657	/* Recheck all endpoints too, their state is affected by suspend */
 658	dapm_mark_endpoints_dirty(card);
 659	snd_soc_dapm_sync(&card->dapm);
 660
 661	/* userspace can access us now we are back as we were before */
 662	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
 
 
 
 
 663}
 664
 665/* powers up audio subsystem after a suspend */
 666int snd_soc_resume(struct device *dev)
 667{
 668	struct snd_soc_card *card = dev_get_drvdata(dev);
 669	bool bus_control = false;
 670	struct snd_soc_pcm_runtime *rtd;
 671	struct snd_soc_dai *codec_dai;
 672	int i;
 673
 674	/* If the card is not initialized yet there is nothing to do */
 675	if (!card->instantiated)
 
 
 676		return 0;
 677
 678	/* activate pins from sleep state */
 679	for_each_card_rtds(card, rtd) {
 680		struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 681
 682		if (cpu_dai->active)
 683			pinctrl_pm_select_default_state(cpu_dai->dev);
 684
 685		for_each_rtd_codec_dai(rtd, i, codec_dai) {
 686			if (codec_dai->active)
 687				pinctrl_pm_select_default_state(codec_dai->dev);
 688		}
 689	}
 690
 691	/*
 692	 * DAIs that also act as the control bus master might have other drivers
 693	 * hanging off them so need to resume immediately. Other drivers don't
 694	 * have that problem and may take a substantial amount of time to resume
 695	 * due to I/O costs and anti-pop so handle them out of line.
 696	 */
 697	for_each_card_rtds(card, rtd) {
 698		struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 699
 700		bus_control |= cpu_dai->driver->bus_control;
 701	}
 702	if (bus_control) {
 703		dev_dbg(dev, "ASoC: Resuming control bus master immediately\n");
 704		soc_resume_deferred(&card->deferred_resume_work);
 705	} else {
 706		dev_dbg(dev, "ASoC: Scheduling resume work\n");
 707		if (!schedule_work(&card->deferred_resume_work))
 708			dev_err(dev, "ASoC: resume work item may be lost\n");
 709	}
 710
 711	return 0;
 712}
 713EXPORT_SYMBOL_GPL(snd_soc_resume);
 714
 715static void soc_resume_init(struct snd_soc_card *card)
 716{
 717	/* deferred resume work */
 718	INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
 719}
 720#else
 721#define snd_soc_suspend NULL
 722#define snd_soc_resume NULL
 723static inline void soc_resume_init(struct snd_soc_card *card)
 724{
 725}
 726#endif
 727
 728static const struct snd_soc_dai_ops null_dai_ops = {
 729};
 730
 731static struct device_node
 732*soc_component_to_node(struct snd_soc_component *component)
 733{
 734	struct device_node *of_node;
 735
 736	of_node = component->dev->of_node;
 737	if (!of_node && component->dev->parent)
 738		of_node = component->dev->parent->of_node;
 739
 740	return of_node;
 741}
 742
 743static int snd_soc_is_matching_component(
 744	const struct snd_soc_dai_link_component *dlc,
 745	struct snd_soc_component *component)
 746{
 747	struct device_node *component_of_node;
 748
 749	if (!dlc)
 750		return 0;
 751
 752	component_of_node = soc_component_to_node(component);
 753
 754	if (dlc->of_node && component_of_node != dlc->of_node)
 755		return 0;
 756	if (dlc->name && strcmp(component->name, dlc->name))
 757		return 0;
 758
 759	return 1;
 760}
 761
 762static struct snd_soc_component *soc_find_component(
 763	const struct snd_soc_dai_link_component *dlc)
 764{
 765	struct snd_soc_component *component;
 766
 767	lockdep_assert_held(&client_mutex);
 768
 769	/*
 770	 * NOTE
 771	 *
 772	 * It returns *1st* found component, but some driver
 773	 * has few components by same of_node/name
 774	 * ex)
 775	 *	CPU component and generic DMAEngine component
 776	 */
 777	for_each_component(component)
 778		if (snd_soc_is_matching_component(dlc, component))
 779			return component;
 780
 781	return NULL;
 782}
 783
 784/**
 785 * snd_soc_find_dai - Find a registered DAI
 786 *
 787 * @dlc: name of the DAI or the DAI driver and optional component info to match
 788 *
 789 * This function will search all registered components and their DAIs to
 790 * find the DAI of the same name. The component's of_node and name
 791 * should also match if being specified.
 792 *
 793 * Return: pointer of DAI, or NULL if not found.
 794 */
 795struct snd_soc_dai *snd_soc_find_dai(
 796	const struct snd_soc_dai_link_component *dlc)
 797{
 
 
 798	struct snd_soc_component *component;
 799	struct snd_soc_dai *dai;
 800
 801	lockdep_assert_held(&client_mutex);
 802
 803	/* Find CPU DAI from registered DAIs */
 804	for_each_component(component) {
 805		if (!snd_soc_is_matching_component(dlc, component))
 
 
 
 
 
 
 
 806			continue;
 807		for_each_component_dais(component, dai) {
 808			if (dlc->dai_name && strcmp(dai->name, dlc->dai_name)
 809			    && (!dai->driver->name
 810				|| strcmp(dai->driver->name, dlc->dai_name)))
 811				continue;
 812
 813			return dai;
 814		}
 815	}
 816
 817	return NULL;
 818}
 819EXPORT_SYMBOL_GPL(snd_soc_find_dai);
 820
 821/**
 822 * snd_soc_find_dai_link - Find a DAI link
 823 *
 824 * @card: soc card
 825 * @id: DAI link ID to match
 826 * @name: DAI link name to match, optional
 827 * @stream_name: DAI link stream name to match, optional
 828 *
 829 * This function will search all existing DAI links of the soc card to
 830 * find the link of the same ID. Since DAI links may not have their
 831 * unique ID, so name and stream name should also match if being
 832 * specified.
 833 *
 834 * Return: pointer of DAI link, or NULL if not found.
 835 */
 836struct snd_soc_dai_link *snd_soc_find_dai_link(struct snd_soc_card *card,
 837					       int id, const char *name,
 838					       const char *stream_name)
 839{
 840	struct snd_soc_dai_link *link;
 841
 842	lockdep_assert_held(&client_mutex);
 843
 844	for_each_card_links(card, link) {
 845		if (link->id != id)
 846			continue;
 847
 848		if (name && (!link->name || strcmp(name, link->name)))
 849			continue;
 850
 851		if (stream_name && (!link->stream_name
 852			|| strcmp(stream_name, link->stream_name)))
 853			continue;
 854
 855		return link;
 856	}
 857
 858	return NULL;
 859}
 860EXPORT_SYMBOL_GPL(snd_soc_find_dai_link);
 861
 862static bool soc_is_dai_link_bound(struct snd_soc_card *card,
 863		struct snd_soc_dai_link *dai_link)
 864{
 865	struct snd_soc_pcm_runtime *rtd;
 866
 867	for_each_card_rtds(card, rtd) {
 868		if (rtd->dai_link == dai_link)
 869			return true;
 870	}
 871
 872	return false;
 873}
 874
 875static int soc_bind_dai_link(struct snd_soc_card *card,
 876	struct snd_soc_dai_link *dai_link)
 877{
 878	struct snd_soc_pcm_runtime *rtd;
 879	struct snd_soc_dai_link_component *codec, *platform;
 880	struct snd_soc_component *component;
 881	int i;
 882
 883	if (dai_link->ignore)
 884		return 0;
 885
 886	dev_dbg(card->dev, "ASoC: binding %s\n", dai_link->name);
 
 
 
 
 
 
 
 
 
 887
 888	if (soc_is_dai_link_bound(card, dai_link)) {
 889		dev_dbg(card->dev, "ASoC: dai link %s already bound\n",
 890			dai_link->name);
 891		return 0;
 
 892	}
 893
 894	rtd = soc_new_pcm_runtime(card, dai_link);
 895	if (!rtd)
 896		return -ENOMEM;
 897
 898	/* FIXME: we need multi CPU support in the future */
 899	rtd->cpu_dai = snd_soc_find_dai(dai_link->cpus);
 900	if (!rtd->cpu_dai) {
 901		dev_info(card->dev, "ASoC: CPU DAI %s not registered\n",
 902			 dai_link->cpus->dai_name);
 903		goto _err_defer;
 904	}
 905	snd_soc_rtdcom_add(rtd, rtd->cpu_dai->component);
 906
 907	/* Find CODEC from registered CODECs */
 908	rtd->num_codecs = dai_link->num_codecs;
 909	for_each_link_codecs(dai_link, i, codec) {
 910		rtd->codec_dais[i] = snd_soc_find_dai(codec);
 911		if (!rtd->codec_dais[i]) {
 912			dev_info(card->dev, "ASoC: CODEC DAI %s not registered\n",
 913				 codec->dai_name);
 914			goto _err_defer;
 
 
 
 
 
 
 915		}
 916
 917		snd_soc_rtdcom_add(rtd, rtd->codec_dais[i]->component);
 918	}
 919
 920	/* Single codec links expect codec and codec_dai in runtime data */
 921	rtd->codec_dai = rtd->codec_dais[0];
 922
 923	/* Find PLATFORM from registered PLATFORMs */
 924	for_each_link_platforms(dai_link, i, platform) {
 925		for_each_component(component) {
 926			if (!snd_soc_is_matching_component(platform, component))
 927				continue;
 928
 929			snd_soc_rtdcom_add(rtd, component);
 930		}
 931	}
 932
 933	soc_add_pcm_runtime(card, rtd);
 934	return 0;
 935
 936_err_defer:
 937	soc_free_pcm_runtime(rtd);
 938	return -EPROBE_DEFER;
 939}
 940
 941static void soc_set_of_name_prefix(struct snd_soc_component *component)
 942{
 943	struct device_node *of_node = soc_component_to_node(component);
 944	const char *str;
 945	int ret;
 946
 947	ret = of_property_read_string(of_node, "sound-name-prefix", &str);
 948	if (!ret)
 949		component->name_prefix = str;
 950}
 951
 952static void soc_set_name_prefix(struct snd_soc_card *card,
 953				struct snd_soc_component *component)
 954{
 955	int i;
 956
 957	for (i = 0; i < card->num_configs && card->codec_conf; i++) {
 958		struct snd_soc_codec_conf *map = &card->codec_conf[i];
 959		struct device_node *of_node = soc_component_to_node(component);
 960
 961		if (map->of_node && of_node != map->of_node)
 962			continue;
 963		if (map->dev_name && strcmp(component->name, map->dev_name))
 964			continue;
 965		component->name_prefix = map->name_prefix;
 966		return;
 967	}
 968
 969	/*
 970	 * If there is no configuration table or no match in the table,
 971	 * check if a prefix is provided in the node
 972	 */
 973	soc_set_of_name_prefix(component);
 974}
 975
 976static void soc_cleanup_component(struct snd_soc_component *component)
 977{
 978	/* For framework level robustness */
 979	snd_soc_component_set_jack(component, NULL, NULL);
 980
 981	list_del_init(&component->card_list);
 982	snd_soc_dapm_free(snd_soc_component_get_dapm(component));
 983	soc_cleanup_component_debugfs(component);
 984	component->card = NULL;
 985	snd_soc_component_module_put_when_remove(component);
 986}
 987
 988static void soc_remove_component(struct snd_soc_component *component)
 989{
 990	if (!component->card)
 991		return;
 992
 993	snd_soc_component_remove(component);
 
 
 
 
 994
 995	soc_cleanup_component(component);
 
 
 
 
 
 
 996}
 997
 998static int soc_probe_component(struct snd_soc_card *card,
 999			       struct snd_soc_component *component)
1000{
1001	struct snd_soc_dapm_context *dapm =
1002		snd_soc_component_get_dapm(component);
1003	struct snd_soc_dai *dai;
1004	int ret;
1005
1006	if (!strcmp(component->name, "snd-soc-dummy"))
1007		return 0;
1008
1009	if (component->card) {
1010		if (component->card != card) {
1011			dev_err(component->dev,
1012				"Trying to bind component to card \"%s\" but is already bound to card \"%s\"\n",
1013				card->name, component->card->name);
1014			return -ENODEV;
1015		}
1016		return 0;
1017	}
1018
1019	ret = snd_soc_component_module_get_when_probe(component);
1020	if (ret < 0)
1021		return ret;
1022
1023	component->card = card;
1024	soc_set_name_prefix(card, component);
1025
1026	soc_init_component_debugfs(component);
1027
1028	snd_soc_dapm_init(dapm, card, component);
1029
1030	ret = snd_soc_dapm_new_controls(dapm,
1031					component->driver->dapm_widgets,
1032					component->driver->num_dapm_widgets);
1033
1034	if (ret != 0) {
1035		dev_err(component->dev,
1036			"Failed to create new controls %d\n", ret);
1037		goto err_probe;
1038	}
1039
1040	for_each_component_dais(component, dai) {
1041		ret = snd_soc_dapm_new_dai_widgets(dapm, dai);
1042		if (ret != 0) {
1043			dev_err(component->dev,
1044				"Failed to create DAI widgets %d\n", ret);
1045			goto err_probe;
 
 
 
1046		}
1047	}
 
1048
1049	ret = snd_soc_component_probe(component);
1050	if (ret < 0) {
1051		dev_err(component->dev,
1052			"ASoC: failed to probe component %d\n", ret);
1053		goto err_probe;
1054	}
1055	WARN(dapm->idle_bias_off &&
1056	     dapm->bias_level != SND_SOC_BIAS_OFF,
1057	     "codec %s can not start from non-off bias with idle_bias_off==1\n",
1058	     component->name);
1059
1060	/* machine specific init */
1061	if (component->init) {
1062		ret = component->init(component);
1063		if (ret < 0) {
1064			dev_err(component->dev,
1065				"Failed to do machine specific init %d\n", ret);
1066			goto err_probe;
1067		}
1068	}
1069
1070	ret = snd_soc_add_component_controls(component,
1071					     component->driver->controls,
1072					     component->driver->num_controls);
1073	if (ret < 0)
1074		goto err_probe;
1075
1076	ret = snd_soc_dapm_add_routes(dapm,
1077				      component->driver->dapm_routes,
1078				      component->driver->num_dapm_routes);
1079	if (ret < 0)
1080		goto err_probe;
1081
1082	/* see for_each_card_components */
1083	list_add(&component->card_list, &card->component_dev_list);
1084
1085err_probe:
1086	if (ret < 0)
1087		soc_cleanup_component(component);
1088
1089	return ret;
1090}
1091
1092static void soc_remove_dai(struct snd_soc_dai *dai, int order)
 
1093{
1094	int err;
1095
1096	if (!dai || !dai->probed || !dai->driver ||
1097	    dai->driver->remove_order != order)
1098		return;
1099
1100	err = snd_soc_dai_remove(dai);
1101	if (err < 0)
1102		dev_err(dai->dev,
1103			"ASoC: failed to remove %s: %d\n",
1104			dai->name, err);
1105
1106	dai->probed = 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1107}
1108
1109static int soc_probe_dai(struct snd_soc_dai *dai, int order)
1110{
1111	int ret;
1112
1113	if (dai->probed ||
1114	    dai->driver->probe_order != order)
1115		return 0;
1116
1117	ret = snd_soc_dai_probe(dai);
1118	if (ret < 0) {
1119		dev_err(dai->dev, "ASoC: failed to probe DAI %s: %d\n",
1120			dai->name, ret);
1121		return ret;
1122	}
1123
1124	dai->probed = 1;
 
 
 
 
1125
1126	return 0;
1127}
1128
1129static void soc_rtd_free(struct snd_soc_pcm_runtime *rtd); /* remove me */
1130static void soc_remove_link_dais(struct snd_soc_card *card)
1131{
1132	int i;
1133	struct snd_soc_dai *codec_dai;
1134	struct snd_soc_pcm_runtime *rtd;
1135	int order;
1136
1137	for_each_comp_order(order) {
1138		for_each_card_rtds(card, rtd) {
1139
1140			/* finalize rtd device */
1141			soc_rtd_free(rtd);
1142
1143			/* remove the CODEC DAI */
1144			for_each_rtd_codec_dai(rtd, i, codec_dai)
1145				soc_remove_dai(codec_dai, order);
1146
1147			soc_remove_dai(rtd->cpu_dai, order);
 
 
 
 
1148		}
1149	}
1150}
1151
1152static int soc_probe_link_dais(struct snd_soc_card *card)
 
1153{
1154	struct snd_soc_dai *codec_dai;
1155	struct snd_soc_pcm_runtime *rtd;
1156	int i, order, ret;
1157
1158	for_each_comp_order(order) {
1159		for_each_card_rtds(card, rtd) {
1160
1161			dev_dbg(card->dev,
1162				"ASoC: probe %s dai link %d late %d\n",
1163				card->name, rtd->num, order);
1164
1165			ret = soc_probe_dai(rtd->cpu_dai, order);
1166			if (ret)
1167				return ret;
1168
1169			/* probe the CODEC DAI */
1170			for_each_rtd_codec_dai(rtd, i, codec_dai) {
1171				ret = soc_probe_dai(codec_dai, order);
1172				if (ret)
1173					return ret;
1174			}
1175		}
1176	}
1177
1178	return 0;
1179}
1180
1181static void soc_remove_link_components(struct snd_soc_card *card)
1182{
1183	struct snd_soc_component *component;
1184	struct snd_soc_pcm_runtime *rtd;
1185	struct snd_soc_rtdcom_list *rtdcom;
1186	int order;
1187
1188	for_each_comp_order(order) {
1189		for_each_card_rtds(card, rtd) {
1190			for_each_rtdcom(rtd, rtdcom) {
1191				component = rtdcom->component;
1192
1193				if (component->driver->remove_order != order)
1194					continue;
1195
1196				soc_remove_component(component);
1197			}
 
 
 
 
 
1198		}
1199	}
1200}
1201
1202static int soc_probe_link_components(struct snd_soc_card *card)
1203{
1204	struct snd_soc_component *component;
1205	struct snd_soc_pcm_runtime *rtd;
1206	struct snd_soc_rtdcom_list *rtdcom;
1207	int ret, order;
1208
1209	for_each_comp_order(order) {
1210		for_each_card_rtds(card, rtd) {
1211			for_each_rtdcom(rtd, rtdcom) {
1212				component = rtdcom->component;
1213
1214				if (component->driver->probe_order != order)
1215					continue;
1216
1217				ret = soc_probe_component(card, component);
1218				if (ret < 0)
1219					return ret;
1220			}
1221		}
1222	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1223
1224	return 0;
1225}
1226
1227static void soc_remove_dai_links(struct snd_soc_card *card)
1228{
1229	struct snd_soc_dai_link *link, *_link;
1230
1231	soc_remove_link_dais(card);
1232
1233	soc_remove_link_components(card);
1234
1235	for_each_card_links_safe(card, link, _link) {
1236		if (link->dobj.type == SND_SOC_DOBJ_DAI_LINK)
1237			dev_warn(card->dev, "Topology forgot to remove link %s?\n",
1238				link->name);
1239
1240		list_del(&link->list);
1241	}
1242}
1243
1244static int soc_init_dai_link(struct snd_soc_card *card,
1245			     struct snd_soc_dai_link *link)
1246{
1247	int i;
1248	struct snd_soc_dai_link_component *codec, *platform;
 
 
1249
1250	for_each_link_codecs(link, i, codec) {
1251		/*
1252		 * Codec must be specified by 1 of name or OF node,
1253		 * not both or neither.
1254		 */
1255		if (!!codec->name == !!codec->of_node) {
1256			dev_err(card->dev, "ASoC: Neither/both codec name/of_node are set for %s\n",
1257				link->name);
1258			return -EINVAL;
1259		}
1260
1261		/* Codec DAI name must be specified */
1262		if (!codec->dai_name) {
1263			dev_err(card->dev, "ASoC: codec_dai_name not set for %s\n",
1264				link->name);
1265			return -EINVAL;
1266		}
1267
1268		/*
1269		 * Defer card registration if codec component is not added to
1270		 * component list.
1271		 */
1272		if (!soc_find_component(codec))
1273			return -EPROBE_DEFER;
1274	}
1275
1276	for_each_link_platforms(link, i, platform) {
1277		/*
1278		 * Platform may be specified by either name or OF node, but it
1279		 * can be left unspecified, then no components will be inserted
1280		 * in the rtdcom list
1281		 */
1282		if (!!platform->name == !!platform->of_node) {
1283			dev_err(card->dev,
1284				"ASoC: Neither/both platform name/of_node are set for %s\n",
1285				link->name);
1286			return -EINVAL;
1287		}
1288
1289		/*
1290		 * Defer card registration if platform component is not added to
1291		 * component list.
1292		 */
1293		if (!soc_find_component(platform))
1294			return -EPROBE_DEFER;
1295	}
1296
1297	/* FIXME */
1298	if (link->num_cpus > 1) {
1299		dev_err(card->dev,
1300			"ASoC: multi cpu is not yet supported %s\n",
1301			link->name);
1302		return -EINVAL;
1303	}
1304
1305	/*
1306	 * CPU device may be specified by either name or OF node, but
1307	 * can be left unspecified, and will be matched based on DAI
1308	 * name alone..
1309	 */
1310	if (link->cpus->name && link->cpus->of_node) {
1311		dev_err(card->dev,
1312			"ASoC: Neither/both cpu name/of_node are set for %s\n",
1313			link->name);
1314		return -EINVAL;
1315	}
1316
1317	/*
1318	 * Defer card registartion if cpu dai component is not added to
1319	 * component list.
1320	 */
1321	if ((link->cpus->of_node || link->cpus->name) &&
1322	    !soc_find_component(link->cpus))
1323		return -EPROBE_DEFER;
1324
1325	/*
1326	 * At least one of CPU DAI name or CPU device name/node must be
1327	 * specified
1328	 */
1329	if (!link->cpus->dai_name &&
1330	    !(link->cpus->name || link->cpus->of_node)) {
1331		dev_err(card->dev,
1332			"ASoC: Neither cpu_dai_name nor cpu_name/of_node are set for %s\n",
1333			link->name);
1334		return -EINVAL;
1335	}
1336
1337	return 0;
1338}
1339
1340void snd_soc_disconnect_sync(struct device *dev)
1341{
1342	struct snd_soc_component *component =
1343			snd_soc_lookup_component(dev, NULL);
1344
1345	if (!component || !component->card)
1346		return;
 
1347
1348	snd_card_disconnect_sync(component->card->snd_card);
1349}
1350EXPORT_SYMBOL_GPL(snd_soc_disconnect_sync);
1351
1352/**
1353 * snd_soc_add_dai_link - Add a DAI link dynamically
1354 * @card: The ASoC card to which the DAI link is added
1355 * @dai_link: The new DAI link to add
1356 *
1357 * This function adds a DAI link to the ASoC card's link list.
1358 *
1359 * Note: Topology can use this API to add DAI links when probing the
1360 * topology component. And machine drivers can still define static
1361 * DAI links in dai_link array.
1362 */
1363int snd_soc_add_dai_link(struct snd_soc_card *card,
1364		struct snd_soc_dai_link *dai_link)
1365{
1366	if (dai_link->dobj.type
1367	    && dai_link->dobj.type != SND_SOC_DOBJ_DAI_LINK) {
1368		dev_err(card->dev, "Invalid dai link type %d\n",
1369			dai_link->dobj.type);
1370		return -EINVAL;
1371	}
1372
1373	lockdep_assert_held(&client_mutex);
1374	/*
1375	 * Notify the machine driver for extra initialization
1376	 * on the link created by topology.
1377	 */
1378	if (dai_link->dobj.type && card->add_dai_link)
1379		card->add_dai_link(card, dai_link);
1380
1381	/* see for_each_card_links */
1382	list_add_tail(&dai_link->list, &card->dai_link_list);
1383
1384	return 0;
1385}
1386EXPORT_SYMBOL_GPL(snd_soc_add_dai_link);
1387
1388/**
1389 * snd_soc_remove_dai_link - Remove a DAI link from the list
1390 * @card: The ASoC card that owns the link
1391 * @dai_link: The DAI link to remove
1392 *
1393 * This function removes a DAI link from the ASoC card's link list.
1394 *
1395 * For DAI links previously added by topology, topology should
1396 * remove them by using the dobj embedded in the link.
1397 */
1398void snd_soc_remove_dai_link(struct snd_soc_card *card,
1399			     struct snd_soc_dai_link *dai_link)
1400{
1401	if (dai_link->dobj.type
1402	    && dai_link->dobj.type != SND_SOC_DOBJ_DAI_LINK) {
1403		dev_err(card->dev, "Invalid dai link type %d\n",
1404			dai_link->dobj.type);
1405		return;
1406	}
1407
1408	lockdep_assert_held(&client_mutex);
1409	/*
1410	 * Notify the machine driver for extra destruction
1411	 * on the link created by topology.
1412	 */
1413	if (dai_link->dobj.type && card->remove_dai_link)
1414		card->remove_dai_link(card, dai_link);
1415
1416	list_del(&dai_link->list);
1417}
1418EXPORT_SYMBOL_GPL(snd_soc_remove_dai_link);
1419
1420static void soc_rtd_free(struct snd_soc_pcm_runtime *rtd)
1421{
1422	if (rtd->dev_registered) {
1423		/* we don't need to call kfree() for rtd->dev */
1424		device_unregister(rtd->dev);
1425		rtd->dev_registered = 0;
 
 
1426	}
1427}
1428
1429static void soc_rtd_release(struct device *dev)
1430{
1431	kfree(dev);
1432}
1433
1434static int soc_rtd_init(struct snd_soc_pcm_runtime *rtd, const char *name)
1435{
1436	int ret = 0;
 
 
 
 
 
 
1437
1438	/* register the rtd device */
 
 
1439	rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL);
1440	if (!rtd->dev)
1441		return -ENOMEM;
1442	rtd->dev->parent = rtd->card->dev;
1443	rtd->dev->release = soc_rtd_release;
1444	rtd->dev->groups = soc_dev_attr_groups;
1445	dev_set_name(rtd->dev, "%s", name);
1446	dev_set_drvdata(rtd->dev, rtd);
 
1447	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients);
1448	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].be_clients);
1449	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].fe_clients);
1450	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].fe_clients);
1451	ret = device_register(rtd->dev);
1452	if (ret < 0) {
1453		/* calling put_device() here to free the rtd->dev */
1454		put_device(rtd->dev);
1455		dev_err(rtd->card->dev,
1456			"ASoC: failed to register runtime device: %d\n", ret);
1457		return ret;
1458	}
1459	rtd->dev_registered = 1;
1460	return 0;
1461}
1462
1463static int soc_link_dai_pcm_new(struct snd_soc_dai **dais, int num_dais,
1464				struct snd_soc_pcm_runtime *rtd)
1465{
1466	int i, ret = 0;
 
1467
1468	for (i = 0; i < num_dais; ++i) {
1469		struct snd_soc_dai_driver *drv = dais[i]->driver;
 
 
 
1470
1471		if (drv->pcm_new)
1472			ret = drv->pcm_new(rtd, dais[i]);
1473		if (ret < 0) {
1474			dev_err(dais[i]->dev,
1475				"ASoC: Failed to bind %s with pcm device\n",
1476				dais[i]->name);
1477			return ret;
1478		}
1479	}
1480
 
 
1481	return 0;
1482}
1483
1484static int soc_link_init(struct snd_soc_card *card,
1485			 struct snd_soc_pcm_runtime *rtd)
1486{
1487	struct snd_soc_dai_link *dai_link = rtd->dai_link;
1488	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1489	struct snd_soc_rtdcom_list *rtdcom;
1490	struct snd_soc_component *component;
1491	int ret, num;
1492
1493	/* set default power off timeout */
1494	rtd->pmdown_time = pmdown_time;
 
 
 
 
 
 
1495
1496	/* do machine specific initialization */
1497	if (dai_link->init) {
1498		ret = dai_link->init(rtd);
1499		if (ret < 0) {
1500			dev_err(card->dev, "ASoC: failed to init %s: %d\n",
1501				dai_link->name, ret);
1502			return ret;
1503		}
1504	}
1505
1506	if (dai_link->dai_fmt) {
1507		ret = snd_soc_runtime_set_dai_fmt(rtd, dai_link->dai_fmt);
1508		if (ret)
 
 
1509			return ret;
1510	}
1511
1512	ret = soc_rtd_init(rtd, dai_link->name);
1513	if (ret)
1514		return ret;
1515
1516	/* add DPCM sysfs entries */
1517	soc_dpcm_debugfs_add(rtd);
 
 
 
 
 
 
 
 
1518
1519	num = rtd->num;
 
1520
1521	/*
1522	 * most drivers will register their PCMs using DAI link ordering but
1523	 * topology based drivers can use the DAI link id field to set PCM
1524	 * device number and then use rtd + a base offset of the BEs.
1525	 */
1526	for_each_rtdcom(rtd, rtdcom) {
1527		component = rtdcom->component;
1528
1529		if (!component->driver->use_dai_pcm_id)
1530			continue;
1531
1532		if (rtd->dai_link->no_pcm)
1533			num += component->driver->be_pcm_base;
1534		else
1535			num = rtd->dai_link->id;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1536	}
1537
1538	/* create compress_device if possible */
1539	ret = snd_soc_dai_compress_new(cpu_dai, rtd, num);
1540	if (ret != -ENOTSUPP) {
1541		if (ret < 0)
1542			dev_err(card->dev, "ASoC: can't create compress %s\n",
1543					 dai_link->stream_name);
1544		return ret;
1545	}
 
 
 
1546
1547	/* create the pcm */
1548	ret = soc_new_pcm(rtd, num);
1549	if (ret < 0) {
1550		dev_err(card->dev, "ASoC: can't create pcm %s :%d\n",
1551			dai_link->stream_name, ret);
1552		return ret;
1553	}
1554	ret = soc_link_dai_pcm_new(&cpu_dai, 1, rtd);
1555	if (ret < 0)
1556		return ret;
1557	ret = soc_link_dai_pcm_new(rtd->codec_dais,
1558				   rtd->num_codecs, rtd);
1559	return ret;
1560}
1561
1562static void soc_unbind_aux_dev(struct snd_soc_card *card)
1563{
1564	struct snd_soc_component *component, *_component;
1565
1566	for_each_card_auxs_safe(card, component, _component) {
1567		component->init = NULL;
1568		list_del(&component->card_aux_list);
1569	}
1570}
1571
1572static int soc_bind_aux_dev(struct snd_soc_card *card)
1573{
1574	struct snd_soc_component *component;
1575	struct snd_soc_aux_dev *aux;
1576	int i;
1577
1578	for_each_card_pre_auxs(card, i, aux) {
1579		/* codecs, usually analog devices */
1580		component = soc_find_component(&aux->dlc);
1581		if (!component)
1582			return -EPROBE_DEFER;
1583
1584		component->init = aux->init;
1585		/* see for_each_card_auxs */
1586		list_add(&component->card_aux_list, &card->aux_comp_list);
1587	}
1588	return 0;
1589}
 
 
 
1590
1591static int soc_probe_aux_devices(struct snd_soc_card *card)
1592{
1593	struct snd_soc_component *comp;
1594	int order;
1595	int ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1596
1597	for_each_comp_order(order) {
1598		for_each_card_auxs(card, comp) {
1599			if (comp->driver->probe_order == order) {
1600				ret = soc_probe_component(card,	comp);
1601				if (ret < 0) {
1602					dev_err(card->dev,
1603						"ASoC: failed to probe aux component %s %d\n",
1604						comp->name, ret);
1605					return ret;
1606				}
1607			}
1608		}
1609	}
1610
1611	return 0;
1612}
 
1613
1614static void soc_remove_aux_devices(struct snd_soc_card *card)
1615{
1616	struct snd_soc_component *comp, *_comp;
1617	int order;
1618
1619	for_each_comp_order(order) {
1620		for_each_card_auxs_safe(card, comp, _comp) {
1621			if (comp->driver->remove_order == order)
1622				soc_remove_component(comp);
1623		}
1624	}
1625}
1626
1627/**
1628 * snd_soc_runtime_set_dai_fmt() - Change DAI link format for a ASoC runtime
1629 * @rtd: The runtime for which the DAI link format should be changed
1630 * @dai_fmt: The new DAI link format
1631 *
1632 * This function updates the DAI link format for all DAIs connected to the DAI
1633 * link for the specified runtime.
1634 *
1635 * Note: For setups with a static format set the dai_fmt field in the
1636 * corresponding snd_dai_link struct instead of using this function.
1637 *
1638 * Returns 0 on success, otherwise a negative error code.
1639 */
1640int snd_soc_runtime_set_dai_fmt(struct snd_soc_pcm_runtime *rtd,
1641	unsigned int dai_fmt)
1642{
1643	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1644	struct snd_soc_dai *codec_dai;
1645	unsigned int i;
1646	int ret;
1647
1648	for_each_rtd_codec_dai(rtd, i, codec_dai) {
1649		ret = snd_soc_dai_set_fmt(codec_dai, dai_fmt);
1650		if (ret != 0 && ret != -ENOTSUPP) {
1651			dev_warn(codec_dai->dev,
1652				 "ASoC: Failed to set DAI format: %d\n", ret);
1653			return ret;
1654		}
1655	}
1656
1657	/*
1658	 * Flip the polarity for the "CPU" end of a CODEC<->CODEC link
1659	 * the component which has non_legacy_dai_naming is Codec
1660	 */
1661	if (cpu_dai->component->driver->non_legacy_dai_naming) {
1662		unsigned int inv_dai_fmt;
 
 
 
 
 
 
 
 
 
1663
1664		inv_dai_fmt = dai_fmt & ~SND_SOC_DAIFMT_MASTER_MASK;
1665		switch (dai_fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1666		case SND_SOC_DAIFMT_CBM_CFM:
1667			inv_dai_fmt |= SND_SOC_DAIFMT_CBS_CFS;
1668			break;
1669		case SND_SOC_DAIFMT_CBM_CFS:
1670			inv_dai_fmt |= SND_SOC_DAIFMT_CBS_CFM;
1671			break;
1672		case SND_SOC_DAIFMT_CBS_CFM:
1673			inv_dai_fmt |= SND_SOC_DAIFMT_CBM_CFS;
1674			break;
1675		case SND_SOC_DAIFMT_CBS_CFS:
1676			inv_dai_fmt |= SND_SOC_DAIFMT_CBM_CFM;
1677			break;
1678		}
1679
1680		dai_fmt = inv_dai_fmt;
1681	}
1682
1683	ret = snd_soc_dai_set_fmt(cpu_dai, dai_fmt);
1684	if (ret != 0 && ret != -ENOTSUPP) {
1685		dev_warn(cpu_dai->dev,
1686			 "ASoC: Failed to set DAI format: %d\n", ret);
1687		return ret;
1688	}
1689
1690	return 0;
1691}
1692EXPORT_SYMBOL_GPL(snd_soc_runtime_set_dai_fmt);
1693
1694#ifdef CONFIG_DMI
1695/*
1696 * Trim special characters, and replace '-' with '_' since '-' is used to
1697 * separate different DMI fields in the card long name. Only number and
1698 * alphabet characters and a few separator characters are kept.
1699 */
1700static void cleanup_dmi_name(char *name)
1701{
1702	int i, j = 0;
1703
1704	for (i = 0; name[i]; i++) {
1705		if (isalnum(name[i]) || (name[i] == '.')
1706		    || (name[i] == '_'))
1707			name[j++] = name[i];
1708		else if (name[i] == '-')
1709			name[j++] = '_';
1710	}
1711
1712	name[j] = '\0';
1713}
 
1714
1715/*
1716 * Check if a DMI field is valid, i.e. not containing any string
1717 * in the black list.
1718 */
1719static int is_dmi_valid(const char *field)
1720{
1721	int i = 0;
 
1722
1723	while (dmi_blacklist[i]) {
1724		if (strstr(field, dmi_blacklist[i]))
 
1725			return 0;
1726		i++;
1727	}
1728
1729	return 1;
 
 
1730}
1731
1732/**
1733 * snd_soc_set_dmi_name() - Register DMI names to card
1734 * @card: The card to register DMI names
1735 * @flavour: The flavour "differentiator" for the card amongst its peers.
1736 *
1737 * An Intel machine driver may be used by many different devices but are
1738 * difficult for userspace to differentiate, since machine drivers ususally
1739 * use their own name as the card short name and leave the card long name
1740 * blank. To differentiate such devices and fix bugs due to lack of
1741 * device-specific configurations, this function allows DMI info to be used
1742 * as the sound card long name, in the format of
1743 * "vendor-product-version-board"
1744 * (Character '-' is used to separate different DMI fields here).
1745 * This will help the user space to load the device-specific Use Case Manager
1746 * (UCM) configurations for the card.
1747 *
1748 * Possible card long names may be:
1749 * DellInc.-XPS139343-01-0310JH
1750 * ASUSTeKCOMPUTERINC.-T100TA-1.0-T100TA
1751 * Circuitco-MinnowboardMaxD0PLATFORM-D0-MinnowBoardMAX
1752 *
1753 * This function also supports flavoring the card longname to provide
1754 * the extra differentiation, like "vendor-product-version-board-flavor".
1755 *
1756 * We only keep number and alphabet characters and a few separator characters
1757 * in the card long name since UCM in the user space uses the card long names
1758 * as card configuration directory names and AudoConf cannot support special
1759 * charactors like SPACE.
1760 *
1761 * Returns 0 on success, otherwise a negative error code.
1762 */
1763int snd_soc_set_dmi_name(struct snd_soc_card *card, const char *flavour)
1764{
1765	const char *vendor, *product, *product_version, *board;
1766	size_t longname_buf_size = sizeof(card->snd_card->longname);
1767	size_t len;
1768
1769	if (card->long_name)
1770		return 0; /* long name already set by driver or from DMI */
1771
1772	/* make up dmi long name as: vendor.product.version.board */
1773	vendor = dmi_get_system_info(DMI_BOARD_VENDOR);
1774	if (!vendor || !is_dmi_valid(vendor)) {
1775		dev_warn(card->dev, "ASoC: no DMI vendor name!\n");
1776		return 0;
1777	}
1778
1779	snprintf(card->dmi_longname, sizeof(card->snd_card->longname),
1780			 "%s", vendor);
1781	cleanup_dmi_name(card->dmi_longname);
1782
1783	product = dmi_get_system_info(DMI_PRODUCT_NAME);
1784	if (product && is_dmi_valid(product)) {
1785		len = strlen(card->dmi_longname);
1786		snprintf(card->dmi_longname + len,
1787			 longname_buf_size - len,
1788			 "-%s", product);
1789
1790		len++;	/* skip the separator "-" */
1791		if (len < longname_buf_size)
1792			cleanup_dmi_name(card->dmi_longname + len);
1793
1794		/*
1795		 * some vendors like Lenovo may only put a self-explanatory
1796		 * name in the product version field
1797		 */
1798		product_version = dmi_get_system_info(DMI_PRODUCT_VERSION);
1799		if (product_version && is_dmi_valid(product_version)) {
1800			len = strlen(card->dmi_longname);
1801			snprintf(card->dmi_longname + len,
1802				 longname_buf_size - len,
1803				 "-%s", product_version);
1804
1805			len++;
1806			if (len < longname_buf_size)
1807				cleanup_dmi_name(card->dmi_longname + len);
1808		}
1809	}
 
 
 
1810
1811	board = dmi_get_system_info(DMI_BOARD_NAME);
1812	if (board && is_dmi_valid(board)) {
1813		len = strlen(card->dmi_longname);
1814		snprintf(card->dmi_longname + len,
1815			 longname_buf_size - len,
1816			 "-%s", board);
1817
1818		len++;
1819		if (len < longname_buf_size)
1820			cleanup_dmi_name(card->dmi_longname + len);
1821	} else if (!product) {
1822		/* fall back to using legacy name */
1823		dev_warn(card->dev, "ASoC: no DMI board/product name!\n");
1824		return 0;
1825	}
1826
1827	/* Add flavour to dmi long name */
1828	if (flavour) {
1829		len = strlen(card->dmi_longname);
1830		snprintf(card->dmi_longname + len,
1831			 longname_buf_size - len,
1832			 "-%s", flavour);
1833
1834		len++;
1835		if (len < longname_buf_size)
1836			cleanup_dmi_name(card->dmi_longname + len);
1837	}
1838
1839	/* set the card long name */
1840	card->long_name = card->dmi_longname;
1841
1842	return 0;
 
1843}
1844EXPORT_SYMBOL_GPL(snd_soc_set_dmi_name);
1845#endif /* CONFIG_DMI */
1846
1847static void soc_check_tplg_fes(struct snd_soc_card *card)
1848{
1849	struct snd_soc_component *component;
1850	const struct snd_soc_component_driver *comp_drv;
1851	struct snd_soc_dai_link *dai_link;
1852	int i;
1853
1854	for_each_component(component) {
1855
1856		/* does this component override FEs ? */
1857		if (!component->driver->ignore_machine)
1858			continue;
1859
1860		/* for this machine ? */
1861		if (!strcmp(component->driver->ignore_machine,
1862			    card->dev->driver->name))
1863			goto match;
1864		if (strcmp(component->driver->ignore_machine,
1865			   dev_name(card->dev)))
1866			continue;
1867match:
1868		/* machine matches, so override the rtd data */
1869		for_each_card_prelinks(card, i, dai_link) {
1870
1871			/* ignore this FE */
1872			if (dai_link->dynamic) {
1873				dai_link->ignore = true;
1874				continue;
1875			}
1876
1877			dev_info(card->dev, "info: override FE DAI link %s\n",
1878				 card->dai_link[i].name);
1879
1880			/* override platform component */
1881			if (!dai_link->platforms) {
1882				dev_err(card->dev, "init platform error");
1883				continue;
1884			}
1885			dai_link->platforms->name = component->name;
1886
1887			/* convert non BE into BE */
1888			dai_link->no_pcm = 1;
1889
1890			/* override any BE fixups */
1891			dai_link->be_hw_params_fixup =
1892				component->driver->be_hw_params_fixup;
1893
1894			/*
1895			 * most BE links don't set stream name, so set it to
1896			 * dai link name if it's NULL to help bind widgets.
1897			 */
1898			if (!dai_link->stream_name)
1899				dai_link->stream_name = dai_link->name;
1900		}
1901
1902		/* Inform userspace we are using alternate topology */
1903		if (component->driver->topology_name_prefix) {
1904
1905			/* topology shortname created? */
1906			if (!card->topology_shortname_created) {
1907				comp_drv = component->driver;
1908
1909				snprintf(card->topology_shortname, 32, "%s-%s",
1910					 comp_drv->topology_name_prefix,
1911					 card->name);
1912				card->topology_shortname_created = true;
1913			}
1914
1915			/* use topology shortname */
1916			card->name = card->topology_shortname;
1917		}
1918	}
 
 
 
1919}
1920
1921static void soc_cleanup_card_resources(struct snd_soc_card *card)
1922{
1923	/* free the ALSA card at first; this syncs with pending operations */
1924	if (card->snd_card) {
1925		snd_card_free(card->snd_card);
1926		card->snd_card = NULL;
1927	}
1928
1929	/* remove and free each DAI */
1930	soc_remove_dai_links(card);
1931	soc_remove_pcm_runtimes(card);
1932
1933	/* remove auxiliary devices */
1934	soc_remove_aux_devices(card);
1935	soc_unbind_aux_dev(card);
1936
1937	snd_soc_dapm_free(&card->dapm);
1938	soc_cleanup_card_debugfs(card);
1939
1940	/* remove the card */
1941	if (card->remove)
1942		card->remove(card);
 
 
 
 
 
 
1943}
1944
1945static int snd_soc_instantiate_card(struct snd_soc_card *card)
1946{
1947	struct snd_soc_pcm_runtime *rtd;
1948	struct snd_soc_dai_link *dai_link;
1949	int ret, i;
1950
1951	mutex_lock(&client_mutex);
1952	for_each_card_prelinks(card, i, dai_link) {
1953		ret = soc_init_dai_link(card, dai_link);
1954		if (ret) {
1955			dev_err(card->dev, "ASoC: failed to init link %s: %d\n",
1956				dai_link->name, ret);
1957			mutex_unlock(&client_mutex);
1958			return ret;
1959		}
1960	}
1961	mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT);
1962
1963	snd_soc_dapm_init(&card->dapm, card, NULL);
1964
1965	/* check whether any platform is ignore machine FE and using topology */
1966	soc_check_tplg_fes(card);
1967
1968	/* bind DAIs */
1969	for_each_card_prelinks(card, i, dai_link) {
1970		ret = soc_bind_dai_link(card, dai_link);
1971		if (ret != 0)
1972			goto probe_end;
1973	}
1974
1975	/* bind aux_devs too */
1976	ret = soc_bind_aux_dev(card);
1977	if (ret < 0)
1978		goto probe_end;
 
 
1979
1980	/* add predefined DAI links to the list */
1981	for_each_card_prelinks(card, i, dai_link) {
1982		ret = snd_soc_add_dai_link(card, dai_link);
 
 
1983		if (ret < 0)
1984			goto probe_end;
1985	}
1986
1987	/* card bind complete so register a sound card */
1988	ret = snd_card_new(card->dev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1989			card->owner, 0, &card->snd_card);
1990	if (ret < 0) {
1991		dev_err(card->dev,
1992			"ASoC: can't create sound card for card %s: %d\n",
1993			card->name, ret);
1994		goto probe_end;
1995	}
1996
1997	soc_init_card_debugfs(card);
 
 
 
1998
1999	soc_resume_init(card);
 
 
2000
2001	ret = snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
2002					card->num_dapm_widgets);
2003	if (ret < 0)
2004		goto probe_end;
2005
2006	ret = snd_soc_dapm_new_controls(&card->dapm, card->of_dapm_widgets,
2007					card->num_of_dapm_widgets);
2008	if (ret < 0)
2009		goto probe_end;
2010
2011	/* initialise the sound card only once */
2012	if (card->probe) {
2013		ret = card->probe(card);
2014		if (ret < 0)
2015			goto probe_end;
2016	}
2017
2018	/* probe all components used by DAI links on this card */
2019	ret = soc_probe_link_components(card);
2020	if (ret < 0) {
2021		dev_err(card->dev,
2022			"ASoC: failed to instantiate card %d\n", ret);
2023		goto probe_end;
2024	}
2025
2026	/* probe auxiliary components */
2027	ret = soc_probe_aux_devices(card);
2028	if (ret < 0)
2029		goto probe_end;
2030
2031	/*
2032	 * Find new DAI links added during probing components and bind them.
2033	 * Components with topology may bring new DAIs and DAI links.
2034	 */
2035	for_each_card_links(card, dai_link) {
2036		if (soc_is_dai_link_bound(card, dai_link))
2037			continue;
2038
2039		ret = soc_init_dai_link(card, dai_link);
2040		if (ret)
2041			goto probe_end;
2042		ret = soc_bind_dai_link(card, dai_link);
2043		if (ret)
2044			goto probe_end;
2045	}
2046
2047	/* probe all DAI links on this card */
2048	ret = soc_probe_link_dais(card);
2049	if (ret < 0) {
2050		dev_err(card->dev,
2051			"ASoC: failed to instantiate card %d\n", ret);
2052		goto probe_end;
 
 
 
 
 
 
2053	}
2054
2055	for_each_card_rtds(card, rtd)
2056		soc_link_init(card, rtd);
 
 
 
 
 
 
 
2057
2058	snd_soc_dapm_link_dai_widgets(card);
2059	snd_soc_dapm_connect_dai_link_widgets(card);
2060
2061	ret = snd_soc_add_card_controls(card, card->controls,
2062					card->num_controls);
2063	if (ret < 0)
2064		goto probe_end;
2065
2066	ret = snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
2067				      card->num_dapm_routes);
2068	if (ret < 0)
2069		goto probe_end;
2070
2071	ret = snd_soc_dapm_add_routes(&card->dapm, card->of_dapm_routes,
2072				      card->num_of_dapm_routes);
2073	if (ret < 0)
2074		goto probe_end;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2075
2076	/* try to set some sane longname if DMI is available */
2077	snd_soc_set_dmi_name(card, NULL);
 
 
 
 
 
 
2078
2079	snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
2080		 "%s", card->name);
2081	snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
2082		 "%s", card->long_name ? card->long_name : card->name);
2083	snprintf(card->snd_card->driver, sizeof(card->snd_card->driver),
2084		 "%s", card->driver_name ? card->driver_name : card->name);
2085	for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) {
2086		switch (card->snd_card->driver[i]) {
2087		case '_':
2088		case '-':
2089		case '\0':
2090			break;
2091		default:
2092			if (!isalnum(card->snd_card->driver[i]))
2093				card->snd_card->driver[i] = '_';
2094			break;
2095		}
2096	}
2097
2098	if (card->late_probe) {
2099		ret = card->late_probe(card);
2100		if (ret < 0) {
2101			dev_err(card->dev, "ASoC: %s late_probe() failed: %d\n",
2102				card->name, ret);
2103			goto probe_end;
2104		}
2105	}
2106
 
 
 
 
2107	snd_soc_dapm_new_widgets(card);
2108
2109	ret = snd_card_register(card->snd_card);
2110	if (ret < 0) {
2111		dev_err(card->dev, "ASoC: failed to register soundcard %d\n",
2112				ret);
2113		goto probe_end;
2114	}
2115
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2116	card->instantiated = 1;
2117	dapm_mark_endpoints_dirty(card);
2118	snd_soc_dapm_sync(&card->dapm);
 
2119
2120probe_end:
2121	if (ret < 0)
2122		soc_cleanup_card_resources(card);
 
 
 
 
 
2123
 
 
 
 
 
 
 
2124	mutex_unlock(&card->mutex);
2125	mutex_unlock(&client_mutex);
2126
2127	return ret;
2128}
2129
2130/* probes a new socdev */
2131static int soc_probe(struct platform_device *pdev)
2132{
2133	struct snd_soc_card *card = platform_get_drvdata(pdev);
2134
2135	/*
2136	 * no card, so machine driver should be registering card
2137	 * we should not be here in that case so ret error
2138	 */
2139	if (!card)
2140		return -EINVAL;
2141
2142	dev_warn(&pdev->dev,
2143		 "ASoC: machine %s should use snd_soc_register_card()\n",
2144		 card->name);
2145
2146	/* Bodge while we unpick instantiation */
2147	card->dev = &pdev->dev;
2148
2149	return snd_soc_register_card(card);
2150}
2151
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2152/* removes a socdev */
2153static int soc_remove(struct platform_device *pdev)
2154{
2155	struct snd_soc_card *card = platform_get_drvdata(pdev);
2156
2157	snd_soc_unregister_card(card);
2158	return 0;
2159}
2160
2161int snd_soc_poweroff(struct device *dev)
2162{
2163	struct snd_soc_card *card = dev_get_drvdata(dev);
2164	struct snd_soc_pcm_runtime *rtd;
2165
2166	if (!card->instantiated)
2167		return 0;
2168
2169	/*
2170	 * Flush out pmdown_time work - we actually do want to run it
2171	 * now, we're shutting down so no imminent restart.
2172	 */
2173	snd_soc_flush_all_delayed_work(card);
 
2174
2175	snd_soc_dapm_shutdown(card);
2176
2177	/* deactivate pins to sleep state */
2178	for_each_card_rtds(card, rtd) {
2179		struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
2180		struct snd_soc_dai *codec_dai;
2181		int i;
2182
2183		pinctrl_pm_select_sleep_state(cpu_dai->dev);
2184		for_each_rtd_codec_dai(rtd, i, codec_dai) {
2185			pinctrl_pm_select_sleep_state(codec_dai->dev);
2186		}
2187	}
2188
2189	return 0;
2190}
2191EXPORT_SYMBOL_GPL(snd_soc_poweroff);
2192
2193const struct dev_pm_ops snd_soc_pm_ops = {
2194	.suspend = snd_soc_suspend,
2195	.resume = snd_soc_resume,
2196	.freeze = snd_soc_suspend,
2197	.thaw = snd_soc_resume,
2198	.poweroff = snd_soc_poweroff,
2199	.restore = snd_soc_resume,
2200};
2201EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
2202
2203/* ASoC platform driver */
2204static struct platform_driver soc_driver = {
2205	.driver		= {
2206		.name		= "soc-audio",
 
2207		.pm		= &snd_soc_pm_ops,
2208	},
2209	.probe		= soc_probe,
2210	.remove		= soc_remove,
2211};
2212
2213/**
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2214 * snd_soc_cnew - create new control
2215 * @_template: control template
2216 * @data: control private data
2217 * @long_name: control long name
2218 * @prefix: control name prefix
2219 *
2220 * Create a new mixer control from a template control.
2221 *
2222 * Returns 0 for success, else error.
2223 */
2224struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
2225				  void *data, const char *long_name,
2226				  const char *prefix)
2227{
2228	struct snd_kcontrol_new template;
2229	struct snd_kcontrol *kcontrol;
2230	char *name = NULL;
2231
2232	memcpy(&template, _template, sizeof(template));
2233	template.index = 0;
2234
2235	if (!long_name)
2236		long_name = template.name;
2237
2238	if (prefix) {
2239		name = kasprintf(GFP_KERNEL, "%s %s", prefix, long_name);
2240		if (!name)
2241			return NULL;
2242
2243		template.name = name;
2244	} else {
2245		template.name = long_name;
2246	}
2247
2248	kcontrol = snd_ctl_new1(&template, data);
2249
2250	kfree(name);
2251
2252	return kcontrol;
2253}
2254EXPORT_SYMBOL_GPL(snd_soc_cnew);
2255
2256static int snd_soc_add_controls(struct snd_card *card, struct device *dev,
2257	const struct snd_kcontrol_new *controls, int num_controls,
2258	const char *prefix, void *data)
2259{
2260	int err, i;
2261
2262	for (i = 0; i < num_controls; i++) {
2263		const struct snd_kcontrol_new *control = &controls[i];
2264
2265		err = snd_ctl_add(card, snd_soc_cnew(control, data,
2266						     control->name, prefix));
2267		if (err < 0) {
2268			dev_err(dev, "ASoC: Failed to add %s: %d\n",
2269				control->name, err);
2270			return err;
2271		}
2272	}
2273
2274	return 0;
2275}
2276
2277struct snd_kcontrol *snd_soc_card_get_kcontrol(struct snd_soc_card *soc_card,
2278					       const char *name)
2279{
2280	struct snd_card *card = soc_card->snd_card;
2281	struct snd_kcontrol *kctl;
2282
2283	if (unlikely(!name))
2284		return NULL;
2285
2286	list_for_each_entry(kctl, &card->controls, list)
2287		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name)))
2288			return kctl;
2289	return NULL;
2290}
2291EXPORT_SYMBOL_GPL(snd_soc_card_get_kcontrol);
2292
2293/**
2294 * snd_soc_add_component_controls - Add an array of controls to a component.
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2295 *
2296 * @component: Component to add controls to
2297 * @controls: Array of controls to add
2298 * @num_controls: Number of elements in the array
2299 *
2300 * Return: 0 for success, else error.
2301 */
2302int snd_soc_add_component_controls(struct snd_soc_component *component,
2303	const struct snd_kcontrol_new *controls, unsigned int num_controls)
2304{
2305	struct snd_card *card = component->card->snd_card;
2306
2307	return snd_soc_add_controls(card, component->dev, controls,
2308			num_controls, component->name_prefix, component);
2309}
2310EXPORT_SYMBOL_GPL(snd_soc_add_component_controls);
2311
2312/**
2313 * snd_soc_add_card_controls - add an array of controls to a SoC card.
2314 * Convenience function to add a list of controls.
2315 *
2316 * @soc_card: SoC card to add controls to
2317 * @controls: array of controls to add
2318 * @num_controls: number of elements in the array
2319 *
2320 * Return 0 for success, else error.
2321 */
2322int snd_soc_add_card_controls(struct snd_soc_card *soc_card,
2323	const struct snd_kcontrol_new *controls, int num_controls)
2324{
2325	struct snd_card *card = soc_card->snd_card;
2326
2327	return snd_soc_add_controls(card, soc_card->dev, controls, num_controls,
2328			NULL, soc_card);
2329}
2330EXPORT_SYMBOL_GPL(snd_soc_add_card_controls);
2331
2332/**
2333 * snd_soc_add_dai_controls - add an array of controls to a DAI.
2334 * Convienience function to add a list of controls.
2335 *
2336 * @dai: DAI to add controls to
2337 * @controls: array of controls to add
2338 * @num_controls: number of elements in the array
2339 *
2340 * Return 0 for success, else error.
2341 */
2342int snd_soc_add_dai_controls(struct snd_soc_dai *dai,
2343	const struct snd_kcontrol_new *controls, int num_controls)
2344{
2345	struct snd_card *card = dai->component->card->snd_card;
2346
2347	return snd_soc_add_controls(card, dai->dev, controls, num_controls,
2348			NULL, dai);
2349}
2350EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls);
2351
2352static int snd_soc_bind_card(struct snd_soc_card *card)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2353{
2354	struct snd_soc_pcm_runtime *rtd;
2355	int ret;
 
2356
2357	ret = snd_soc_instantiate_card(card);
2358	if (ret != 0)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2359		return ret;
2360
2361	/* deactivate pins to sleep state */
2362	for_each_card_rtds(card, rtd) {
2363		struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
2364		struct snd_soc_dai *codec_dai;
2365		int j;
2366
2367		for_each_rtd_codec_dai(rtd, j, codec_dai) {
2368			if (!codec_dai->active)
2369				pinctrl_pm_select_sleep_state(codec_dai->dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2370		}
 
 
 
 
 
 
 
 
 
 
 
2371
2372		if (!cpu_dai->active)
2373			pinctrl_pm_select_sleep_state(cpu_dai->dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2374	}
2375
2376	return ret;
2377}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2378
2379/**
2380 * snd_soc_register_card - Register a card with the ASoC core
2381 *
2382 * @card: Card to register
2383 *
2384 */
2385int snd_soc_register_card(struct snd_soc_card *card)
2386{
 
 
2387	if (!card->name || !card->dev)
2388		return -EINVAL;
2389
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2390	dev_set_drvdata(card->dev, card);
2391
2392	INIT_LIST_HEAD(&card->widgets);
2393	INIT_LIST_HEAD(&card->paths);
2394	INIT_LIST_HEAD(&card->dapm_list);
2395	INIT_LIST_HEAD(&card->aux_comp_list);
2396	INIT_LIST_HEAD(&card->component_dev_list);
2397	INIT_LIST_HEAD(&card->list);
2398	INIT_LIST_HEAD(&card->dai_link_list);
2399	INIT_LIST_HEAD(&card->rtd_list);
2400	INIT_LIST_HEAD(&card->dapm_dirty);
2401	INIT_LIST_HEAD(&card->dobj_list);
2402
 
 
 
 
 
 
 
 
2403	card->num_rtd = 0;
 
 
 
 
 
 
 
2404	card->instantiated = 0;
2405	mutex_init(&card->mutex);
2406	mutex_init(&card->dapm_mutex);
2407	mutex_init(&card->pcm_mutex);
2408	spin_lock_init(&card->dpcm_lock);
2409
2410	return snd_soc_bind_card(card);
2411}
2412EXPORT_SYMBOL_GPL(snd_soc_register_card);
2413
2414static void snd_soc_unbind_card(struct snd_soc_card *card, bool unregister)
2415{
2416	if (card->instantiated) {
2417		card->instantiated = false;
2418		snd_soc_dapm_shutdown(card);
2419		snd_soc_flush_all_delayed_work(card);
2420
2421		/* remove all components used by DAI links on this card */
2422		soc_remove_link_components(card);
2423
2424		soc_cleanup_card_resources(card);
2425		if (!unregister)
2426			list_add(&card->list, &unbind_card_list);
2427	} else {
2428		if (unregister)
2429			list_del(&card->list);
 
 
2430	}
 
 
2431}
 
2432
2433/**
2434 * snd_soc_unregister_card - Unregister a card with the ASoC core
2435 *
2436 * @card: Card to unregister
2437 *
2438 */
2439int snd_soc_unregister_card(struct snd_soc_card *card)
2440{
2441	mutex_lock(&client_mutex);
2442	snd_soc_unbind_card(card, true);
2443	mutex_unlock(&client_mutex);
2444	dev_dbg(card->dev, "ASoC: Unregistered card '%s'\n", card->name);
2445
2446	return 0;
2447}
2448EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
2449
2450/*
2451 * Simplify DAI link configuration by removing ".-1" from device names
2452 * and sanitizing names.
2453 */
2454static char *fmt_single_name(struct device *dev, int *id)
2455{
2456	char *found, name[NAME_SIZE];
2457	int id1, id2;
2458
2459	if (dev_name(dev) == NULL)
2460		return NULL;
2461
2462	strlcpy(name, dev_name(dev), NAME_SIZE);
2463
2464	/* are we a "%s.%d" name (platform and SPI components) */
2465	found = strstr(name, dev->driver->name);
2466	if (found) {
2467		/* get ID */
2468		if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
2469
2470			/* discard ID from name if ID == -1 */
2471			if (*id == -1)
2472				found[strlen(dev->driver->name)] = '\0';
2473		}
2474
2475	} else {
2476		/* I2C component devices are named "bus-addr" */
2477		if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
2478			char tmp[NAME_SIZE];
2479
2480			/* create unique ID number from I2C addr and bus */
2481			*id = ((id1 & 0xffff) << 16) + id2;
2482
2483			/* sanitize component name for DAI link creation */
2484			snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name,
2485				 name);
2486			strlcpy(name, tmp, NAME_SIZE);
2487		} else
2488			*id = 0;
2489	}
2490
2491	return kstrdup(name, GFP_KERNEL);
2492}
2493
2494/*
2495 * Simplify DAI link naming for single devices with multiple DAIs by removing
2496 * any ".-1" and using the DAI name (instead of device name).
2497 */
2498static inline char *fmt_multiple_name(struct device *dev,
2499		struct snd_soc_dai_driver *dai_drv)
2500{
2501	if (dai_drv->name == NULL) {
2502		dev_err(dev,
2503			"ASoC: error - multiple DAI %s registered with no name\n",
2504			dev_name(dev));
2505		return NULL;
2506	}
2507
2508	return kstrdup(dai_drv->name, GFP_KERNEL);
2509}
2510
2511/**
2512 * snd_soc_unregister_dai - Unregister DAIs from the ASoC core
2513 *
2514 * @component: The component for which the DAIs should be unregistered
2515 */
2516static void snd_soc_unregister_dais(struct snd_soc_component *component)
2517{
2518	struct snd_soc_dai *dai, *_dai;
2519
2520	for_each_component_dais_safe(component, dai, _dai) {
2521		dev_dbg(component->dev, "ASoC: Unregistered DAI '%s'\n",
2522			dai->name);
2523		list_del(&dai->list);
2524		kfree(dai->name);
2525		kfree(dai);
2526	}
2527}
2528
2529/* Create a DAI and add it to the component's DAI list */
2530static struct snd_soc_dai *soc_add_dai(struct snd_soc_component *component,
2531	struct snd_soc_dai_driver *dai_drv,
2532	bool legacy_dai_naming)
2533{
2534	struct device *dev = component->dev;
2535	struct snd_soc_dai *dai;
2536
2537	dev_dbg(dev, "ASoC: dynamically register DAI %s\n", dev_name(dev));
2538
2539	dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
2540	if (dai == NULL)
2541		return NULL;
2542
2543	/*
2544	 * Back in the old days when we still had component-less DAIs,
2545	 * instead of having a static name, component-less DAIs would
2546	 * inherit the name of the parent device so it is possible to
2547	 * register multiple instances of the DAI. We still need to keep
2548	 * the same naming style even though those DAIs are not
2549	 * component-less anymore.
2550	 */
2551	if (legacy_dai_naming &&
2552	    (dai_drv->id == 0 || dai_drv->name == NULL)) {
2553		dai->name = fmt_single_name(dev, &dai->id);
2554	} else {
2555		dai->name = fmt_multiple_name(dev, dai_drv);
2556		if (dai_drv->id)
2557			dai->id = dai_drv->id;
2558		else
2559			dai->id = component->num_dai;
2560	}
2561	if (dai->name == NULL) {
2562		kfree(dai);
2563		return NULL;
2564	}
2565
2566	dai->component = component;
2567	dai->dev = dev;
2568	dai->driver = dai_drv;
2569	if (!dai->driver->ops)
2570		dai->driver->ops = &null_dai_ops;
2571
2572	/* see for_each_component_dais */
2573	list_add_tail(&dai->list, &component->dai_list);
2574	component->num_dai++;
2575
2576	dev_dbg(dev, "ASoC: Registered DAI '%s'\n", dai->name);
2577	return dai;
2578}
2579
2580/**
2581 * snd_soc_register_dais - Register a DAI with the ASoC core
2582 *
2583 * @component: The component the DAIs are registered for
 
 
2584 * @dai_drv: DAI driver to use for the DAIs
2585 * @count: Number of DAIs
 
 
2586 */
2587static int snd_soc_register_dais(struct snd_soc_component *component,
2588				 struct snd_soc_dai_driver *dai_drv,
2589				 size_t count)
2590{
2591	struct device *dev = component->dev;
2592	struct snd_soc_dai *dai;
2593	unsigned int i;
2594	int ret;
2595
2596	dev_dbg(dev, "ASoC: dai register %s #%zu\n", dev_name(dev), count);
2597
2598	for (i = 0; i < count; i++) {
2599
2600		dai = soc_add_dai(component, dai_drv + i, count == 1 &&
2601				  !component->driver->non_legacy_dai_naming);
2602		if (dai == NULL) {
2603			ret = -ENOMEM;
2604			goto err;
2605		}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2606	}
2607
2608	return 0;
2609
2610err:
2611	snd_soc_unregister_dais(component);
2612
2613	return ret;
2614}
2615
2616/**
2617 * snd_soc_register_dai - Register a DAI dynamically & create its widgets
2618 *
2619 * @component: The component the DAIs are registered for
2620 * @dai_drv: DAI driver to use for the DAI
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 */
2626int snd_soc_register_dai(struct snd_soc_component *component,
2627	struct snd_soc_dai_driver *dai_drv)
 
 
 
 
 
2628{
2629	struct snd_soc_dapm_context *dapm =
2630		snd_soc_component_get_dapm(component);
2631	struct snd_soc_dai *dai;
2632	int ret;
2633
2634	if (dai_drv->dobj.type != SND_SOC_DOBJ_PCM) {
2635		dev_err(component->dev, "Invalid dai type %d\n",
2636			dai_drv->dobj.type);
2637		return -EINVAL;
 
2638	}
2639
2640	lockdep_assert_held(&client_mutex);
2641	dai = soc_add_dai(component, dai_drv, false);
2642	if (!dai)
2643		return -ENOMEM;
 
2644
2645	/*
2646	 * Create the DAI widgets here. After adding DAIs, topology may
2647	 * also add routes that need these widgets as source or sink.
2648	 */
2649	ret = snd_soc_dapm_new_dai_widgets(dapm, dai);
2650	if (ret != 0) {
2651		dev_err(component->dev,
2652			"Failed to create DAI widgets %d\n", ret);
 
 
 
2653	}
2654
 
 
 
 
 
 
2655	return ret;
2656}
2657EXPORT_SYMBOL_GPL(snd_soc_register_dai);
2658
2659static int snd_soc_component_initialize(struct snd_soc_component *component,
2660	const struct snd_soc_component_driver *driver, struct device *dev)
2661{
2662	INIT_LIST_HEAD(&component->dai_list);
2663	INIT_LIST_HEAD(&component->dobj_list);
2664	INIT_LIST_HEAD(&component->card_list);
2665	mutex_init(&component->io_mutex);
2666
2667	component->name = fmt_single_name(dev, &component->id);
2668	if (!component->name) {
2669		dev_err(dev, "ASoC: Failed to allocate name\n");
 
 
 
 
 
 
 
2670		return -ENOMEM;
2671	}
2672
2673	component->dev = dev;
2674	component->driver = driver;
2675
2676	return 0;
 
2677}
 
2678
2679static void snd_soc_component_setup_regmap(struct snd_soc_component *component)
 
 
 
 
2680{
2681	int val_bytes = regmap_get_val_bytes(component->regmap);
2682
2683	/* Errors are legitimate for non-integer byte multiples */
2684	if (val_bytes > 0)
2685		component->val_bytes = val_bytes;
2686}
 
2687
2688#ifdef CONFIG_REGMAP
 
 
 
 
 
 
 
 
 
 
2689
2690/**
2691 * snd_soc_component_init_regmap() - Initialize regmap instance for the
2692 *                                   component
2693 * @component: The component for which to initialize the regmap instance
2694 * @regmap: The regmap instance that should be used by the component
2695 *
2696 * This function allows deferred assignment of the regmap instance that is
2697 * associated with the component. Only use this if the regmap instance is not
2698 * yet ready when the component is registered. The function must also be called
2699 * before the first IO attempt of the component.
2700 */
2701void snd_soc_component_init_regmap(struct snd_soc_component *component,
2702	struct regmap *regmap)
2703{
2704	component->regmap = regmap;
2705	snd_soc_component_setup_regmap(component);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2706}
2707EXPORT_SYMBOL_GPL(snd_soc_component_init_regmap);
2708
2709/**
2710 * snd_soc_component_exit_regmap() - De-initialize regmap instance for the
2711 *                                   component
2712 * @component: The component for which to de-initialize the regmap instance
2713 *
2714 * Calls regmap_exit() on the regmap instance associated to the component and
2715 * removes the regmap instance from the component.
2716 *
2717 * This function should only be used if snd_soc_component_init_regmap() was used
2718 * to initialize the regmap instance.
2719 */
2720void snd_soc_component_exit_regmap(struct snd_soc_component *component)
 
2721{
2722	regmap_exit(component->regmap);
2723	component->regmap = NULL;
2724}
2725EXPORT_SYMBOL_GPL(snd_soc_component_exit_regmap);
2726
2727#endif
2728
2729static void snd_soc_component_add(struct snd_soc_component *component)
2730{
2731	mutex_lock(&client_mutex);
2732
2733	if (!component->driver->write && !component->driver->read) {
2734		if (!component->regmap)
2735			component->regmap = dev_get_regmap(component->dev,
2736							   NULL);
2737		if (component->regmap)
2738			snd_soc_component_setup_regmap(component);
2739	}
2740
2741	/* see for_each_component */
2742	list_add(&component->list, &component_list);
 
2743
 
 
 
 
 
 
 
 
2744	mutex_unlock(&client_mutex);
 
 
 
 
2745}
 
2746
2747static void snd_soc_component_cleanup(struct snd_soc_component *component)
2748{
2749	snd_soc_unregister_dais(component);
2750	kfree(component->name);
 
 
 
 
 
 
2751}
 
2752
2753static void snd_soc_component_del_unlocked(struct snd_soc_component *component)
 
 
 
 
 
2754{
2755	struct snd_soc_card *card = component->card;
2756
2757	if (card)
2758		snd_soc_unbind_card(card, false);
2759
2760	list_del(&component->list);
2761}
2762
2763#define ENDIANNESS_MAP(name) \
2764	(SNDRV_PCM_FMTBIT_##name##LE | SNDRV_PCM_FMTBIT_##name##BE)
2765static u64 endianness_format_map[] = {
2766	ENDIANNESS_MAP(S16_),
2767	ENDIANNESS_MAP(U16_),
2768	ENDIANNESS_MAP(S24_),
2769	ENDIANNESS_MAP(U24_),
2770	ENDIANNESS_MAP(S32_),
2771	ENDIANNESS_MAP(U32_),
2772	ENDIANNESS_MAP(S24_3),
2773	ENDIANNESS_MAP(U24_3),
2774	ENDIANNESS_MAP(S20_3),
2775	ENDIANNESS_MAP(U20_3),
2776	ENDIANNESS_MAP(S18_3),
2777	ENDIANNESS_MAP(U18_3),
2778	ENDIANNESS_MAP(FLOAT_),
2779	ENDIANNESS_MAP(FLOAT64_),
2780	ENDIANNESS_MAP(IEC958_SUBFRAME_),
 
 
2781};
2782
2783/*
2784 * Fix up the DAI formats for endianness: codecs don't actually see
2785 * the endianness of the data but we're using the CPU format
2786 * definitions which do need to include endianness so we ensure that
2787 * codec DAIs always have both big and little endian variants set.
2788 */
2789static void convert_endianness_formats(struct snd_soc_pcm_stream *stream)
2790{
2791	int i;
2792
2793	for (i = 0; i < ARRAY_SIZE(endianness_format_map); i++)
2794		if (stream->formats & endianness_format_map[i])
2795			stream->formats |= endianness_format_map[i];
2796}
2797
2798static void snd_soc_try_rebind_card(void)
 
 
 
 
 
 
 
 
2799{
2800	struct snd_soc_card *card, *c;
2801
2802	list_for_each_entry_safe(card, c, &unbind_card_list, list)
2803		if (!snd_soc_bind_card(card))
2804			list_del(&card->list);
2805}
2806
2807int snd_soc_add_component(struct device *dev,
2808			struct snd_soc_component *component,
2809			const struct snd_soc_component_driver *component_driver,
2810			struct snd_soc_dai_driver *dai_drv,
2811			int num_dai)
2812{
2813	int ret;
2814	int i;
2815
2816	ret = snd_soc_component_initialize(component, component_driver, dev);
2817	if (ret)
2818		goto err_free;
2819
2820	if (component_driver->endianness) {
2821		for (i = 0; i < num_dai; i++) {
2822			convert_endianness_formats(&dai_drv[i].playback);
2823			convert_endianness_formats(&dai_drv[i].capture);
2824		}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2825	}
2826
2827	ret = snd_soc_register_dais(component, dai_drv, num_dai);
 
 
 
 
 
 
 
2828	if (ret < 0) {
2829		dev_err(dev, "ASoC: Failed to register DAIs: %d\n", ret);
2830		goto err_cleanup;
2831	}
2832
2833	snd_soc_component_add(component);
2834	snd_soc_try_rebind_card();
2835
2836	return 0;
2837
2838err_cleanup:
2839	snd_soc_component_cleanup(component);
2840err_free:
2841	return ret;
2842}
2843EXPORT_SYMBOL_GPL(snd_soc_add_component);
2844
2845int snd_soc_register_component(struct device *dev,
2846			const struct snd_soc_component_driver *component_driver,
2847			struct snd_soc_dai_driver *dai_drv,
2848			int num_dai)
2849{
2850	struct snd_soc_component *component;
2851
2852	component = devm_kzalloc(dev, sizeof(*component), GFP_KERNEL);
2853	if (!component)
2854		return -ENOMEM;
2855
2856	return snd_soc_add_component(dev, component, component_driver,
2857				     dai_drv, num_dai);
 
 
2858}
2859EXPORT_SYMBOL_GPL(snd_soc_register_component);
2860
2861/**
2862 * snd_soc_unregister_component - Unregister all related component
2863 * from the ASoC core
2864 *
2865 * @dev: The device to unregister
2866 */
2867static int __snd_soc_unregister_component(struct device *dev)
2868{
2869	struct snd_soc_component *component;
2870	int found = 0;
2871
2872	mutex_lock(&client_mutex);
2873	for_each_component(component) {
2874		if (dev != component->dev)
2875			continue;
2876
2877		snd_soc_tplg_component_remove(component,
2878					      SND_SOC_TPLG_INDEX_ALL);
2879		snd_soc_component_del_unlocked(component);
2880		found = 1;
2881		break;
2882	}
2883	mutex_unlock(&client_mutex);
2884
2885	if (found)
2886		snd_soc_component_cleanup(component);
2887
2888	return found;
2889}
2890
2891void snd_soc_unregister_component(struct device *dev)
2892{
2893	while (__snd_soc_unregister_component(dev))
2894		;
2895}
2896EXPORT_SYMBOL_GPL(snd_soc_unregister_component);
2897
2898struct snd_soc_component *snd_soc_lookup_component(struct device *dev,
2899						   const char *driver_name)
2900{
2901	struct snd_soc_component *component;
2902	struct snd_soc_component *ret;
2903
2904	ret = NULL;
2905	mutex_lock(&client_mutex);
2906	for_each_component(component) {
2907		if (dev != component->dev)
2908			continue;
2909
2910		if (driver_name &&
2911		    (driver_name != component->driver->name) &&
2912		    (strcmp(component->driver->name, driver_name) != 0))
2913			continue;
2914
2915		ret = component;
2916		break;
2917	}
2918	mutex_unlock(&client_mutex);
2919
2920	return ret;
 
 
 
 
2921}
2922EXPORT_SYMBOL_GPL(snd_soc_lookup_component);
2923
2924/* Retrieve a card's name from device tree */
2925int snd_soc_of_parse_card_name(struct snd_soc_card *card,
2926			       const char *propname)
2927{
2928	struct device_node *np;
2929	int ret;
2930
2931	if (!card->dev) {
2932		pr_err("card->dev is not set before calling %s\n", __func__);
2933		return -EINVAL;
2934	}
2935
2936	np = card->dev->of_node;
2937
2938	ret = of_property_read_string_index(np, propname, 0, &card->name);
2939	/*
2940	 * EINVAL means the property does not exist. This is fine providing
2941	 * card->name was previously set, which is checked later in
2942	 * snd_soc_register_card.
2943	 */
2944	if (ret < 0 && ret != -EINVAL) {
2945		dev_err(card->dev,
2946			"ASoC: Property '%s' could not be read: %d\n",
2947			propname, ret);
2948		return ret;
2949	}
2950
2951	return 0;
2952}
2953EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
2954
2955static const struct snd_soc_dapm_widget simple_widgets[] = {
2956	SND_SOC_DAPM_MIC("Microphone", NULL),
2957	SND_SOC_DAPM_LINE("Line", NULL),
2958	SND_SOC_DAPM_HP("Headphone", NULL),
2959	SND_SOC_DAPM_SPK("Speaker", NULL),
2960};
2961
2962int snd_soc_of_parse_audio_simple_widgets(struct snd_soc_card *card,
2963					  const char *propname)
2964{
2965	struct device_node *np = card->dev->of_node;
2966	struct snd_soc_dapm_widget *widgets;
2967	const char *template, *wname;
2968	int i, j, num_widgets, ret;
2969
2970	num_widgets = of_property_count_strings(np, propname);
2971	if (num_widgets < 0) {
2972		dev_err(card->dev,
2973			"ASoC: Property '%s' does not exist\n",	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	if (!num_widgets) {
2984		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
2985			propname);
2986		return -EINVAL;
2987	}
2988
2989	widgets = devm_kcalloc(card->dev, num_widgets, sizeof(*widgets),
2990			       GFP_KERNEL);
2991	if (!widgets) {
2992		dev_err(card->dev,
2993			"ASoC: Could not allocate memory for widgets\n");
2994		return -ENOMEM;
2995	}
2996
2997	for (i = 0; i < num_widgets; i++) {
2998		ret = of_property_read_string_index(np, propname,
2999			2 * i, &template);
3000		if (ret) {
3001			dev_err(card->dev,
3002				"ASoC: Property '%s' index %d read error:%d\n",
3003				propname, 2 * i, ret);
3004			return -EINVAL;
3005		}
3006
3007		for (j = 0; j < ARRAY_SIZE(simple_widgets); j++) {
3008			if (!strncmp(template, simple_widgets[j].name,
3009				     strlen(simple_widgets[j].name))) {
3010				widgets[i] = simple_widgets[j];
3011				break;
3012			}
3013		}
3014
3015		if (j >= ARRAY_SIZE(simple_widgets)) {
3016			dev_err(card->dev,
3017				"ASoC: DAPM widget '%s' is not supported\n",
3018				template);
3019			return -EINVAL;
3020		}
3021
3022		ret = of_property_read_string_index(np, propname,
3023						    (2 * i) + 1,
3024						    &wname);
3025		if (ret) {
3026			dev_err(card->dev,
3027				"ASoC: Property '%s' index %d read error:%d\n",
3028				propname, (2 * i) + 1, ret);
3029			return -EINVAL;
3030		}
3031
3032		widgets[i].name = wname;
3033	}
3034
3035	card->of_dapm_widgets = widgets;
3036	card->num_of_dapm_widgets = num_widgets;
3037
3038	return 0;
3039}
3040EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_simple_widgets);
3041
3042int snd_soc_of_get_slot_mask(struct device_node *np,
3043			     const char *prop_name,
3044			     unsigned int *mask)
3045{
3046	u32 val;
3047	const __be32 *of_slot_mask = of_get_property(np, prop_name, &val);
3048	int i;
3049
3050	if (!of_slot_mask)
3051		return 0;
3052	val /= sizeof(u32);
3053	for (i = 0; i < val; i++)
3054		if (be32_to_cpup(&of_slot_mask[i]))
3055			*mask |= (1 << i);
3056
3057	return val;
3058}
3059EXPORT_SYMBOL_GPL(snd_soc_of_get_slot_mask);
3060
3061int snd_soc_of_parse_tdm_slot(struct device_node *np,
3062			      unsigned int *tx_mask,
3063			      unsigned int *rx_mask,
3064			      unsigned int *slots,
3065			      unsigned int *slot_width)
3066{
3067	u32 val;
3068	int ret;
3069
3070	if (tx_mask)
3071		snd_soc_of_get_slot_mask(np, "dai-tdm-slot-tx-mask", tx_mask);
3072	if (rx_mask)
3073		snd_soc_of_get_slot_mask(np, "dai-tdm-slot-rx-mask", rx_mask);
3074
3075	if (of_property_read_bool(np, "dai-tdm-slot-num")) {
3076		ret = of_property_read_u32(np, "dai-tdm-slot-num", &val);
3077		if (ret)
3078			return ret;
3079
3080		if (slots)
3081			*slots = val;
3082	}
3083
3084	if (of_property_read_bool(np, "dai-tdm-slot-width")) {
3085		ret = of_property_read_u32(np, "dai-tdm-slot-width", &val);
3086		if (ret)
3087			return ret;
3088
3089		if (slot_width)
3090			*slot_width = val;
3091	}
3092
3093	return 0;
3094}
3095EXPORT_SYMBOL_GPL(snd_soc_of_parse_tdm_slot);
3096
3097void snd_soc_of_parse_node_prefix(struct device_node *np,
3098				  struct snd_soc_codec_conf *codec_conf,
3099				  struct device_node *of_node,
3100				  const char *propname)
3101{
3102	const char *str;
3103	int ret;
3104
3105	ret = of_property_read_string(np, propname, &str);
3106	if (ret < 0) {
3107		/* no prefix is not error */
3108		return;
3109	}
3110
3111	codec_conf->of_node	= of_node;
3112	codec_conf->name_prefix	= str;
3113}
3114EXPORT_SYMBOL_GPL(snd_soc_of_parse_node_prefix);
3115
3116int snd_soc_of_parse_audio_routing(struct snd_soc_card *card,
3117				   const char *propname)
3118{
3119	struct device_node *np = card->dev->of_node;
3120	int num_routes;
3121	struct snd_soc_dapm_route *routes;
3122	int i, ret;
3123
3124	num_routes = of_property_count_strings(np, propname);
3125	if (num_routes < 0 || num_routes & 1) {
3126		dev_err(card->dev,
3127			"ASoC: Property '%s' does not exist or its length is not even\n",
3128			propname);
3129		return -EINVAL;
3130	}
3131	num_routes /= 2;
3132	if (!num_routes) {
3133		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
3134			propname);
3135		return -EINVAL;
3136	}
3137
3138	routes = devm_kcalloc(card->dev, num_routes, sizeof(*routes),
3139			      GFP_KERNEL);
3140	if (!routes) {
3141		dev_err(card->dev,
3142			"ASoC: Could not allocate DAPM route table\n");
3143		return -EINVAL;
3144	}
3145
3146	for (i = 0; i < num_routes; i++) {
3147		ret = of_property_read_string_index(np, propname,
3148			2 * i, &routes[i].sink);
3149		if (ret) {
3150			dev_err(card->dev,
3151				"ASoC: Property '%s' index %d could not be read: %d\n",
3152				propname, 2 * i, ret);
3153			return -EINVAL;
3154		}
3155		ret = of_property_read_string_index(np, propname,
3156			(2 * i) + 1, &routes[i].source);
3157		if (ret) {
3158			dev_err(card->dev,
3159				"ASoC: Property '%s' index %d could not be read: %d\n",
3160				propname, (2 * i) + 1, ret);
3161			return -EINVAL;
3162		}
3163	}
3164
3165	card->num_of_dapm_routes = num_routes;
3166	card->of_dapm_routes = routes;
3167
3168	return 0;
3169}
3170EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
3171
3172unsigned int snd_soc_of_parse_daifmt(struct device_node *np,
3173				     const char *prefix,
3174				     struct device_node **bitclkmaster,
3175				     struct device_node **framemaster)
3176{
3177	int ret, i;
3178	char prop[128];
3179	unsigned int format = 0;
3180	int bit, frame;
3181	const char *str;
3182	struct {
3183		char *name;
3184		unsigned int val;
3185	} of_fmt_table[] = {
3186		{ "i2s",	SND_SOC_DAIFMT_I2S },
3187		{ "right_j",	SND_SOC_DAIFMT_RIGHT_J },
3188		{ "left_j",	SND_SOC_DAIFMT_LEFT_J },
3189		{ "dsp_a",	SND_SOC_DAIFMT_DSP_A },
3190		{ "dsp_b",	SND_SOC_DAIFMT_DSP_B },
3191		{ "ac97",	SND_SOC_DAIFMT_AC97 },
3192		{ "pdm",	SND_SOC_DAIFMT_PDM},
3193		{ "msb",	SND_SOC_DAIFMT_MSB },
3194		{ "lsb",	SND_SOC_DAIFMT_LSB },
3195	};
3196
3197	if (!prefix)
3198		prefix = "";
3199
3200	/*
3201	 * check "dai-format = xxx"
3202	 * or    "[prefix]format = xxx"
3203	 * SND_SOC_DAIFMT_FORMAT_MASK area
3204	 */
3205	ret = of_property_read_string(np, "dai-format", &str);
3206	if (ret < 0) {
3207		snprintf(prop, sizeof(prop), "%sformat", prefix);
3208		ret = of_property_read_string(np, prop, &str);
3209	}
3210	if (ret == 0) {
3211		for (i = 0; i < ARRAY_SIZE(of_fmt_table); i++) {
3212			if (strcmp(str, of_fmt_table[i].name) == 0) {
3213				format |= of_fmt_table[i].val;
3214				break;
3215			}
3216		}
3217	}
3218
3219	/*
3220	 * check "[prefix]continuous-clock"
3221	 * SND_SOC_DAIFMT_CLOCK_MASK area
3222	 */
3223	snprintf(prop, sizeof(prop), "%scontinuous-clock", prefix);
3224	if (of_property_read_bool(np, prop))
3225		format |= SND_SOC_DAIFMT_CONT;
3226	else
3227		format |= SND_SOC_DAIFMT_GATED;
3228
3229	/*
3230	 * check "[prefix]bitclock-inversion"
3231	 * check "[prefix]frame-inversion"
3232	 * SND_SOC_DAIFMT_INV_MASK area
3233	 */
3234	snprintf(prop, sizeof(prop), "%sbitclock-inversion", prefix);
3235	bit = !!of_get_property(np, prop, NULL);
3236
3237	snprintf(prop, sizeof(prop), "%sframe-inversion", prefix);
3238	frame = !!of_get_property(np, prop, NULL);
3239
3240	switch ((bit << 4) + frame) {
3241	case 0x11:
3242		format |= SND_SOC_DAIFMT_IB_IF;
3243		break;
3244	case 0x10:
3245		format |= SND_SOC_DAIFMT_IB_NF;
3246		break;
3247	case 0x01:
3248		format |= SND_SOC_DAIFMT_NB_IF;
3249		break;
3250	default:
3251		/* SND_SOC_DAIFMT_NB_NF is default */
3252		break;
3253	}
3254
3255	/*
3256	 * check "[prefix]bitclock-master"
3257	 * check "[prefix]frame-master"
3258	 * SND_SOC_DAIFMT_MASTER_MASK area
3259	 */
3260	snprintf(prop, sizeof(prop), "%sbitclock-master", prefix);
3261	bit = !!of_get_property(np, prop, NULL);
3262	if (bit && bitclkmaster)
3263		*bitclkmaster = of_parse_phandle(np, prop, 0);
3264
3265	snprintf(prop, sizeof(prop), "%sframe-master", prefix);
3266	frame = !!of_get_property(np, prop, NULL);
3267	if (frame && framemaster)
3268		*framemaster = of_parse_phandle(np, prop, 0);
3269
3270	switch ((bit << 4) + frame) {
3271	case 0x11:
3272		format |= SND_SOC_DAIFMT_CBM_CFM;
3273		break;
3274	case 0x10:
3275		format |= SND_SOC_DAIFMT_CBM_CFS;
3276		break;
3277	case 0x01:
3278		format |= SND_SOC_DAIFMT_CBS_CFM;
3279		break;
3280	default:
3281		format |= SND_SOC_DAIFMT_CBS_CFS;
3282		break;
3283	}
3284
3285	return format;
3286}
3287EXPORT_SYMBOL_GPL(snd_soc_of_parse_daifmt);
3288
3289int snd_soc_get_dai_id(struct device_node *ep)
 
3290{
3291	struct snd_soc_component *component;
3292	struct snd_soc_dai_link_component dlc;
3293	int ret;
3294
3295	dlc.of_node	= of_graph_get_port_parent(ep);
3296	dlc.name	= NULL;
3297	/*
3298	 * For example HDMI case, HDMI has video/sound port,
3299	 * but ALSA SoC needs sound port number only.
3300	 * Thus counting HDMI DT port/endpoint doesn't work.
3301	 * Then, it should have .of_xlate_dai_id
3302	 */
3303	ret = -ENOTSUPP;
3304	mutex_lock(&client_mutex);
3305	component = soc_find_component(&dlc);
3306	if (component)
3307		ret = snd_soc_component_of_xlate_dai_id(component, ep);
3308	mutex_unlock(&client_mutex);
3309
3310	of_node_put(dlc.of_node);
3311
3312	return ret;
3313}
3314EXPORT_SYMBOL_GPL(snd_soc_get_dai_id);
3315
3316int snd_soc_get_dai_name(struct of_phandle_args *args,
3317				const char **dai_name)
3318{
3319	struct snd_soc_component *pos;
3320	struct device_node *component_of_node;
3321	int ret = -EPROBE_DEFER;
3322
3323	mutex_lock(&client_mutex);
3324	for_each_component(pos) {
3325		component_of_node = soc_component_to_node(pos);
3326
3327		if (component_of_node != args->np)
3328			continue;
3329
3330		ret = snd_soc_component_of_xlate_dai_name(pos, args, dai_name);
3331		if (ret == -ENOTSUPP) {
3332			struct snd_soc_dai *dai;
3333			int id = -1;
3334
3335			switch (args->args_count) {
3336			case 0:
3337				id = 0; /* same as dai_drv[0] */
3338				break;
3339			case 1:
3340				id = args->args[0];
3341				break;
3342			default:
3343				/* not supported */
3344				break;
3345			}
3346
3347			if (id < 0 || id >= pos->num_dai) {
3348				ret = -EINVAL;
3349				continue;
3350			}
3351
3352			ret = 0;
3353
3354			/* find target DAI */
3355			for_each_component_dais(pos, dai) {
3356				if (id == 0)
3357					break;
3358				id--;
3359			}
3360
3361			*dai_name = dai->driver->name;
3362			if (!*dai_name)
3363				*dai_name = pos->name;
3364		}
3365
3366		break;
3367	}
3368	mutex_unlock(&client_mutex);
3369	return ret;
3370}
3371EXPORT_SYMBOL_GPL(snd_soc_get_dai_name);
3372
3373int snd_soc_of_get_dai_name(struct device_node *of_node,
3374			    const char **dai_name)
3375{
3376	struct of_phandle_args args;
3377	int ret;
3378
3379	ret = of_parse_phandle_with_args(of_node, "sound-dai",
3380					 "#sound-dai-cells", 0, &args);
3381	if (ret)
3382		return ret;
3383
3384	ret = snd_soc_get_dai_name(&args, dai_name);
3385
3386	of_node_put(args.np);
3387
3388	return ret;
3389}
3390EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_name);
3391
3392/*
3393 * snd_soc_of_put_dai_link_codecs - Dereference device nodes in the codecs array
3394 * @dai_link: DAI link
3395 *
3396 * Dereference device nodes acquired by snd_soc_of_get_dai_link_codecs().
3397 */
3398void snd_soc_of_put_dai_link_codecs(struct snd_soc_dai_link *dai_link)
3399{
3400	struct snd_soc_dai_link_component *component;
3401	int index;
3402
3403	for_each_link_codecs(dai_link, index, component) {
3404		if (!component->of_node)
3405			break;
3406		of_node_put(component->of_node);
3407		component->of_node = NULL;
3408	}
3409}
3410EXPORT_SYMBOL_GPL(snd_soc_of_put_dai_link_codecs);
3411
3412/*
3413 * snd_soc_of_get_dai_link_codecs - Parse a list of CODECs in the devicetree
3414 * @dev: Card device
3415 * @of_node: Device node
3416 * @dai_link: DAI link
3417 *
3418 * Builds an array of CODEC DAI components from the DAI link property
3419 * 'sound-dai'.
3420 * The array is set in the DAI link and the number of DAIs is set accordingly.
3421 * The device nodes in the array (of_node) must be dereferenced by calling
3422 * snd_soc_of_put_dai_link_codecs() on @dai_link.
3423 *
3424 * Returns 0 for success
3425 */
3426int snd_soc_of_get_dai_link_codecs(struct device *dev,
3427				   struct device_node *of_node,
3428				   struct snd_soc_dai_link *dai_link)
3429{
3430	struct of_phandle_args args;
3431	struct snd_soc_dai_link_component *component;
3432	char *name;
3433	int index, num_codecs, ret;
3434
3435	/* Count the number of CODECs */
3436	name = "sound-dai";
3437	num_codecs = of_count_phandle_with_args(of_node, name,
3438						"#sound-dai-cells");
3439	if (num_codecs <= 0) {
3440		if (num_codecs == -ENOENT)
3441			dev_err(dev, "No 'sound-dai' property\n");
3442		else
3443			dev_err(dev, "Bad phandle in 'sound-dai'\n");
3444		return num_codecs;
3445	}
3446	component = devm_kcalloc(dev,
3447				 num_codecs, sizeof(*component),
3448				 GFP_KERNEL);
3449	if (!component)
3450		return -ENOMEM;
3451	dai_link->codecs = component;
3452	dai_link->num_codecs = num_codecs;
3453
3454	/* Parse the list */
3455	for_each_link_codecs(dai_link, index, component) {
3456		ret = of_parse_phandle_with_args(of_node, name,
3457						 "#sound-dai-cells",
3458						 index, &args);
3459		if (ret)
3460			goto err;
3461		component->of_node = args.np;
3462		ret = snd_soc_get_dai_name(&args, &component->dai_name);
3463		if (ret < 0)
3464			goto err;
3465	}
3466	return 0;
3467err:
3468	snd_soc_of_put_dai_link_codecs(dai_link);
3469	dai_link->codecs = NULL;
3470	dai_link->num_codecs = 0;
3471	return ret;
3472}
3473EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_link_codecs);
3474
3475static int __init snd_soc_init(void)
3476{
3477	snd_soc_debugfs_init();
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3478	snd_soc_util_init();
3479
3480	return platform_driver_register(&soc_driver);
3481}
3482module_init(snd_soc_init);
3483
3484static void __exit snd_soc_exit(void)
3485{
3486	snd_soc_util_exit();
3487	snd_soc_debugfs_exit();
3488
 
 
 
3489	platform_driver_unregister(&soc_driver);
3490}
3491module_exit(snd_soc_exit);
3492
3493/* Module information */
3494MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
3495MODULE_DESCRIPTION("ALSA SoC Core");
3496MODULE_LICENSE("GPL");
3497MODULE_ALIAS("platform:soc-audio");
v3.15
   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 <linux/gpio.h>
  38#include <linux/of_gpio.h>
  39#include <sound/ac97_codec.h>
  40#include <sound/core.h>
  41#include <sound/jack.h>
  42#include <sound/pcm.h>
  43#include <sound/pcm_params.h>
  44#include <sound/soc.h>
  45#include <sound/soc-dpcm.h>
 
  46#include <sound/initval.h>
  47
  48#define CREATE_TRACE_POINTS
  49#include <trace/events/asoc.h>
  50
  51#define NAME_SIZE	32
  52
  53#ifdef CONFIG_DEBUG_FS
  54struct dentry *snd_soc_debugfs_root;
  55EXPORT_SYMBOL_GPL(snd_soc_debugfs_root);
  56#endif
  57
  58static DEFINE_MUTEX(client_mutex);
  59static LIST_HEAD(platform_list);
  60static LIST_HEAD(codec_list);
  61static LIST_HEAD(component_list);
 
 
 
 
 
 
 
 
 
 
 
  62
  63/*
  64 * This is a timeout to do a DAPM powerdown after a stream is closed().
  65 * It can be used to eliminate pops between different playback streams, e.g.
  66 * between two audio tracks.
  67 */
  68static int pmdown_time = 5000;
  69module_param(pmdown_time, int, 0);
  70MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
  71
  72struct snd_ac97_reset_cfg {
  73	struct pinctrl *pctl;
  74	struct pinctrl_state *pstate_reset;
  75	struct pinctrl_state *pstate_warm_reset;
  76	struct pinctrl_state *pstate_run;
  77	int gpio_sdata;
  78	int gpio_sync;
  79	int gpio_reset;
 
 
 
 
 
 
  80};
 
  81
  82/* returns the minimum number of bytes needed to represent
  83 * a particular given value */
  84static int min_bytes_needed(unsigned long val)
  85{
  86	int c = 0;
  87	int i;
  88
  89	for (i = (sizeof val * 8) - 1; i >= 0; --i, ++c)
  90		if (val & (1UL << i))
  91			break;
  92	c = (sizeof val * 8) - c;
  93	if (!c || (c % 8))
  94		c = (c + 8) / 8;
  95	else
  96		c /= 8;
  97	return c;
  98}
  99
 100/* fill buf which is 'len' bytes with a formatted
 101 * string of the form 'reg: value\n' */
 102static int format_register_str(struct snd_soc_codec *codec,
 103			       unsigned int reg, char *buf, size_t len)
 104{
 105	int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
 106	int regsize = codec->driver->reg_word_size * 2;
 107	int ret;
 108	char tmpbuf[len + 1];
 109	char regbuf[regsize + 1];
 110
 111	/* since tmpbuf is allocated on the stack, warn the callers if they
 112	 * try to abuse this function */
 113	WARN_ON(len > 63);
 
 
 
 114
 115	/* +2 for ': ' and + 1 for '\n' */
 116	if (wordsize + regsize + 2 + 1 != len)
 117		return -EINVAL;
 118
 119	ret = snd_soc_read(codec, reg);
 120	if (ret < 0) {
 121		memset(regbuf, 'X', regsize);
 122		regbuf[regsize] = '\0';
 123	} else {
 124		snprintf(regbuf, regsize + 1, "%.*x", regsize, ret);
 125	}
 126
 127	/* prepare the buffer */
 128	snprintf(tmpbuf, len + 1, "%.*x: %s\n", wordsize, reg, regbuf);
 129	/* copy it back to the caller without the '\0' */
 130	memcpy(buf, tmpbuf, len);
 
 131
 132	return 0;
 
 
 133}
 134
 135/* codec register dump */
 136static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf,
 137				  size_t count, loff_t pos)
 138{
 139	int i, step = 1;
 140	int wordsize, regsize;
 141	int len;
 142	size_t total = 0;
 143	loff_t p = 0;
 144
 145	wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
 146	regsize = codec->driver->reg_word_size * 2;
 
 
 147
 148	len = wordsize + regsize + 2 + 1;
 
 
 
 
 149
 150	if (!codec->driver->reg_cache_size)
 151		return 0;
 
 
 
 152
 153	if (codec->driver->reg_cache_step)
 154		step = codec->driver->reg_cache_step;
 155
 156	for (i = 0; i < codec->driver->reg_cache_size; i += step) {
 157		if (!snd_soc_codec_readable_register(codec, i))
 158			continue;
 159		if (codec->driver->display_register) {
 160			count += codec->driver->display_register(codec, buf + count,
 161							 PAGE_SIZE - count, i);
 162		} else {
 163			/* only support larger than PAGE_SIZE bytes debugfs
 164			 * entries for the default case */
 165			if (p >= pos) {
 166				if (total + len >= count - 1)
 167					break;
 168				format_register_str(codec, i, buf + total, len);
 169				total += len;
 170			}
 171			p += len;
 172		}
 
 
 
 173	}
 174
 175	total = min(total, count - 1);
 176
 177	return total;
 178}
 179
 180static ssize_t codec_reg_show(struct device *dev,
 181	struct device_attribute *attr, char *buf)
 182{
 183	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
 184
 185	return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0);
 
 186}
 187
 188static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
 189
 190static ssize_t pmdown_time_show(struct device *dev,
 191				struct device_attribute *attr, char *buf)
 192{
 193	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
 
 194
 195	return sprintf(buf, "%ld\n", rtd->pmdown_time);
 196}
 197
 198static ssize_t pmdown_time_set(struct device *dev,
 199			       struct device_attribute *attr,
 200			       const char *buf, size_t count)
 201{
 202	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
 203	int ret;
 204
 205	ret = kstrtol(buf, 10, &rtd->pmdown_time);
 206	if (ret)
 207		return ret;
 208
 209	return count;
 210}
 
 211
 212static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
 213
 214#ifdef CONFIG_DEBUG_FS
 215static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
 216				   size_t count, loff_t *ppos)
 217{
 218	ssize_t ret;
 219	struct snd_soc_codec *codec = file->private_data;
 220	char *buf;
 221
 222	if (*ppos < 0 || !count)
 223		return -EINVAL;
 224
 225	buf = kmalloc(count, GFP_KERNEL);
 226	if (!buf)
 227		return -ENOMEM;
 228
 229	ret = soc_codec_reg_show(codec, buf, count, *ppos);
 230	if (ret >= 0) {
 231		if (copy_to_user(user_buf, buf, ret)) {
 232			kfree(buf);
 233			return -EFAULT;
 234		}
 235		*ppos += ret;
 236	}
 237
 238	kfree(buf);
 239	return ret;
 240}
 
 241
 242static ssize_t codec_reg_write_file(struct file *file,
 243		const char __user *user_buf, size_t count, loff_t *ppos)
 244{
 245	char buf[32];
 246	size_t buf_size;
 247	char *start = buf;
 248	unsigned long reg, value;
 249	struct snd_soc_codec *codec = file->private_data;
 250	int ret;
 251
 252	buf_size = min(count, (sizeof(buf)-1));
 253	if (copy_from_user(buf, user_buf, buf_size))
 254		return -EFAULT;
 255	buf[buf_size] = 0;
 256
 257	while (*start == ' ')
 258		start++;
 259	reg = simple_strtoul(start, &start, 16);
 260	while (*start == ' ')
 261		start++;
 262	ret = kstrtoul(start, 16, &value);
 263	if (ret)
 264		return ret;
 265
 266	/* Userspace has been fiddling around behind the kernel's back */
 267	add_taint(TAINT_USER, LOCKDEP_NOW_UNRELIABLE);
 268
 269	snd_soc_write(codec, reg, value);
 270	return buf_size;
 
 
 271}
 272
 273static const struct file_operations codec_reg_fops = {
 274	.open = simple_open,
 275	.read = codec_reg_read_file,
 276	.write = codec_reg_write_file,
 277	.llseek = default_llseek,
 278};
 279
 280static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
 281{
 282	struct dentry *debugfs_card_root = codec->card->debugfs_card_root;
 283
 284	codec->debugfs_codec_root = debugfs_create_dir(codec->name,
 285						       debugfs_card_root);
 286	if (!codec->debugfs_codec_root) {
 287		dev_warn(codec->dev,
 288			"ASoC: Failed to create codec debugfs directory\n");
 289		return;
 290	}
 291
 292	debugfs_create_bool("cache_sync", 0444, codec->debugfs_codec_root,
 293			    &codec->cache_sync);
 294	debugfs_create_bool("cache_only", 0444, codec->debugfs_codec_root,
 295			    &codec->cache_only);
 296
 297	codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
 298						 codec->debugfs_codec_root,
 299						 codec, &codec_reg_fops);
 300	if (!codec->debugfs_reg)
 301		dev_warn(codec->dev,
 302			"ASoC: Failed to create codec register debugfs file\n");
 303
 304	snd_soc_dapm_debugfs_init(&codec->dapm, codec->debugfs_codec_root);
 
 
 305}
 306
 307static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
 
 308{
 309	debugfs_remove_recursive(codec->debugfs_codec_root);
 310}
 311
 312static void soc_init_platform_debugfs(struct snd_soc_platform *platform)
 313{
 314	struct dentry *debugfs_card_root = platform->card->debugfs_card_root;
 315
 316	platform->debugfs_platform_root = debugfs_create_dir(platform->name,
 317						       debugfs_card_root);
 318	if (!platform->debugfs_platform_root) {
 319		dev_warn(platform->dev,
 320			"ASoC: Failed to create platform debugfs directory\n");
 321		return;
 322	}
 323
 324	snd_soc_dapm_debugfs_init(&platform->dapm,
 325		platform->debugfs_platform_root);
 326}
 327
 328static void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
 329{
 330	debugfs_remove_recursive(platform->debugfs_platform_root);
 331}
 332
 333static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
 334				    size_t count, loff_t *ppos)
 335{
 336	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
 337	ssize_t len, ret = 0;
 338	struct snd_soc_codec *codec;
 339
 340	if (!buf)
 341		return -ENOMEM;
 342
 343	list_for_each_entry(codec, &codec_list, list) {
 344		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
 345			       codec->name);
 346		if (len >= 0)
 347			ret += len;
 348		if (ret > PAGE_SIZE) {
 349			ret = PAGE_SIZE;
 350			break;
 351		}
 352	}
 353
 354	if (ret >= 0)
 355		ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
 356
 357	kfree(buf);
 358
 359	return ret;
 360}
 361
 362static const struct file_operations codec_list_fops = {
 363	.read = codec_list_read_file,
 364	.llseek = default_llseek,/* read accesses f_pos */
 365};
 366
 367static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
 368				  size_t count, loff_t *ppos)
 369{
 370	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
 371	ssize_t len, ret = 0;
 372	struct snd_soc_component *component;
 373	struct snd_soc_dai *dai;
 
 
 
 374
 375	if (!buf)
 
 376		return -ENOMEM;
 377
 378	list_for_each_entry(component, &component_list, list) {
 379		list_for_each_entry(dai, &component->dai_list, list) {
 380			len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
 381				dai->name);
 382			if (len >= 0)
 383				ret += len;
 384			if (ret > PAGE_SIZE) {
 385				ret = PAGE_SIZE;
 386				break;
 387			}
 388		}
 389	}
 390
 391	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
 392
 393	kfree(buf);
 394
 395	return ret;
 396}
 397
 398static const struct file_operations dai_list_fops = {
 399	.read = dai_list_read_file,
 400	.llseek = default_llseek,/* read accesses f_pos */
 401};
 402
 403static ssize_t platform_list_read_file(struct file *file,
 404				       char __user *user_buf,
 405				       size_t count, loff_t *ppos)
 406{
 407	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
 408	ssize_t len, ret = 0;
 409	struct snd_soc_platform *platform;
 410
 411	if (!buf)
 412		return -ENOMEM;
 413
 414	list_for_each_entry(platform, &platform_list, list) {
 415		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
 416			       platform->name);
 417		if (len >= 0)
 418			ret += len;
 419		if (ret > PAGE_SIZE) {
 420			ret = PAGE_SIZE;
 421			break;
 422		}
 423	}
 424
 425	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
 
 426
 427	kfree(buf);
 
 
 
 
 
 
 
 
 
 428
 429	return ret;
 430}
 431
 432static const struct file_operations platform_list_fops = {
 433	.read = platform_list_read_file,
 434	.llseek = default_llseek,/* read accesses f_pos */
 435};
 436
 437static void soc_init_card_debugfs(struct snd_soc_card *card)
 438{
 439	card->debugfs_card_root = debugfs_create_dir(card->name,
 440						     snd_soc_debugfs_root);
 441	if (!card->debugfs_card_root) {
 442		dev_warn(card->dev,
 443			 "ASoC: Failed to create card debugfs directory\n");
 444		return;
 445	}
 446
 447	card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
 448						    card->debugfs_card_root,
 449						    &card->pop_time);
 450	if (!card->debugfs_pop_time)
 451		dev_warn(card->dev,
 452		       "ASoC: Failed to create pop time debugfs file\n");
 453}
 
 454
 455static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
 
 456{
 457	debugfs_remove_recursive(card->debugfs_card_root);
 
 
 
 
 
 
 
 
 458}
 
 459
 460#else
 461
 462static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
 
 463{
 464}
 465
 466static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
 467{
 468}
 469
 470static inline void soc_init_platform_debugfs(struct snd_soc_platform *platform)
 471{
 472}
 
 
 
 
 
 
 
 
 
 
 473
 474static inline void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
 475{
 476}
 477
 478static inline void soc_init_card_debugfs(struct snd_soc_card *card)
 479{
 
 
 
 480}
 481
 482static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
 
 483{
 
 
 
 
 484}
 485#endif
 486
 487struct snd_pcm_substream *snd_soc_get_dai_substream(struct snd_soc_card *card,
 488		const char *dai_link, int stream)
 489{
 490	int i;
 491
 492	for (i = 0; i < card->num_links; i++) {
 493		if (card->rtd[i].dai_link->no_pcm &&
 494			!strcmp(card->rtd[i].dai_link->name, dai_link))
 495			return card->rtd[i].pcm->streams[stream].substream;
 496	}
 497	dev_dbg(card->dev, "ASoC: failed to find dai link %s\n", dai_link);
 498	return NULL;
 499}
 500EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream);
 501
 502struct snd_soc_pcm_runtime *snd_soc_get_pcm_runtime(struct snd_soc_card *card,
 503		const char *dai_link)
 504{
 505	int i;
 506
 507	for (i = 0; i < card->num_links; i++) {
 508		if (!strcmp(card->rtd[i].dai_link->name, dai_link))
 509			return &card->rtd[i];
 510	}
 511	dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link);
 512	return NULL;
 513}
 514EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime);
 515
 516#ifdef CONFIG_SND_SOC_AC97_BUS
 517/* unregister ac97 codec */
 518static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
 519{
 520	if (codec->ac97->dev.bus)
 521		device_unregister(&codec->ac97->dev);
 522	return 0;
 523}
 524
 525/* stop no dev release warning */
 526static void soc_ac97_device_release(struct device *dev){}
 527
 528/* register ac97 codec to bus */
 529static int soc_ac97_dev_register(struct snd_soc_codec *codec)
 530{
 531	int err;
 532
 533	codec->ac97->dev.bus = &ac97_bus_type;
 534	codec->ac97->dev.parent = codec->card->dev;
 535	codec->ac97->dev.release = soc_ac97_device_release;
 536
 537	dev_set_name(&codec->ac97->dev, "%d-%d:%s",
 538		     codec->card->snd_card->number, 0, codec->name);
 539	err = device_register(&codec->ac97->dev);
 540	if (err < 0) {
 541		dev_err(codec->dev, "ASoC: Can't register ac97 bus\n");
 542		codec->ac97->dev.bus = NULL;
 543		return err;
 544	}
 545	return 0;
 546}
 547#endif
 548
 549static void codec2codec_close_delayed_work(struct work_struct *work)
 550{
 551	/* Currently nothing to do for c2c links
 552	 * Since c2c links are internal nodes in the DAPM graph and
 553	 * don't interface with the outside world or application layer
 554	 * we don't have to do any special handling on close.
 555	 */
 556}
 557
 558#ifdef CONFIG_PM_SLEEP
 559/* powers down audio subsystem for suspend */
 560int snd_soc_suspend(struct device *dev)
 561{
 562	struct snd_soc_card *card = dev_get_drvdata(dev);
 563	struct snd_soc_codec *codec;
 
 564	int i;
 565
 566	/* If the initialization of this soc device failed, there is no codec
 567	 * associated with it. Just bail out in this case.
 568	 */
 569	if (list_empty(&card->codec_dev_list))
 570		return 0;
 571
 572	/* Due to the resume being scheduled into a workqueue we could
 573	* suspend before that's finished - wait for it to complete.
 
 574	 */
 575	snd_power_lock(card->snd_card);
 576	snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
 577	snd_power_unlock(card->snd_card);
 578
 579	/* we're going to block userspace touching us until resume completes */
 580	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
 581
 582	/* mute any active DACs */
 583	for (i = 0; i < card->num_rtd; i++) {
 584		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
 585		struct snd_soc_dai_driver *drv = dai->driver;
 586
 587		if (card->rtd[i].dai_link->ignore_suspend)
 588			continue;
 589
 590		if (drv->ops->digital_mute && dai->playback_active)
 591			drv->ops->digital_mute(dai, 1);
 
 
 
 592	}
 593
 594	/* suspend all pcms */
 595	for (i = 0; i < card->num_rtd; i++) {
 596		if (card->rtd[i].dai_link->ignore_suspend)
 597			continue;
 598
 599		snd_pcm_suspend_all(card->rtd[i].pcm);
 600	}
 601
 602	if (card->suspend_pre)
 603		card->suspend_pre(card);
 604
 605	for (i = 0; i < card->num_rtd; i++) {
 606		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
 607		struct snd_soc_platform *platform = card->rtd[i].platform;
 608
 609		if (card->rtd[i].dai_link->ignore_suspend)
 610			continue;
 611
 612		if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
 613			cpu_dai->driver->suspend(cpu_dai);
 614		if (platform->driver->suspend && !platform->suspended) {
 615			platform->driver->suspend(cpu_dai);
 616			platform->suspended = 1;
 617		}
 618	}
 619
 620	/* close any waiting streams and save state */
 621	for (i = 0; i < card->num_rtd; i++) {
 622		flush_delayed_work(&card->rtd[i].delayed_work);
 623		card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level;
 624	}
 625
 626	for (i = 0; i < card->num_rtd; i++) {
 627
 628		if (card->rtd[i].dai_link->ignore_suspend)
 629			continue;
 630
 631		snd_soc_dapm_stream_event(&card->rtd[i],
 632					  SNDRV_PCM_STREAM_PLAYBACK,
 633					  SND_SOC_DAPM_STREAM_SUSPEND);
 634
 635		snd_soc_dapm_stream_event(&card->rtd[i],
 636					  SNDRV_PCM_STREAM_CAPTURE,
 637					  SND_SOC_DAPM_STREAM_SUSPEND);
 638	}
 639
 640	/* Recheck all analogue paths too */
 641	dapm_mark_io_dirty(&card->dapm);
 642	snd_soc_dapm_sync(&card->dapm);
 643
 644	/* suspend all CODECs */
 645	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
 646		/* If there are paths active then the CODEC will be held with
 647		 * bias _ON and should not be suspended. */
 648		if (!codec->suspended && codec->driver->suspend) {
 649			switch (codec->dapm.bias_level) {
 
 
 
 
 
 650			case SND_SOC_BIAS_STANDBY:
 651				/*
 652				 * If the CODEC is capable of idle
 653				 * bias off then being in STANDBY
 654				 * means it's doing something,
 655				 * otherwise fall through.
 656				 */
 657				if (codec->dapm.idle_bias_off) {
 658					dev_dbg(codec->dev,
 659						"ASoC: idle_bias_off CODEC on over suspend\n");
 660					break;
 661				}
 
 
 662			case SND_SOC_BIAS_OFF:
 663				codec->driver->suspend(codec);
 664				codec->suspended = 1;
 665				codec->cache_sync = 1;
 666				if (codec->using_regmap)
 667					regcache_mark_dirty(codec->control_data);
 668				/* deactivate pins to sleep state */
 669				pinctrl_pm_select_sleep_state(codec->dev);
 670				break;
 671			default:
 672				dev_dbg(codec->dev,
 673					"ASoC: CODEC is on over suspend\n");
 674				break;
 675			}
 676		}
 677	}
 678
 679	for (i = 0; i < card->num_rtd; i++) {
 680		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
 681
 682		if (card->rtd[i].dai_link->ignore_suspend)
 683			continue;
 684
 685		if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
 686			cpu_dai->driver->suspend(cpu_dai);
 687
 688		/* deactivate pins to sleep state */
 689		pinctrl_pm_select_sleep_state(cpu_dai->dev);
 690	}
 691
 692	if (card->suspend_post)
 693		card->suspend_post(card);
 694
 695	return 0;
 696}
 697EXPORT_SYMBOL_GPL(snd_soc_suspend);
 698
 699/* deferred resume work, so resume can complete before we finished
 
 700 * setting our codec back up, which can be very slow on I2C
 701 */
 702static void soc_resume_deferred(struct work_struct *work)
 703{
 704	struct snd_soc_card *card =
 705			container_of(work, struct snd_soc_card, deferred_resume_work);
 706	struct snd_soc_codec *codec;
 
 
 707	int i;
 708
 709	/* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
 
 710	 * so userspace apps are blocked from touching us
 711	 */
 712
 713	dev_dbg(card->dev, "ASoC: starting resume work\n");
 714
 715	/* Bring us up into D2 so that DAPM starts enabling things */
 716	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
 717
 718	if (card->resume_pre)
 719		card->resume_pre(card);
 720
 721	/* resume AC97 DAIs */
 722	for (i = 0; i < card->num_rtd; i++) {
 723		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
 724
 725		if (card->rtd[i].dai_link->ignore_suspend)
 726			continue;
 727
 728		if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
 729			cpu_dai->driver->resume(cpu_dai);
 730	}
 731
 732	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
 733		/* If the CODEC was idle over suspend then it will have been
 734		 * left with bias OFF or STANDBY and suspended so we must now
 735		 * resume.  Otherwise the suspend was suppressed.
 736		 */
 737		if (codec->driver->resume && codec->suspended) {
 738			switch (codec->dapm.bias_level) {
 739			case SND_SOC_BIAS_STANDBY:
 740			case SND_SOC_BIAS_OFF:
 741				codec->driver->resume(codec);
 742				codec->suspended = 0;
 743				break;
 744			default:
 745				dev_dbg(codec->dev,
 746					"ASoC: CODEC was on over suspend\n");
 747				break;
 748			}
 749		}
 750	}
 751
 752	for (i = 0; i < card->num_rtd; i++) {
 753
 754		if (card->rtd[i].dai_link->ignore_suspend)
 755			continue;
 756
 757		snd_soc_dapm_stream_event(&card->rtd[i],
 758					  SNDRV_PCM_STREAM_PLAYBACK,
 759					  SND_SOC_DAPM_STREAM_RESUME);
 760
 761		snd_soc_dapm_stream_event(&card->rtd[i],
 762					  SNDRV_PCM_STREAM_CAPTURE,
 763					  SND_SOC_DAPM_STREAM_RESUME);
 764	}
 765
 766	/* unmute any active DACs */
 767	for (i = 0; i < card->num_rtd; i++) {
 768		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
 769		struct snd_soc_dai_driver *drv = dai->driver;
 770
 771		if (card->rtd[i].dai_link->ignore_suspend)
 772			continue;
 773
 774		if (drv->ops->digital_mute && dai->playback_active)
 775			drv->ops->digital_mute(dai, 0);
 
 
 
 776	}
 777
 778	for (i = 0; i < card->num_rtd; i++) {
 779		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
 780		struct snd_soc_platform *platform = card->rtd[i].platform;
 781
 782		if (card->rtd[i].dai_link->ignore_suspend)
 783			continue;
 784
 785		if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
 786			cpu_dai->driver->resume(cpu_dai);
 787		if (platform->driver->resume && platform->suspended) {
 788			platform->driver->resume(cpu_dai);
 789			platform->suspended = 0;
 790		}
 791	}
 792
 793	if (card->resume_post)
 794		card->resume_post(card);
 795
 796	dev_dbg(card->dev, "ASoC: resume work completed\n");
 797
 
 
 
 
 798	/* userspace can access us now we are back as we were before */
 799	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
 800
 801	/* Recheck all analogue paths too */
 802	dapm_mark_io_dirty(&card->dapm);
 803	snd_soc_dapm_sync(&card->dapm);
 804}
 805
 806/* powers up audio subsystem after a suspend */
 807int snd_soc_resume(struct device *dev)
 808{
 809	struct snd_soc_card *card = dev_get_drvdata(dev);
 810	int i, ac97_control = 0;
 
 
 
 811
 812	/* If the initialization of this soc device failed, there is no codec
 813	 * associated with it. Just bail out in this case.
 814	 */
 815	if (list_empty(&card->codec_dev_list))
 816		return 0;
 817
 818	/* activate pins from sleep state */
 819	for (i = 0; i < card->num_rtd; i++) {
 820		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
 821		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
 822		if (cpu_dai->active)
 823			pinctrl_pm_select_default_state(cpu_dai->dev);
 824		if (codec_dai->active)
 825			pinctrl_pm_select_default_state(codec_dai->dev);
 
 
 
 826	}
 827
 828	/* AC97 devices might have other drivers hanging off them so
 829	 * need to resume immediately.  Other drivers don't have that
 830	 * problem and may take a substantial amount of time to resume
 
 831	 * due to I/O costs and anti-pop so handle them out of line.
 832	 */
 833	for (i = 0; i < card->num_rtd; i++) {
 834		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
 835		ac97_control |= cpu_dai->driver->ac97_control;
 
 836	}
 837	if (ac97_control) {
 838		dev_dbg(dev, "ASoC: Resuming AC97 immediately\n");
 839		soc_resume_deferred(&card->deferred_resume_work);
 840	} else {
 841		dev_dbg(dev, "ASoC: Scheduling resume work\n");
 842		if (!schedule_work(&card->deferred_resume_work))
 843			dev_err(dev, "ASoC: resume work item may be lost\n");
 844	}
 845
 846	return 0;
 847}
 848EXPORT_SYMBOL_GPL(snd_soc_resume);
 
 
 
 
 
 
 849#else
 850#define snd_soc_suspend NULL
 851#define snd_soc_resume NULL
 
 
 
 852#endif
 853
 854static const struct snd_soc_dai_ops null_dai_ops = {
 855};
 856
 857static int soc_bind_dai_link(struct snd_soc_card *card, int num)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 858{
 859	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
 860	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
 861	struct snd_soc_component *component;
 862	struct snd_soc_codec *codec;
 863	struct snd_soc_platform *platform;
 864	struct snd_soc_dai *codec_dai, *cpu_dai;
 865	const char *platform_name;
 866
 867	dev_dbg(card->dev, "ASoC: binding %s at idx %d\n", dai_link->name, num);
 868
 869	/* Find CPU DAI from registered DAIs*/
 870	list_for_each_entry(component, &component_list, list) {
 871		if (dai_link->cpu_of_node &&
 872			component->dev->of_node != dai_link->cpu_of_node)
 873			continue;
 874		if (dai_link->cpu_name &&
 875			strcmp(dev_name(component->dev), dai_link->cpu_name))
 876			continue;
 877		list_for_each_entry(cpu_dai, &component->dai_list, list) {
 878			if (dai_link->cpu_dai_name &&
 879				strcmp(cpu_dai->name, dai_link->cpu_dai_name))
 
 880				continue;
 881
 882			rtd->cpu_dai = cpu_dai;
 883		}
 884	}
 885
 886	if (!rtd->cpu_dai) {
 887		dev_err(card->dev, "ASoC: CPU DAI %s not registered\n",
 888			dai_link->cpu_dai_name);
 889		return -EPROBE_DEFER;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 890	}
 891
 892	/* Find CODEC from registered CODECs */
 893	list_for_each_entry(codec, &codec_list, list) {
 894		if (dai_link->codec_of_node) {
 895			if (codec->dev->of_node != dai_link->codec_of_node)
 896				continue;
 897		} else {
 898			if (strcmp(codec->name, dai_link->codec_name))
 899				continue;
 900		}
 
 901
 902		rtd->codec = codec;
 
 903
 904		/*
 905		 * CODEC found, so find CODEC DAI from registered DAIs from
 906		 * this CODEC
 907		 */
 908		list_for_each_entry(codec_dai, &codec->component.dai_list, list) {
 909			if (!strcmp(codec_dai->name, dai_link->codec_dai_name)) {
 910				rtd->codec_dai = codec_dai;
 911				break;
 912			}
 913		}
 914
 915		if (!rtd->codec_dai) {
 916			dev_err(card->dev, "ASoC: CODEC DAI %s not registered\n",
 917				dai_link->codec_dai_name);
 918			return -EPROBE_DEFER;
 919		}
 920	}
 921
 922	if (!rtd->codec) {
 923		dev_err(card->dev, "ASoC: CODEC %s not registered\n",
 924			dai_link->codec_name);
 925		return -EPROBE_DEFER;
 
 
 
 
 
 
 926	}
 
 927
 928	/* if there's no platform we match on the empty platform */
 929	platform_name = dai_link->platform_name;
 930	if (!platform_name && !dai_link->platform_of_node)
 931		platform_name = "snd-soc-dummy";
 932
 933	/* find one from the set of registered platforms */
 934	list_for_each_entry(platform, &platform_list, list) {
 935		if (dai_link->platform_of_node) {
 936			if (platform->dev->of_node !=
 937			    dai_link->platform_of_node)
 938				continue;
 939		} else {
 940			if (strcmp(platform->name, platform_name))
 941				continue;
 942		}
 943
 944		rtd->platform = platform;
 945	}
 946	if (!rtd->platform) {
 947		dev_err(card->dev, "ASoC: platform %s not registered\n",
 948			dai_link->platform_name);
 949		return -EPROBE_DEFER;
 
 
 
 
 
 
 
 
 950	}
 951
 952	card->num_rtd++;
 
 953
 954	return 0;
 
 
 955}
 956
 957static int soc_remove_platform(struct snd_soc_platform *platform)
 958{
 
 
 959	int ret;
 960
 961	if (platform->driver->remove) {
 962		ret = platform->driver->remove(platform);
 963		if (ret < 0)
 964			dev_err(platform->dev, "ASoC: failed to remove %d\n",
 965				ret);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 966	}
 967
 968	/* Make sure all DAPM widgets are freed */
 969	snd_soc_dapm_free(&platform->dapm);
 
 
 
 
 970
 971	soc_cleanup_platform_debugfs(platform);
 972	platform->probed = 0;
 973	list_del(&platform->card_list);
 974	module_put(platform->dev->driver->owner);
 975
 976	return 0;
 
 
 
 
 977}
 978
 979static void soc_remove_codec(struct snd_soc_codec *codec)
 980{
 981	int err;
 
 982
 983	if (codec->driver->remove) {
 984		err = codec->driver->remove(codec);
 985		if (err < 0)
 986			dev_err(codec->dev, "ASoC: failed to remove %d\n", err);
 987	}
 988
 989	/* Make sure all DAPM widgets are freed */
 990	snd_soc_dapm_free(&codec->dapm);
 991
 992	soc_cleanup_codec_debugfs(codec);
 993	codec->probed = 0;
 994	list_del(&codec->card_list);
 995	module_put(codec->dev->driver->owner);
 996}
 997
 998static void soc_remove_link_dais(struct snd_soc_card *card, int num, int order)
 
 999{
1000	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1001	struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1002	int err;
 
 
 
 
1003
1004	/* unregister the rtd device */
1005	if (rtd->dev_registered) {
1006		device_remove_file(rtd->dev, &dev_attr_pmdown_time);
1007		device_remove_file(rtd->dev, &dev_attr_codec_reg);
1008		device_unregister(rtd->dev);
1009		rtd->dev_registered = 0;
 
 
1010	}
1011
1012	/* remove the CODEC DAI */
1013	if (codec_dai && codec_dai->probed &&
1014			codec_dai->driver->remove_order == order) {
1015		if (codec_dai->driver->remove) {
1016			err = codec_dai->driver->remove(codec_dai);
1017			if (err < 0)
1018				dev_err(codec_dai->dev,
1019					"ASoC: failed to remove %s: %d\n",
1020					codec_dai->name, err);
1021		}
1022		codec_dai->probed = 0;
1023		list_del(&codec_dai->card_list);
 
 
 
 
 
 
 
1024	}
1025
1026	/* remove the cpu_dai */
1027	if (cpu_dai && cpu_dai->probed &&
1028			cpu_dai->driver->remove_order == order) {
1029		if (cpu_dai->driver->remove) {
1030			err = cpu_dai->driver->remove(cpu_dai);
1031			if (err < 0)
1032				dev_err(cpu_dai->dev,
1033					"ASoC: failed to remove %s: %d\n",
1034					cpu_dai->name, err);
1035		}
1036		cpu_dai->probed = 0;
1037		list_del(&cpu_dai->card_list);
1038
1039		if (!cpu_dai->codec) {
1040			snd_soc_dapm_free(&cpu_dai->dapm);
1041			module_put(cpu_dai->dev->driver->owner);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1042		}
1043	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1044}
1045
1046static void soc_remove_link_components(struct snd_soc_card *card, int num,
1047				       int order)
1048{
1049	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1050	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1051	struct snd_soc_dai *codec_dai = rtd->codec_dai;
1052	struct snd_soc_platform *platform = rtd->platform;
1053	struct snd_soc_codec *codec;
1054
1055	/* remove the platform */
1056	if (platform && platform->probed &&
1057	    platform->driver->remove_order == order) {
1058		soc_remove_platform(platform);
1059	}
1060
1061	/* remove the CODEC-side CODEC */
1062	if (codec_dai) {
1063		codec = codec_dai->codec;
1064		if (codec && codec->probed &&
1065		    codec->driver->remove_order == order)
1066			soc_remove_codec(codec);
1067	}
1068
1069	/* remove any CPU-side CODEC */
1070	if (cpu_dai) {
1071		codec = cpu_dai->codec;
1072		if (codec && codec->probed &&
1073		    codec->driver->remove_order == order)
1074			soc_remove_codec(codec);
1075	}
1076}
1077
1078static void soc_remove_dai_links(struct snd_soc_card *card)
1079{
1080	int dai, order;
 
 
 
 
1081
1082	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1083			order++) {
1084		for (dai = 0; dai < card->num_rtd; dai++)
1085			soc_remove_link_dais(card, dai, order);
 
1086	}
1087
1088	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1089			order++) {
1090		for (dai = 0; dai < card->num_rtd; dai++)
1091			soc_remove_link_components(card, dai, order);
1092	}
1093
1094	card->num_rtd = 0;
1095}
1096
1097static void soc_set_name_prefix(struct snd_soc_card *card,
1098				struct snd_soc_codec *codec)
1099{
1100	int i;
 
 
 
 
 
 
1101
1102	if (card->codec_conf == NULL)
1103		return;
 
 
 
 
1104
1105	for (i = 0; i < card->num_configs; i++) {
1106		struct snd_soc_codec_conf *map = &card->codec_conf[i];
1107		if (map->dev_name && !strcmp(codec->name, map->dev_name)) {
1108			codec->name_prefix = map->name_prefix;
1109			break;
1110		}
1111	}
1112}
1113
1114static int soc_probe_codec(struct snd_soc_card *card,
1115			   struct snd_soc_codec *codec)
1116{
1117	int ret = 0;
1118	const struct snd_soc_codec_driver *driver = codec->driver;
1119	struct snd_soc_dai *dai;
 
 
 
 
 
 
 
1120
1121	codec->card = card;
1122	codec->dapm.card = card;
1123	soc_set_name_prefix(card, codec);
1124
1125	if (!try_module_get(codec->dev->driver->owner))
1126		return -ENODEV;
 
 
 
 
 
 
1127
1128	soc_init_codec_debugfs(codec);
 
1129
1130	if (driver->dapm_widgets)
1131		snd_soc_dapm_new_controls(&codec->dapm, driver->dapm_widgets,
1132					  driver->num_dapm_widgets);
 
 
 
1133
1134	/* Create DAPM widgets for each DAI stream */
1135	list_for_each_entry(dai, &codec->component.dai_list, list)
1136		snd_soc_dapm_new_dai_widgets(&codec->dapm, dai);
 
1137
1138	codec->dapm.idle_bias_off = driver->idle_bias_off;
 
1139
1140	if (!codec->write && dev_get_regmap(codec->dev, NULL)) {
1141		/* Set the default I/O up try regmap */
1142		ret = snd_soc_codec_set_cache_io(codec, NULL);
1143		if (ret < 0) {
1144			dev_err(codec->dev,
1145				"Failed to set cache I/O: %d\n", ret);
1146			goto err_probe;
1147		}
1148	}
 
1149
1150	if (driver->probe) {
1151		ret = driver->probe(codec);
1152		if (ret < 0) {
1153			dev_err(codec->dev,
1154				"ASoC: failed to probe CODEC %d\n", ret);
1155			goto err_probe;
 
 
 
 
 
 
 
 
 
 
 
 
 
1156		}
1157		WARN(codec->dapm.idle_bias_off &&
1158			codec->dapm.bias_level != SND_SOC_BIAS_OFF,
1159			"codec %s can not start from non-off bias with idle_bias_off==1\n",
1160			codec->name);
1161	}
1162
1163	if (driver->controls)
1164		snd_soc_add_codec_controls(codec, driver->controls,
1165				     driver->num_controls);
1166	if (driver->dapm_routes)
1167		snd_soc_dapm_add_routes(&codec->dapm, driver->dapm_routes,
1168					driver->num_dapm_routes);
1169
1170	/* mark codec as probed and add to card codec list */
1171	codec->probed = 1;
1172	list_add(&codec->card_list, &card->codec_dev_list);
1173	list_add(&codec->dapm.list, &card->dapm_list);
1174
1175	return 0;
 
1176
1177err_probe:
1178	soc_cleanup_codec_debugfs(codec);
1179	module_put(codec->dev->driver->owner);
 
 
 
 
 
 
 
 
 
1180
1181	return ret;
 
1182}
1183
1184static int soc_probe_platform(struct snd_soc_card *card,
1185			   struct snd_soc_platform *platform)
1186{
1187	int ret = 0;
1188	const struct snd_soc_platform_driver *driver = platform->driver;
1189	struct snd_soc_component *component;
1190	struct snd_soc_dai *dai;
1191
1192	platform->card = card;
1193	platform->dapm.card = card;
 
 
 
 
 
 
 
 
1194
1195	if (!try_module_get(platform->dev->driver->owner))
1196		return -ENODEV;
 
 
 
 
1197
1198	soc_init_platform_debugfs(platform);
 
 
 
 
 
 
1199
1200	if (driver->dapm_widgets)
1201		snd_soc_dapm_new_controls(&platform->dapm,
1202			driver->dapm_widgets, driver->num_dapm_widgets);
 
 
 
 
 
 
 
 
 
1203
1204	/* Create DAPM widgets for each DAI stream */
1205	list_for_each_entry(component, &component_list, list) {
1206		if (component->dev != platform->dev)
1207			continue;
1208		list_for_each_entry(dai, &component->dai_list, list)
1209			snd_soc_dapm_new_dai_widgets(&platform->dapm, dai);
1210	}
1211
1212	platform->dapm.idle_bias_off = 1;
 
 
 
 
 
 
1213
1214	if (driver->probe) {
1215		ret = driver->probe(platform);
1216		if (ret < 0) {
1217			dev_err(platform->dev,
1218				"ASoC: failed to probe platform %d\n", ret);
1219			goto err_probe;
1220		}
 
 
 
1221	}
1222
1223	if (driver->controls)
1224		snd_soc_add_platform_controls(platform, driver->controls,
1225				     driver->num_controls);
1226	if (driver->dapm_routes)
1227		snd_soc_dapm_add_routes(&platform->dapm, driver->dapm_routes,
1228					driver->num_dapm_routes);
1229
1230	/* mark platform as probed and add to card platform list */
1231	platform->probed = 1;
1232	list_add(&platform->card_list, &card->platform_dev_list);
1233	list_add(&platform->dapm.list, &card->dapm_list);
 
 
 
 
 
 
 
 
1234
1235	return 0;
 
 
 
 
 
 
1236
1237err_probe:
1238	soc_cleanup_platform_debugfs(platform);
1239	module_put(platform->dev->driver->owner);
1240
1241	return ret;
1242}
 
1243
1244static void rtd_release(struct device *dev)
 
 
 
 
 
 
 
 
 
 
 
 
1245{
1246	kfree(dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1247}
 
1248
1249static int soc_post_component_init(struct snd_soc_card *card,
1250				   struct snd_soc_codec *codec,
1251				   int num, int dailess)
 
 
 
 
 
 
 
 
 
1252{
1253	struct snd_soc_dai_link *dai_link = NULL;
1254	struct snd_soc_aux_dev *aux_dev = NULL;
1255	struct snd_soc_pcm_runtime *rtd;
1256	const char *name;
1257	int ret = 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
1258
1259	if (!dailess) {
1260		dai_link = &card->dai_link[num];
1261		rtd = &card->rtd[num];
1262		name = dai_link->name;
1263	} else {
1264		aux_dev = &card->aux_dev[num];
1265		rtd = &card->rtd_aux[num];
1266		name = aux_dev->name;
1267	}
1268	rtd->card = card;
 
 
 
 
 
1269
1270	/* do machine specific initialization */
1271	if (!dailess && dai_link->init)
1272		ret = dai_link->init(rtd);
1273	else if (dailess && aux_dev->init)
1274		ret = aux_dev->init(&codec->dapm);
1275	if (ret < 0) {
1276		dev_err(card->dev, "ASoC: failed to init %s: %d\n", name, ret);
1277		return ret;
1278	}
1279
1280	/* register the rtd device */
1281	rtd->codec = codec;
1282
1283	rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL);
1284	if (!rtd->dev)
1285		return -ENOMEM;
1286	device_initialize(rtd->dev);
1287	rtd->dev->parent = card->dev;
1288	rtd->dev->release = rtd_release;
1289	rtd->dev->init_name = name;
1290	dev_set_drvdata(rtd->dev, rtd);
1291	mutex_init(&rtd->pcm_mutex);
1292	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients);
1293	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].be_clients);
1294	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].fe_clients);
1295	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].fe_clients);
1296	ret = device_add(rtd->dev);
1297	if (ret < 0) {
1298		/* calling put_device() here to free the rtd->dev */
1299		put_device(rtd->dev);
1300		dev_err(card->dev,
1301			"ASoC: failed to register runtime device: %d\n", ret);
1302		return ret;
1303	}
1304	rtd->dev_registered = 1;
 
 
1305
1306	/* add DAPM sysfs entries for this codec */
1307	ret = snd_soc_dapm_sys_add(rtd->dev);
1308	if (ret < 0)
1309		dev_err(codec->dev,
1310			"ASoC: failed to add codec dapm sysfs entries: %d\n", ret);
1311
1312	/* add codec sysfs entries */
1313	ret = device_create_file(rtd->dev, &dev_attr_codec_reg);
1314	if (ret < 0)
1315		dev_err(codec->dev,
1316			"ASoC: failed to add codec sysfs files: %d\n", ret);
1317
1318#ifdef CONFIG_DEBUG_FS
1319	/* add DPCM sysfs entries */
1320	if (!dailess && !dai_link->dynamic)
1321		goto out;
1322
1323	ret = soc_dpcm_debugfs_add(rtd);
1324	if (ret < 0)
1325		dev_err(rtd->dev, "ASoC: failed to add dpcm sysfs entries: %d\n", ret);
 
1326
1327out:
1328#endif
1329	return 0;
1330}
1331
1332static int soc_probe_link_components(struct snd_soc_card *card, int num,
1333				     int order)
1334{
1335	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1336	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1337	struct snd_soc_dai *codec_dai = rtd->codec_dai;
1338	struct snd_soc_platform *platform = rtd->platform;
1339	int ret;
1340
1341	/* probe the CPU-side component, if it is a CODEC */
1342	if (cpu_dai->codec &&
1343	    !cpu_dai->codec->probed &&
1344	    cpu_dai->codec->driver->probe_order == order) {
1345		ret = soc_probe_codec(card, cpu_dai->codec);
1346		if (ret < 0)
1347			return ret;
1348	}
1349
1350	/* probe the CODEC-side component */
1351	if (!codec_dai->codec->probed &&
1352	    codec_dai->codec->driver->probe_order == order) {
1353		ret = soc_probe_codec(card, codec_dai->codec);
1354		if (ret < 0)
 
1355			return ret;
 
1356	}
1357
1358	/* probe the platform */
1359	if (!platform->probed &&
1360	    platform->driver->probe_order == order) {
1361		ret = soc_probe_platform(card, platform);
1362		if (ret < 0)
1363			return ret;
1364	}
1365
1366	return 0;
1367}
 
1368
1369static int soc_probe_link_dais(struct snd_soc_card *card, int num, int order)
1370{
1371	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1372	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1373	struct snd_soc_codec *codec = rtd->codec;
1374	struct snd_soc_platform *platform = rtd->platform;
1375	struct snd_soc_dai *codec_dai = rtd->codec_dai;
1376	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1377	struct snd_soc_dapm_widget *play_w, *capture_w;
1378	int ret;
1379
1380	dev_dbg(card->dev, "ASoC: probe %s dai link %d late %d\n",
1381			card->name, num, order);
1382
1383	/* config components */
1384	cpu_dai->platform = platform;
1385	codec_dai->card = card;
1386	cpu_dai->card = card;
 
 
 
1387
1388	/* set default power off timeout */
1389	rtd->pmdown_time = pmdown_time;
1390
1391	/* probe the cpu_dai */
1392	if (!cpu_dai->probed &&
1393			cpu_dai->driver->probe_order == order) {
1394		if (!cpu_dai->codec) {
1395			cpu_dai->dapm.card = card;
1396			if (!try_module_get(cpu_dai->dev->driver->owner))
1397				return -ENODEV;
1398
1399			list_add(&cpu_dai->dapm.list, &card->dapm_list);
1400		}
1401
1402		if (cpu_dai->driver->probe) {
1403			ret = cpu_dai->driver->probe(cpu_dai);
1404			if (ret < 0) {
1405				dev_err(cpu_dai->dev,
1406					"ASoC: failed to probe CPU DAI %s: %d\n",
1407					cpu_dai->name, ret);
1408				module_put(cpu_dai->dev->driver->owner);
1409				return ret;
1410			}
1411		}
1412		cpu_dai->probed = 1;
1413		/* mark cpu_dai as probed and add to card dai list */
1414		list_add(&cpu_dai->card_list, &card->dai_dev_list);
1415	}
1416
1417	/* probe the CODEC DAI */
1418	if (!codec_dai->probed && codec_dai->driver->probe_order == order) {
1419		if (codec_dai->driver->probe) {
1420			ret = codec_dai->driver->probe(codec_dai);
1421			if (ret < 0) {
1422				dev_err(codec_dai->dev,
1423					"ASoC: failed to probe CODEC DAI %s: %d\n",
1424					codec_dai->name, ret);
1425				return ret;
1426			}
1427		}
1428
1429		/* mark codec_dai as probed and add to card dai list */
1430		codec_dai->probed = 1;
1431		list_add(&codec_dai->card_list, &card->dai_dev_list);
 
 
 
1432	}
 
 
 
 
 
 
 
 
 
 
 
1433
1434	/* complete DAI probe during last probe */
1435	if (order != SND_SOC_COMP_ORDER_LAST)
1436		return 0;
 
 
1437
1438	ret = soc_post_component_init(card, codec, num, 0);
1439	if (ret)
1440		return ret;
 
 
1441
1442	ret = device_create_file(rtd->dev, &dev_attr_pmdown_time);
1443	if (ret < 0)
1444		dev_warn(rtd->dev, "ASoC: failed to add pmdown_time sysfs: %d\n",
1445			ret);
 
1446
1447	if (cpu_dai->driver->compress_dai) {
1448		/*create compress_device"*/
1449		ret = soc_new_compress(rtd, num);
1450		if (ret < 0) {
1451			dev_err(card->dev, "ASoC: can't create compress %s\n",
1452					 dai_link->stream_name);
1453			return ret;
1454		}
1455	} else {
1456
1457		if (!dai_link->params) {
1458			/* create the pcm */
1459			ret = soc_new_pcm(rtd, num);
1460			if (ret < 0) {
1461				dev_err(card->dev, "ASoC: can't create pcm %s :%d\n",
1462				       dai_link->stream_name, ret);
1463				return ret;
1464			}
1465		} else {
1466			INIT_DELAYED_WORK(&rtd->delayed_work,
1467						codec2codec_close_delayed_work);
1468
1469			/* link the DAI widgets */
1470			play_w = codec_dai->playback_widget;
1471			capture_w = cpu_dai->capture_widget;
1472			if (play_w && capture_w) {
1473				ret = snd_soc_dapm_new_pcm(card, dai_link->params,
1474						   capture_w, play_w);
1475				if (ret != 0) {
1476					dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n",
1477						play_w->name, capture_w->name, ret);
1478					return ret;
1479				}
1480			}
1481
1482			play_w = cpu_dai->playback_widget;
1483			capture_w = codec_dai->capture_widget;
1484			if (play_w && capture_w) {
1485				ret = snd_soc_dapm_new_pcm(card, dai_link->params,
1486						   capture_w, play_w);
1487				if (ret != 0) {
1488					dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n",
1489						play_w->name, capture_w->name, ret);
1490					return ret;
1491				}
1492			}
1493		}
1494	}
1495
1496	/* add platform data for AC97 devices */
1497	if (rtd->codec_dai->driver->ac97_control)
1498		snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1499
1500	return 0;
 
 
 
 
 
 
 
 
 
 
1501}
1502
1503#ifdef CONFIG_SND_SOC_AC97_BUS
1504static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
 
 
 
 
 
 
 
 
 
 
 
 
 
1505{
 
 
 
1506	int ret;
1507
1508	/* Only instantiate AC97 if not already done by the adaptor
1509	 * for the generic AC97 subsystem.
 
 
 
 
 
 
 
 
 
 
1510	 */
1511	if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) {
1512		/*
1513		 * It is possible that the AC97 device is already registered to
1514		 * the device subsystem. This happens when the device is created
1515		 * via snd_ac97_mixer(). Currently only SoC codec that does so
1516		 * is the generic AC97 glue but others migh emerge.
1517		 *
1518		 * In those cases we don't try to register the device again.
1519		 */
1520		if (!rtd->codec->ac97_created)
1521			return 0;
1522
1523		ret = soc_ac97_dev_register(rtd->codec);
1524		if (ret < 0) {
1525			dev_err(rtd->codec->dev,
1526				"ASoC: AC97 device register failed: %d\n", ret);
1527			return ret;
 
 
 
 
 
 
 
 
 
1528		}
1529
1530		rtd->codec->ac97_registered = 1;
1531	}
 
 
 
 
 
 
 
 
1532	return 0;
1533}
 
1534
1535static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec)
 
 
 
 
 
 
1536{
1537	if (codec->ac97_registered) {
1538		soc_ac97_dev_unregister(codec);
1539		codec->ac97_registered = 0;
 
 
 
 
 
1540	}
 
 
1541}
1542#endif
1543
1544static int soc_check_aux_dev(struct snd_soc_card *card, int num)
 
 
 
 
1545{
1546	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
1547	struct snd_soc_codec *codec;
1548
1549	/* find CODEC from registered CODECs*/
1550	list_for_each_entry(codec, &codec_list, list) {
1551		if (!strcmp(codec->name, aux_dev->codec_name))
1552			return 0;
 
1553	}
1554
1555	dev_err(card->dev, "ASoC: %s not registered\n", aux_dev->codec_name);
1556
1557	return -EPROBE_DEFER;
1558}
1559
1560static int soc_probe_aux_dev(struct snd_soc_card *card, int num)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1561{
1562	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
1563	struct snd_soc_codec *codec;
1564	int ret = -ENODEV;
1565
1566	/* find CODEC from registered CODECs*/
1567	list_for_each_entry(codec, &codec_list, list) {
1568		if (!strcmp(codec->name, aux_dev->codec_name)) {
1569			if (codec->probed) {
1570				dev_err(codec->dev,
1571					"ASoC: codec already probed");
1572				ret = -EBUSY;
1573				goto out;
1574			}
1575			goto found;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1576		}
1577	}
1578	/* codec not found */
1579	dev_err(card->dev, "ASoC: codec %s not found", aux_dev->codec_name);
1580	return -EPROBE_DEFER;
1581
1582found:
1583	ret = soc_probe_codec(card, codec);
1584	if (ret < 0)
1585		return ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1586
1587	ret = soc_post_component_init(card, codec, num, 1);
 
1588
1589out:
1590	return ret;
1591}
 
 
1592
1593static void soc_remove_aux_dev(struct snd_soc_card *card, int num)
1594{
1595	struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
1596	struct snd_soc_codec *codec = rtd->codec;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1597
1598	/* unregister the rtd device */
1599	if (rtd->dev_registered) {
1600		device_remove_file(rtd->dev, &dev_attr_codec_reg);
1601		device_unregister(rtd->dev);
1602		rtd->dev_registered = 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1603	}
1604
1605	if (codec && codec->probed)
1606		soc_remove_codec(codec);
1607}
1608
1609static int snd_soc_init_codec_cache(struct snd_soc_codec *codec)
1610{
1611	int ret;
 
 
 
 
 
 
 
 
 
 
 
 
1612
1613	if (codec->cache_init)
1614		return 0;
1615
1616	ret = snd_soc_cache_init(codec);
1617	if (ret < 0) {
1618		dev_err(codec->dev,
1619			"ASoC: Failed to set cache compression type: %d\n",
1620			ret);
1621		return ret;
1622	}
1623	codec->cache_init = 1;
1624	return 0;
1625}
1626
1627static int snd_soc_instantiate_card(struct snd_soc_card *card)
1628{
1629	struct snd_soc_codec *codec;
1630	struct snd_soc_dai_link *dai_link;
1631	int ret, i, order, dai_fmt;
1632
 
 
 
 
 
 
 
 
 
 
1633	mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT);
1634
 
 
 
 
 
1635	/* bind DAIs */
1636	for (i = 0; i < card->num_links; i++) {
1637		ret = soc_bind_dai_link(card, i);
1638		if (ret != 0)
1639			goto base_error;
1640	}
1641
1642	/* check aux_devs too */
1643	for (i = 0; i < card->num_aux_devs; i++) {
1644		ret = soc_check_aux_dev(card, i);
1645		if (ret != 0)
1646			goto base_error;
1647	}
1648
1649	/* initialize the register cache for each available codec */
1650	list_for_each_entry(codec, &codec_list, list) {
1651		if (codec->cache_init)
1652			continue;
1653		ret = snd_soc_init_codec_cache(codec);
1654		if (ret < 0)
1655			goto base_error;
1656	}
1657
1658	/* card bind complete so register a sound card */
1659	ret = snd_card_new(card->dev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1660			card->owner, 0, &card->snd_card);
1661	if (ret < 0) {
1662		dev_err(card->dev,
1663			"ASoC: can't create sound card for card %s: %d\n",
1664			card->name, ret);
1665		goto base_error;
1666	}
1667
1668	card->dapm.bias_level = SND_SOC_BIAS_OFF;
1669	card->dapm.dev = card->dev;
1670	card->dapm.card = card;
1671	list_add(&card->dapm.list, &card->dapm_list);
1672
1673#ifdef CONFIG_DEBUG_FS
1674	snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
1675#endif
1676
1677#ifdef CONFIG_PM_SLEEP
1678	/* deferred resume work */
1679	INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
1680#endif
1681
1682	if (card->dapm_widgets)
1683		snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
1684					  card->num_dapm_widgets);
 
1685
1686	/* initialise the sound card only once */
1687	if (card->probe) {
1688		ret = card->probe(card);
1689		if (ret < 0)
1690			goto card_probe_error;
1691	}
1692
1693	/* probe all components used by DAI links on this card */
1694	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1695			order++) {
1696		for (i = 0; i < card->num_links; i++) {
1697			ret = soc_probe_link_components(card, i, order);
1698			if (ret < 0) {
1699				dev_err(card->dev,
1700					"ASoC: failed to instantiate card %d\n",
1701					ret);
1702				goto probe_dai_err;
1703			}
1704		}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1705	}
1706
1707	/* probe all DAI links on this card */
1708	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1709			order++) {
1710		for (i = 0; i < card->num_links; i++) {
1711			ret = soc_probe_link_dais(card, i, order);
1712			if (ret < 0) {
1713				dev_err(card->dev,
1714					"ASoC: failed to instantiate card %d\n",
1715					ret);
1716				goto probe_dai_err;
1717			}
1718		}
1719	}
1720
1721	for (i = 0; i < card->num_aux_devs; i++) {
1722		ret = soc_probe_aux_dev(card, i);
1723		if (ret < 0) {
1724			dev_err(card->dev,
1725				"ASoC: failed to add auxiliary devices %d\n",
1726				ret);
1727			goto probe_aux_dev_err;
1728		}
1729	}
1730
1731	snd_soc_dapm_link_dai_widgets(card);
1732	snd_soc_dapm_connect_dai_link_widgets(card);
1733
1734	if (card->controls)
1735		snd_soc_add_card_controls(card, card->controls, card->num_controls);
 
 
1736
1737	if (card->dapm_routes)
1738		snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
1739					card->num_dapm_routes);
1740
1741	for (i = 0; i < card->num_links; i++) {
1742		dai_link = &card->dai_link[i];
1743		dai_fmt = dai_link->dai_fmt;
1744
1745		if (dai_fmt) {
1746			ret = snd_soc_dai_set_fmt(card->rtd[i].codec_dai,
1747						  dai_fmt);
1748			if (ret != 0 && ret != -ENOTSUPP)
1749				dev_warn(card->rtd[i].codec_dai->dev,
1750					 "ASoC: Failed to set DAI format: %d\n",
1751					 ret);
1752		}
1753
1754		/* If this is a regular CPU link there will be a platform */
1755		if (dai_fmt &&
1756		    (dai_link->platform_name || dai_link->platform_of_node)) {
1757			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1758						  dai_fmt);
1759			if (ret != 0 && ret != -ENOTSUPP)
1760				dev_warn(card->rtd[i].cpu_dai->dev,
1761					 "ASoC: Failed to set DAI format: %d\n",
1762					 ret);
1763		} else if (dai_fmt) {
1764			/* Flip the polarity for the "CPU" end */
1765			dai_fmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
1766			switch (dai_link->dai_fmt &
1767				SND_SOC_DAIFMT_MASTER_MASK) {
1768			case SND_SOC_DAIFMT_CBM_CFM:
1769				dai_fmt |= SND_SOC_DAIFMT_CBS_CFS;
1770				break;
1771			case SND_SOC_DAIFMT_CBM_CFS:
1772				dai_fmt |= SND_SOC_DAIFMT_CBS_CFM;
1773				break;
1774			case SND_SOC_DAIFMT_CBS_CFM:
1775				dai_fmt |= SND_SOC_DAIFMT_CBM_CFS;
1776				break;
1777			case SND_SOC_DAIFMT_CBS_CFS:
1778				dai_fmt |= SND_SOC_DAIFMT_CBM_CFM;
1779				break;
1780			}
1781
1782			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1783						  dai_fmt);
1784			if (ret != 0 && ret != -ENOTSUPP)
1785				dev_warn(card->rtd[i].cpu_dai->dev,
1786					 "ASoC: Failed to set DAI format: %d\n",
1787					 ret);
1788		}
1789	}
1790
1791	snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1792		 "%s", card->name);
1793	snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
1794		 "%s", card->long_name ? card->long_name : card->name);
1795	snprintf(card->snd_card->driver, sizeof(card->snd_card->driver),
1796		 "%s", card->driver_name ? card->driver_name : card->name);
1797	for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) {
1798		switch (card->snd_card->driver[i]) {
1799		case '_':
1800		case '-':
1801		case '\0':
1802			break;
1803		default:
1804			if (!isalnum(card->snd_card->driver[i]))
1805				card->snd_card->driver[i] = '_';
1806			break;
1807		}
1808	}
1809
1810	if (card->late_probe) {
1811		ret = card->late_probe(card);
1812		if (ret < 0) {
1813			dev_err(card->dev, "ASoC: %s late_probe() failed: %d\n",
1814				card->name, ret);
1815			goto probe_aux_dev_err;
1816		}
1817	}
1818
1819	if (card->fully_routed)
1820		list_for_each_entry(codec, &card->codec_dev_list, card_list)
1821			snd_soc_dapm_auto_nc_codec_pins(codec);
1822
1823	snd_soc_dapm_new_widgets(card);
1824
1825	ret = snd_card_register(card->snd_card);
1826	if (ret < 0) {
1827		dev_err(card->dev, "ASoC: failed to register soundcard %d\n",
1828				ret);
1829		goto probe_aux_dev_err;
1830	}
1831
1832#ifdef CONFIG_SND_SOC_AC97_BUS
1833	/* register any AC97 codecs */
1834	for (i = 0; i < card->num_rtd; i++) {
1835		ret = soc_register_ac97_dai_link(&card->rtd[i]);
1836		if (ret < 0) {
1837			dev_err(card->dev,
1838				"ASoC: failed to register AC97: %d\n", ret);
1839			while (--i >= 0)
1840				soc_unregister_ac97_dai_link(card->rtd[i].codec);
1841			goto probe_aux_dev_err;
1842		}
1843	}
1844#endif
1845
1846	card->instantiated = 1;
 
1847	snd_soc_dapm_sync(&card->dapm);
1848	mutex_unlock(&card->mutex);
1849
1850	return 0;
1851
1852probe_aux_dev_err:
1853	for (i = 0; i < card->num_aux_devs; i++)
1854		soc_remove_aux_dev(card, i);
1855
1856probe_dai_err:
1857	soc_remove_dai_links(card);
1858
1859card_probe_error:
1860	if (card->remove)
1861		card->remove(card);
1862
1863	snd_card_free(card->snd_card);
1864
1865base_error:
1866	mutex_unlock(&card->mutex);
 
1867
1868	return ret;
1869}
1870
1871/* probes a new socdev */
1872static int soc_probe(struct platform_device *pdev)
1873{
1874	struct snd_soc_card *card = platform_get_drvdata(pdev);
1875
1876	/*
1877	 * no card, so machine driver should be registering card
1878	 * we should not be here in that case so ret error
1879	 */
1880	if (!card)
1881		return -EINVAL;
1882
1883	dev_warn(&pdev->dev,
1884		 "ASoC: machine %s should use snd_soc_register_card()\n",
1885		 card->name);
1886
1887	/* Bodge while we unpick instantiation */
1888	card->dev = &pdev->dev;
1889
1890	return snd_soc_register_card(card);
1891}
1892
1893static int soc_cleanup_card_resources(struct snd_soc_card *card)
1894{
1895	int i;
1896
1897	/* make sure any delayed work runs */
1898	for (i = 0; i < card->num_rtd; i++) {
1899		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1900		flush_delayed_work(&rtd->delayed_work);
1901	}
1902
1903	/* remove auxiliary devices */
1904	for (i = 0; i < card->num_aux_devs; i++)
1905		soc_remove_aux_dev(card, i);
1906
1907	/* remove and free each DAI */
1908	soc_remove_dai_links(card);
1909
1910	soc_cleanup_card_debugfs(card);
1911
1912	/* remove the card */
1913	if (card->remove)
1914		card->remove(card);
1915
1916	snd_soc_dapm_free(&card->dapm);
1917
1918	snd_card_free(card->snd_card);
1919	return 0;
1920
1921}
1922
1923/* removes a socdev */
1924static int soc_remove(struct platform_device *pdev)
1925{
1926	struct snd_soc_card *card = platform_get_drvdata(pdev);
1927
1928	snd_soc_unregister_card(card);
1929	return 0;
1930}
1931
1932int snd_soc_poweroff(struct device *dev)
1933{
1934	struct snd_soc_card *card = dev_get_drvdata(dev);
1935	int i;
1936
1937	if (!card->instantiated)
1938		return 0;
1939
1940	/* Flush out pmdown_time work - we actually do want to run it
1941	 * now, we're shutting down so no imminent restart. */
1942	for (i = 0; i < card->num_rtd; i++) {
1943		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1944		flush_delayed_work(&rtd->delayed_work);
1945	}
1946
1947	snd_soc_dapm_shutdown(card);
1948
1949	/* deactivate pins to sleep state */
1950	for (i = 0; i < card->num_rtd; i++) {
1951		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1952		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
1953		pinctrl_pm_select_sleep_state(codec_dai->dev);
 
1954		pinctrl_pm_select_sleep_state(cpu_dai->dev);
 
 
 
1955	}
1956
1957	return 0;
1958}
1959EXPORT_SYMBOL_GPL(snd_soc_poweroff);
1960
1961const struct dev_pm_ops snd_soc_pm_ops = {
1962	.suspend = snd_soc_suspend,
1963	.resume = snd_soc_resume,
1964	.freeze = snd_soc_suspend,
1965	.thaw = snd_soc_resume,
1966	.poweroff = snd_soc_poweroff,
1967	.restore = snd_soc_resume,
1968};
1969EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
1970
1971/* ASoC platform driver */
1972static struct platform_driver soc_driver = {
1973	.driver		= {
1974		.name		= "soc-audio",
1975		.owner		= THIS_MODULE,
1976		.pm		= &snd_soc_pm_ops,
1977	},
1978	.probe		= soc_probe,
1979	.remove		= soc_remove,
1980};
1981
1982/**
1983 * snd_soc_codec_volatile_register: Report if a register is volatile.
1984 *
1985 * @codec: CODEC to query.
1986 * @reg: Register to query.
1987 *
1988 * Boolean function indiciating if a CODEC register is volatile.
1989 */
1990int snd_soc_codec_volatile_register(struct snd_soc_codec *codec,
1991				    unsigned int reg)
1992{
1993	if (codec->volatile_register)
1994		return codec->volatile_register(codec, reg);
1995	else
1996		return 0;
1997}
1998EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
1999
2000/**
2001 * snd_soc_codec_readable_register: Report if a register is readable.
2002 *
2003 * @codec: CODEC to query.
2004 * @reg: Register to query.
2005 *
2006 * Boolean function indicating if a CODEC register is readable.
2007 */
2008int snd_soc_codec_readable_register(struct snd_soc_codec *codec,
2009				    unsigned int reg)
2010{
2011	if (codec->readable_register)
2012		return codec->readable_register(codec, reg);
2013	else
2014		return 1;
2015}
2016EXPORT_SYMBOL_GPL(snd_soc_codec_readable_register);
2017
2018/**
2019 * snd_soc_codec_writable_register: Report if a register is writable.
2020 *
2021 * @codec: CODEC to query.
2022 * @reg: Register to query.
2023 *
2024 * Boolean function indicating if a CODEC register is writable.
2025 */
2026int snd_soc_codec_writable_register(struct snd_soc_codec *codec,
2027				    unsigned int reg)
2028{
2029	if (codec->writable_register)
2030		return codec->writable_register(codec, reg);
2031	else
2032		return 1;
2033}
2034EXPORT_SYMBOL_GPL(snd_soc_codec_writable_register);
2035
2036int snd_soc_platform_read(struct snd_soc_platform *platform,
2037					unsigned int reg)
2038{
2039	unsigned int ret;
2040
2041	if (!platform->driver->read) {
2042		dev_err(platform->dev, "ASoC: platform has no read back\n");
2043		return -1;
2044	}
2045
2046	ret = platform->driver->read(platform, reg);
2047	dev_dbg(platform->dev, "read %x => %x\n", reg, ret);
2048	trace_snd_soc_preg_read(platform, reg, ret);
2049
2050	return ret;
2051}
2052EXPORT_SYMBOL_GPL(snd_soc_platform_read);
2053
2054int snd_soc_platform_write(struct snd_soc_platform *platform,
2055					 unsigned int reg, unsigned int val)
2056{
2057	if (!platform->driver->write) {
2058		dev_err(platform->dev, "ASoC: platform has no write back\n");
2059		return -1;
2060	}
2061
2062	dev_dbg(platform->dev, "write %x = %x\n", reg, val);
2063	trace_snd_soc_preg_write(platform, reg, val);
2064	return platform->driver->write(platform, reg, val);
2065}
2066EXPORT_SYMBOL_GPL(snd_soc_platform_write);
2067
2068/**
2069 * snd_soc_new_ac97_codec - initailise AC97 device
2070 * @codec: audio codec
2071 * @ops: AC97 bus operations
2072 * @num: AC97 codec number
2073 *
2074 * Initialises AC97 codec resources for use by ad-hoc devices only.
2075 */
2076int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
2077	struct snd_ac97_bus_ops *ops, int num)
2078{
2079	mutex_lock(&codec->mutex);
2080
2081	codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
2082	if (codec->ac97 == NULL) {
2083		mutex_unlock(&codec->mutex);
2084		return -ENOMEM;
2085	}
2086
2087	codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
2088	if (codec->ac97->bus == NULL) {
2089		kfree(codec->ac97);
2090		codec->ac97 = NULL;
2091		mutex_unlock(&codec->mutex);
2092		return -ENOMEM;
2093	}
2094
2095	codec->ac97->bus->ops = ops;
2096	codec->ac97->num = num;
2097
2098	/*
2099	 * Mark the AC97 device to be created by us. This way we ensure that the
2100	 * device will be registered with the device subsystem later on.
2101	 */
2102	codec->ac97_created = 1;
2103
2104	mutex_unlock(&codec->mutex);
2105	return 0;
2106}
2107EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
2108
2109static struct snd_ac97_reset_cfg snd_ac97_rst_cfg;
2110
2111static void snd_soc_ac97_warm_reset(struct snd_ac97 *ac97)
2112{
2113	struct pinctrl *pctl = snd_ac97_rst_cfg.pctl;
2114
2115	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_warm_reset);
2116
2117	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 1);
2118
2119	udelay(10);
2120
2121	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0);
2122
2123	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run);
2124	msleep(2);
2125}
2126
2127static void snd_soc_ac97_reset(struct snd_ac97 *ac97)
2128{
2129	struct pinctrl *pctl = snd_ac97_rst_cfg.pctl;
2130
2131	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_reset);
2132
2133	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0);
2134	gpio_direction_output(snd_ac97_rst_cfg.gpio_sdata, 0);
2135	gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 0);
2136
2137	udelay(10);
2138
2139	gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 1);
2140
2141	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run);
2142	msleep(2);
2143}
2144
2145static int snd_soc_ac97_parse_pinctl(struct device *dev,
2146		struct snd_ac97_reset_cfg *cfg)
2147{
2148	struct pinctrl *p;
2149	struct pinctrl_state *state;
2150	int gpio;
2151	int ret;
2152
2153	p = devm_pinctrl_get(dev);
2154	if (IS_ERR(p)) {
2155		dev_err(dev, "Failed to get pinctrl\n");
2156		return PTR_RET(p);
2157	}
2158	cfg->pctl = p;
2159
2160	state = pinctrl_lookup_state(p, "ac97-reset");
2161	if (IS_ERR(state)) {
2162		dev_err(dev, "Can't find pinctrl state ac97-reset\n");
2163		return PTR_RET(state);
2164	}
2165	cfg->pstate_reset = state;
2166
2167	state = pinctrl_lookup_state(p, "ac97-warm-reset");
2168	if (IS_ERR(state)) {
2169		dev_err(dev, "Can't find pinctrl state ac97-warm-reset\n");
2170		return PTR_RET(state);
2171	}
2172	cfg->pstate_warm_reset = state;
2173
2174	state = pinctrl_lookup_state(p, "ac97-running");
2175	if (IS_ERR(state)) {
2176		dev_err(dev, "Can't find pinctrl state ac97-running\n");
2177		return PTR_RET(state);
2178	}
2179	cfg->pstate_run = state;
2180
2181	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 0);
2182	if (gpio < 0) {
2183		dev_err(dev, "Can't find ac97-sync gpio\n");
2184		return gpio;
2185	}
2186	ret = devm_gpio_request(dev, gpio, "AC97 link sync");
2187	if (ret) {
2188		dev_err(dev, "Failed requesting ac97-sync gpio\n");
2189		return ret;
2190	}
2191	cfg->gpio_sync = gpio;
2192
2193	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 1);
2194	if (gpio < 0) {
2195		dev_err(dev, "Can't find ac97-sdata gpio %d\n", gpio);
2196		return gpio;
2197	}
2198	ret = devm_gpio_request(dev, gpio, "AC97 link sdata");
2199	if (ret) {
2200		dev_err(dev, "Failed requesting ac97-sdata gpio\n");
2201		return ret;
2202	}
2203	cfg->gpio_sdata = gpio;
2204
2205	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 2);
2206	if (gpio < 0) {
2207		dev_err(dev, "Can't find ac97-reset gpio\n");
2208		return gpio;
2209	}
2210	ret = devm_gpio_request(dev, gpio, "AC97 link reset");
2211	if (ret) {
2212		dev_err(dev, "Failed requesting ac97-reset gpio\n");
2213		return ret;
2214	}
2215	cfg->gpio_reset = gpio;
2216
2217	return 0;
2218}
2219
2220struct snd_ac97_bus_ops *soc_ac97_ops;
2221EXPORT_SYMBOL_GPL(soc_ac97_ops);
2222
2223int snd_soc_set_ac97_ops(struct snd_ac97_bus_ops *ops)
2224{
2225	if (ops == soc_ac97_ops)
2226		return 0;
2227
2228	if (soc_ac97_ops && ops)
2229		return -EBUSY;
2230
2231	soc_ac97_ops = ops;
2232
2233	return 0;
2234}
2235EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops);
2236
2237/**
2238 * snd_soc_set_ac97_ops_of_reset - Set ac97 ops with generic ac97 reset functions
2239 *
2240 * This function sets the reset and warm_reset properties of ops and parses
2241 * the device node of pdev to get pinctrl states and gpio numbers to use.
2242 */
2243int snd_soc_set_ac97_ops_of_reset(struct snd_ac97_bus_ops *ops,
2244		struct platform_device *pdev)
2245{
2246	struct device *dev = &pdev->dev;
2247	struct snd_ac97_reset_cfg cfg;
2248	int ret;
2249
2250	ret = snd_soc_ac97_parse_pinctl(dev, &cfg);
2251	if (ret)
2252		return ret;
2253
2254	ret = snd_soc_set_ac97_ops(ops);
2255	if (ret)
2256		return ret;
2257
2258	ops->warm_reset = snd_soc_ac97_warm_reset;
2259	ops->reset = snd_soc_ac97_reset;
2260
2261	snd_ac97_rst_cfg = cfg;
2262	return 0;
2263}
2264EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops_of_reset);
2265
2266/**
2267 * snd_soc_free_ac97_codec - free AC97 codec device
2268 * @codec: audio codec
2269 *
2270 * Frees AC97 codec device resources.
2271 */
2272void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
2273{
2274	mutex_lock(&codec->mutex);
2275#ifdef CONFIG_SND_SOC_AC97_BUS
2276	soc_unregister_ac97_dai_link(codec);
2277#endif
2278	kfree(codec->ac97->bus);
2279	kfree(codec->ac97);
2280	codec->ac97 = NULL;
2281	codec->ac97_created = 0;
2282	mutex_unlock(&codec->mutex);
2283}
2284EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
2285
2286unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg)
2287{
2288	unsigned int ret;
2289
2290	ret = codec->read(codec, reg);
2291	dev_dbg(codec->dev, "read %x => %x\n", reg, ret);
2292	trace_snd_soc_reg_read(codec, reg, ret);
2293
2294	return ret;
2295}
2296EXPORT_SYMBOL_GPL(snd_soc_read);
2297
2298unsigned int snd_soc_write(struct snd_soc_codec *codec,
2299			   unsigned int reg, unsigned int val)
2300{
2301	dev_dbg(codec->dev, "write %x = %x\n", reg, val);
2302	trace_snd_soc_reg_write(codec, reg, val);
2303	return codec->write(codec, reg, val);
2304}
2305EXPORT_SYMBOL_GPL(snd_soc_write);
2306
2307/**
2308 * snd_soc_update_bits - update codec register bits
2309 * @codec: audio codec
2310 * @reg: codec register
2311 * @mask: register mask
2312 * @value: new value
2313 *
2314 * Writes new register value.
2315 *
2316 * Returns 1 for change, 0 for no change, or negative error code.
2317 */
2318int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
2319				unsigned int mask, unsigned int value)
2320{
2321	bool change;
2322	unsigned int old, new;
2323	int ret;
2324
2325	if (codec->using_regmap) {
2326		ret = regmap_update_bits_check(codec->control_data, reg,
2327					       mask, value, &change);
2328	} else {
2329		ret = snd_soc_read(codec, reg);
2330		if (ret < 0)
2331			return ret;
2332
2333		old = ret;
2334		new = (old & ~mask) | (value & mask);
2335		change = old != new;
2336		if (change)
2337			ret = snd_soc_write(codec, reg, new);
2338	}
2339
2340	if (ret < 0)
2341		return ret;
2342
2343	return change;
2344}
2345EXPORT_SYMBOL_GPL(snd_soc_update_bits);
2346
2347/**
2348 * snd_soc_update_bits_locked - update codec register bits
2349 * @codec: audio codec
2350 * @reg: codec register
2351 * @mask: register mask
2352 * @value: new value
2353 *
2354 * Writes new register value, and takes the codec mutex.
2355 *
2356 * Returns 1 for change else 0.
2357 */
2358int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
2359			       unsigned short reg, unsigned int mask,
2360			       unsigned int value)
2361{
2362	int change;
2363
2364	mutex_lock(&codec->mutex);
2365	change = snd_soc_update_bits(codec, reg, mask, value);
2366	mutex_unlock(&codec->mutex);
2367
2368	return change;
2369}
2370EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
2371
2372/**
2373 * snd_soc_test_bits - test register for change
2374 * @codec: audio codec
2375 * @reg: codec register
2376 * @mask: register mask
2377 * @value: new value
2378 *
2379 * Tests a register with a new value and checks if the new value is
2380 * different from the old value.
2381 *
2382 * Returns 1 for change else 0.
2383 */
2384int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
2385				unsigned int mask, unsigned int value)
2386{
2387	int change;
2388	unsigned int old, new;
2389
2390	old = snd_soc_read(codec, reg);
2391	new = (old & ~mask) | value;
2392	change = old != new;
2393
2394	return change;
2395}
2396EXPORT_SYMBOL_GPL(snd_soc_test_bits);
2397
2398/**
2399 * snd_soc_cnew - create new control
2400 * @_template: control template
2401 * @data: control private data
2402 * @long_name: control long name
2403 * @prefix: control name prefix
2404 *
2405 * Create a new mixer control from a template control.
2406 *
2407 * Returns 0 for success, else error.
2408 */
2409struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
2410				  void *data, const char *long_name,
2411				  const char *prefix)
2412{
2413	struct snd_kcontrol_new template;
2414	struct snd_kcontrol *kcontrol;
2415	char *name = NULL;
2416
2417	memcpy(&template, _template, sizeof(template));
2418	template.index = 0;
2419
2420	if (!long_name)
2421		long_name = template.name;
2422
2423	if (prefix) {
2424		name = kasprintf(GFP_KERNEL, "%s %s", prefix, long_name);
2425		if (!name)
2426			return NULL;
2427
2428		template.name = name;
2429	} else {
2430		template.name = long_name;
2431	}
2432
2433	kcontrol = snd_ctl_new1(&template, data);
2434
2435	kfree(name);
2436
2437	return kcontrol;
2438}
2439EXPORT_SYMBOL_GPL(snd_soc_cnew);
2440
2441static int snd_soc_add_controls(struct snd_card *card, struct device *dev,
2442	const struct snd_kcontrol_new *controls, int num_controls,
2443	const char *prefix, void *data)
2444{
2445	int err, i;
2446
2447	for (i = 0; i < num_controls; i++) {
2448		const struct snd_kcontrol_new *control = &controls[i];
 
2449		err = snd_ctl_add(card, snd_soc_cnew(control, data,
2450						     control->name, prefix));
2451		if (err < 0) {
2452			dev_err(dev, "ASoC: Failed to add %s: %d\n",
2453				control->name, err);
2454			return err;
2455		}
2456	}
2457
2458	return 0;
2459}
2460
2461struct snd_kcontrol *snd_soc_card_get_kcontrol(struct snd_soc_card *soc_card,
2462					       const char *name)
2463{
2464	struct snd_card *card = soc_card->snd_card;
2465	struct snd_kcontrol *kctl;
2466
2467	if (unlikely(!name))
2468		return NULL;
2469
2470	list_for_each_entry(kctl, &card->controls, list)
2471		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name)))
2472			return kctl;
2473	return NULL;
2474}
2475EXPORT_SYMBOL_GPL(snd_soc_card_get_kcontrol);
2476
2477/**
2478 * snd_soc_add_codec_controls - add an array of controls to a codec.
2479 * Convenience function to add a list of controls. Many codecs were
2480 * duplicating this code.
2481 *
2482 * @codec: codec 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_codec_controls(struct snd_soc_codec *codec,
2489	const struct snd_kcontrol_new *controls, int num_controls)
2490{
2491	struct snd_card *card = codec->card->snd_card;
2492
2493	return snd_soc_add_controls(card, codec->dev, controls, num_controls,
2494			codec->name_prefix, codec);
2495}
2496EXPORT_SYMBOL_GPL(snd_soc_add_codec_controls);
2497
2498/**
2499 * snd_soc_add_platform_controls - add an array of controls to a platform.
2500 * Convenience function to add a list of controls.
2501 *
2502 * @platform: platform to add controls to
2503 * @controls: array of controls to add
2504 * @num_controls: number of elements in the array
2505 *
2506 * Return 0 for success, else error.
2507 */
2508int snd_soc_add_platform_controls(struct snd_soc_platform *platform,
2509	const struct snd_kcontrol_new *controls, int num_controls)
2510{
2511	struct snd_card *card = platform->card->snd_card;
2512
2513	return snd_soc_add_controls(card, platform->dev, controls, num_controls,
2514			NULL, platform);
2515}
2516EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls);
2517
2518/**
2519 * snd_soc_add_card_controls - add an array of controls to a SoC card.
2520 * Convenience function to add a list of controls.
2521 *
2522 * @soc_card: SoC card to add controls to
2523 * @controls: array of controls to add
2524 * @num_controls: number of elements in the array
2525 *
2526 * Return 0 for success, else error.
2527 */
2528int snd_soc_add_card_controls(struct snd_soc_card *soc_card,
2529	const struct snd_kcontrol_new *controls, int num_controls)
2530{
2531	struct snd_card *card = soc_card->snd_card;
2532
2533	return snd_soc_add_controls(card, soc_card->dev, controls, num_controls,
2534			NULL, soc_card);
2535}
2536EXPORT_SYMBOL_GPL(snd_soc_add_card_controls);
2537
2538/**
2539 * snd_soc_add_dai_controls - add an array of controls to a DAI.
2540 * Convienience function to add a list of controls.
2541 *
2542 * @dai: DAI to add controls to
2543 * @controls: array of controls to add
2544 * @num_controls: number of elements in the array
2545 *
2546 * Return 0 for success, else error.
2547 */
2548int snd_soc_add_dai_controls(struct snd_soc_dai *dai,
2549	const struct snd_kcontrol_new *controls, int num_controls)
2550{
2551	struct snd_card *card = dai->card->snd_card;
2552
2553	return snd_soc_add_controls(card, dai->dev, controls, num_controls,
2554			NULL, dai);
2555}
2556EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls);
2557
2558/**
2559 * snd_soc_info_enum_double - enumerated double mixer info callback
2560 * @kcontrol: mixer control
2561 * @uinfo: control element information
2562 *
2563 * Callback to provide information about a double enumerated
2564 * mixer control.
2565 *
2566 * Returns 0 for success.
2567 */
2568int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2569	struct snd_ctl_elem_info *uinfo)
2570{
2571	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2572
2573	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2574	uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
2575	uinfo->value.enumerated.items = e->items;
2576
2577	if (uinfo->value.enumerated.item >= e->items)
2578		uinfo->value.enumerated.item = e->items - 1;
2579	strlcpy(uinfo->value.enumerated.name,
2580		e->texts[uinfo->value.enumerated.item],
2581		sizeof(uinfo->value.enumerated.name));
2582	return 0;
2583}
2584EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2585
2586/**
2587 * snd_soc_get_enum_double - enumerated double mixer get callback
2588 * @kcontrol: mixer control
2589 * @ucontrol: control element information
2590 *
2591 * Callback to get the value of a double enumerated mixer.
2592 *
2593 * Returns 0 for success.
2594 */
2595int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2596	struct snd_ctl_elem_value *ucontrol)
2597{
2598	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2599	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2600	unsigned int val, item;
2601	unsigned int reg_val;
2602
2603	reg_val = snd_soc_read(codec, e->reg);
2604	val = (reg_val >> e->shift_l) & e->mask;
2605	item = snd_soc_enum_val_to_item(e, val);
2606	ucontrol->value.enumerated.item[0] = item;
2607	if (e->shift_l != e->shift_r) {
2608		val = (reg_val >> e->shift_l) & e->mask;
2609		item = snd_soc_enum_val_to_item(e, val);
2610		ucontrol->value.enumerated.item[1] = item;
2611	}
2612
2613	return 0;
2614}
2615EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2616
2617/**
2618 * snd_soc_put_enum_double - enumerated double mixer put callback
2619 * @kcontrol: mixer control
2620 * @ucontrol: control element information
2621 *
2622 * Callback to set the value of a double enumerated mixer.
2623 *
2624 * Returns 0 for success.
2625 */
2626int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2627	struct snd_ctl_elem_value *ucontrol)
2628{
2629	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2630	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2631	unsigned int *item = ucontrol->value.enumerated.item;
2632	unsigned int val;
2633	unsigned int mask;
2634
2635	if (item[0] >= e->items)
2636		return -EINVAL;
2637	val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
2638	mask = e->mask << e->shift_l;
2639	if (e->shift_l != e->shift_r) {
2640		if (item[1] >= e->items)
2641			return -EINVAL;
2642		val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r;
2643		mask |= e->mask << e->shift_r;
2644	}
2645
2646	return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2647}
2648EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2649
2650/**
2651 * snd_soc_read_signed - Read a codec register and interprete as signed value
2652 * @codec: codec
2653 * @reg: Register to read
2654 * @mask: Mask to use after shifting the register value
2655 * @shift: Right shift of register value
2656 * @sign_bit: Bit that describes if a number is negative or not.
2657 *
2658 * This functions reads a codec register. The register value is shifted right
2659 * by 'shift' bits and masked with the given 'mask'. Afterwards it translates
2660 * the given registervalue into a signed integer if sign_bit is non-zero.
2661 *
2662 * Returns the register value as signed int.
2663 */
2664static int snd_soc_read_signed(struct snd_soc_codec *codec, unsigned int reg,
2665		unsigned int mask, unsigned int shift, unsigned int sign_bit)
2666{
 
2667	int ret;
2668	unsigned int val;
2669
2670	val = (snd_soc_read(codec, reg) >> shift) & mask;
2671
2672	if (!sign_bit)
2673		return val;
2674
2675	/* non-negative number */
2676	if (!(val & BIT(sign_bit)))
2677		return val;
2678
2679	ret = val;
2680
2681	/*
2682	 * The register most probably does not contain a full-sized int.
2683	 * Instead we have an arbitrary number of bits in a signed
2684	 * representation which has to be translated into a full-sized int.
2685	 * This is done by filling up all bits above the sign-bit.
2686	 */
2687	ret |= ~((int)(BIT(sign_bit) - 1));
2688
2689	return ret;
2690}
2691
2692/**
2693 * snd_soc_info_volsw - single mixer info callback
2694 * @kcontrol: mixer control
2695 * @uinfo: control element information
2696 *
2697 * Callback to provide information about a single mixer control, or a double
2698 * mixer control that spans 2 registers.
2699 *
2700 * Returns 0 for success.
2701 */
2702int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2703	struct snd_ctl_elem_info *uinfo)
2704{
2705	struct soc_mixer_control *mc =
2706		(struct soc_mixer_control *)kcontrol->private_value;
2707	int platform_max;
2708
2709	if (!mc->platform_max)
2710		mc->platform_max = mc->max;
2711	platform_max = mc->platform_max;
2712
2713	if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
2714		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2715	else
2716		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2717
2718	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
2719	uinfo->value.integer.min = 0;
2720	uinfo->value.integer.max = platform_max - mc->min;
2721	return 0;
2722}
2723EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2724
2725/**
2726 * snd_soc_get_volsw - single mixer get callback
2727 * @kcontrol: mixer control
2728 * @ucontrol: control element information
2729 *
2730 * Callback to get the value of a single mixer control, or a double mixer
2731 * control that spans 2 registers.
2732 *
2733 * Returns 0 for success.
2734 */
2735int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2736	struct snd_ctl_elem_value *ucontrol)
2737{
2738	struct soc_mixer_control *mc =
2739		(struct soc_mixer_control *)kcontrol->private_value;
2740	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2741	unsigned int reg = mc->reg;
2742	unsigned int reg2 = mc->rreg;
2743	unsigned int shift = mc->shift;
2744	unsigned int rshift = mc->rshift;
2745	int max = mc->max;
2746	int min = mc->min;
2747	int sign_bit = mc->sign_bit;
2748	unsigned int mask = (1 << fls(max)) - 1;
2749	unsigned int invert = mc->invert;
2750
2751	if (sign_bit)
2752		mask = BIT(sign_bit + 1) - 1;
2753
2754	ucontrol->value.integer.value[0] = snd_soc_read_signed(codec, reg, mask,
2755			shift, sign_bit) - min;
2756	if (invert)
2757		ucontrol->value.integer.value[0] =
2758			max - ucontrol->value.integer.value[0];
2759
2760	if (snd_soc_volsw_is_stereo(mc)) {
2761		if (reg == reg2)
2762			ucontrol->value.integer.value[1] =
2763				snd_soc_read_signed(codec, reg, mask, rshift,
2764						sign_bit) - min;
2765		else
2766			ucontrol->value.integer.value[1] =
2767				snd_soc_read_signed(codec, reg2, mask, shift,
2768						sign_bit) - min;
2769		if (invert)
2770			ucontrol->value.integer.value[1] =
2771				max - ucontrol->value.integer.value[1];
2772	}
2773
2774	return 0;
2775}
2776EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2777
2778/**
2779 * snd_soc_put_volsw - single mixer put callback
2780 * @kcontrol: mixer control
2781 * @ucontrol: control element information
2782 *
2783 * Callback to set the value of a single mixer control, or a double mixer
2784 * control that spans 2 registers.
2785 *
2786 * Returns 0 for success.
2787 */
2788int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2789	struct snd_ctl_elem_value *ucontrol)
2790{
2791	struct soc_mixer_control *mc =
2792		(struct soc_mixer_control *)kcontrol->private_value;
2793	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2794	unsigned int reg = mc->reg;
2795	unsigned int reg2 = mc->rreg;
2796	unsigned int shift = mc->shift;
2797	unsigned int rshift = mc->rshift;
2798	int max = mc->max;
2799	int min = mc->min;
2800	unsigned int sign_bit = mc->sign_bit;
2801	unsigned int mask = (1 << fls(max)) - 1;
2802	unsigned int invert = mc->invert;
2803	int err;
2804	bool type_2r = false;
2805	unsigned int val2 = 0;
2806	unsigned int val, val_mask;
2807
2808	if (sign_bit)
2809		mask = BIT(sign_bit + 1) - 1;
2810
2811	val = ((ucontrol->value.integer.value[0] + min) & mask);
2812	if (invert)
2813		val = max - val;
2814	val_mask = mask << shift;
2815	val = val << shift;
2816	if (snd_soc_volsw_is_stereo(mc)) {
2817		val2 = ((ucontrol->value.integer.value[1] + min) & mask);
2818		if (invert)
2819			val2 = max - val2;
2820		if (reg == reg2) {
2821			val_mask |= mask << rshift;
2822			val |= val2 << rshift;
2823		} else {
2824			val2 = val2 << shift;
2825			type_2r = true;
2826		}
2827	}
2828	err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
2829	if (err < 0)
2830		return err;
2831
2832	if (type_2r)
2833		err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
2834
2835	return err;
2836}
2837EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2838
2839/**
2840 * snd_soc_get_volsw_sx - single mixer get callback
2841 * @kcontrol: mixer control
2842 * @ucontrol: control element information
2843 *
2844 * Callback to get the value of a single mixer control, or a double mixer
2845 * control that spans 2 registers.
2846 *
2847 * Returns 0 for success.
2848 */
2849int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol,
2850		      struct snd_ctl_elem_value *ucontrol)
2851{
2852	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2853	struct soc_mixer_control *mc =
2854	    (struct soc_mixer_control *)kcontrol->private_value;
2855
2856	unsigned int reg = mc->reg;
2857	unsigned int reg2 = mc->rreg;
2858	unsigned int shift = mc->shift;
2859	unsigned int rshift = mc->rshift;
2860	int max = mc->max;
2861	int min = mc->min;
2862	int mask = (1 << (fls(min + max) - 1)) - 1;
2863
2864	ucontrol->value.integer.value[0] =
2865	    ((snd_soc_read(codec, reg) >> shift) - min) & mask;
2866
2867	if (snd_soc_volsw_is_stereo(mc))
2868		ucontrol->value.integer.value[1] =
2869			((snd_soc_read(codec, reg2) >> rshift) - min) & mask;
2870
2871	return 0;
2872}
2873EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx);
2874
2875/**
2876 * snd_soc_put_volsw_sx - double mixer set callback
2877 * @kcontrol: mixer control
2878 * @uinfo: control element information
2879 *
2880 * Callback to set the value of a double mixer control that spans 2 registers.
2881 *
2882 * Returns 0 for success.
2883 */
2884int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol,
2885			 struct snd_ctl_elem_value *ucontrol)
2886{
2887	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2888	struct soc_mixer_control *mc =
2889	    (struct soc_mixer_control *)kcontrol->private_value;
2890
2891	unsigned int reg = mc->reg;
2892	unsigned int reg2 = mc->rreg;
2893	unsigned int shift = mc->shift;
2894	unsigned int rshift = mc->rshift;
2895	int max = mc->max;
2896	int min = mc->min;
2897	int mask = (1 << (fls(min + max) - 1)) - 1;
2898	int err = 0;
2899	unsigned short val, val_mask, val2 = 0;
2900
2901	val_mask = mask << shift;
2902	val = (ucontrol->value.integer.value[0] + min) & mask;
2903	val = val << shift;
2904
2905	err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
2906	if (err < 0)
2907		return err;
2908
2909	if (snd_soc_volsw_is_stereo(mc)) {
2910		val_mask = mask << rshift;
2911		val2 = (ucontrol->value.integer.value[1] + min) & mask;
2912		val2 = val2 << rshift;
2913
2914		if (snd_soc_update_bits_locked(codec, reg2, val_mask, val2))
2915			return err;
2916	}
2917	return 0;
2918}
2919EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx);
2920
2921/**
2922 * snd_soc_info_volsw_s8 - signed mixer info callback
2923 * @kcontrol: mixer control
2924 * @uinfo: control element information
2925 *
2926 * Callback to provide information about a signed mixer control.
2927 *
2928 * Returns 0 for success.
2929 */
2930int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2931	struct snd_ctl_elem_info *uinfo)
2932{
2933	struct soc_mixer_control *mc =
2934		(struct soc_mixer_control *)kcontrol->private_value;
2935	int platform_max;
2936	int min = mc->min;
2937
2938	if (!mc->platform_max)
2939		mc->platform_max = mc->max;
2940	platform_max = mc->platform_max;
2941
2942	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2943	uinfo->count = 2;
2944	uinfo->value.integer.min = 0;
2945	uinfo->value.integer.max = platform_max - min;
2946	return 0;
2947}
2948EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2949
2950/**
2951 * snd_soc_get_volsw_s8 - signed mixer get callback
2952 * @kcontrol: mixer control
2953 * @ucontrol: control element information
2954 *
2955 * Callback to get the value of a signed mixer control.
2956 *
2957 * Returns 0 for success.
2958 */
2959int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2960	struct snd_ctl_elem_value *ucontrol)
2961{
2962	struct soc_mixer_control *mc =
2963		(struct soc_mixer_control *)kcontrol->private_value;
2964	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2965	unsigned int reg = mc->reg;
2966	int min = mc->min;
2967	int val = snd_soc_read(codec, reg);
2968
2969	ucontrol->value.integer.value[0] =
2970		((signed char)(val & 0xff))-min;
2971	ucontrol->value.integer.value[1] =
2972		((signed char)((val >> 8) & 0xff))-min;
2973	return 0;
2974}
2975EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2976
2977/**
2978 * snd_soc_put_volsw_sgn - signed mixer put callback
2979 * @kcontrol: mixer control
2980 * @ucontrol: control element information
2981 *
2982 * Callback to set the value of a signed mixer control.
2983 *
2984 * Returns 0 for success.
2985 */
2986int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2987	struct snd_ctl_elem_value *ucontrol)
2988{
2989	struct soc_mixer_control *mc =
2990		(struct soc_mixer_control *)kcontrol->private_value;
2991	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2992	unsigned int reg = mc->reg;
2993	int min = mc->min;
2994	unsigned int val;
2995
2996	val = (ucontrol->value.integer.value[0]+min) & 0xff;
2997	val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
2998
2999	return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
3000}
3001EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
3002
3003/**
3004 * snd_soc_info_volsw_range - single mixer info callback with range.
3005 * @kcontrol: mixer control
3006 * @uinfo: control element information
3007 *
3008 * Callback to provide information, within a range, about a single
3009 * mixer control.
3010 *
3011 * returns 0 for success.
3012 */
3013int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol,
3014	struct snd_ctl_elem_info *uinfo)
3015{
3016	struct soc_mixer_control *mc =
3017		(struct soc_mixer_control *)kcontrol->private_value;
3018	int platform_max;
3019	int min = mc->min;
3020
3021	if (!mc->platform_max)
3022		mc->platform_max = mc->max;
3023	platform_max = mc->platform_max;
3024
3025	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
3026	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
3027	uinfo->value.integer.min = 0;
3028	uinfo->value.integer.max = platform_max - min;
3029
3030	return 0;
3031}
3032EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range);
3033
3034/**
3035 * snd_soc_put_volsw_range - single mixer put value callback with range.
3036 * @kcontrol: mixer control
3037 * @ucontrol: control element information
3038 *
3039 * Callback to set the value, within a range, for a single mixer control.
3040 *
3041 * Returns 0 for success.
3042 */
3043int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol,
3044	struct snd_ctl_elem_value *ucontrol)
3045{
3046	struct soc_mixer_control *mc =
3047		(struct soc_mixer_control *)kcontrol->private_value;
3048	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3049	unsigned int reg = mc->reg;
3050	unsigned int rreg = mc->rreg;
3051	unsigned int shift = mc->shift;
3052	int min = mc->min;
3053	int max = mc->max;
3054	unsigned int mask = (1 << fls(max)) - 1;
3055	unsigned int invert = mc->invert;
3056	unsigned int val, val_mask;
3057	int ret;
3058
3059	val = ((ucontrol->value.integer.value[0] + min) & mask);
3060	if (invert)
3061		val = max - val;
3062	val_mask = mask << shift;
3063	val = val << shift;
3064
3065	ret = snd_soc_update_bits_locked(codec, reg, val_mask, val);
3066	if (ret < 0)
3067		return ret;
3068
3069	if (snd_soc_volsw_is_stereo(mc)) {
3070		val = ((ucontrol->value.integer.value[1] + min) & mask);
3071		if (invert)
3072			val = max - val;
3073		val_mask = mask << shift;
3074		val = val << shift;
3075
3076		ret = snd_soc_update_bits_locked(codec, rreg, val_mask, val);
3077	}
3078
3079	return ret;
3080}
3081EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range);
3082
3083/**
3084 * snd_soc_get_volsw_range - single mixer get callback with range
3085 * @kcontrol: mixer control
3086 * @ucontrol: control element information
3087 *
3088 * Callback to get the value, within a range, of a single mixer control.
3089 *
3090 * Returns 0 for success.
3091 */
3092int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol,
3093	struct snd_ctl_elem_value *ucontrol)
3094{
3095	struct soc_mixer_control *mc =
3096		(struct soc_mixer_control *)kcontrol->private_value;
3097	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3098	unsigned int reg = mc->reg;
3099	unsigned int rreg = mc->rreg;
3100	unsigned int shift = mc->shift;
3101	int min = mc->min;
3102	int max = mc->max;
3103	unsigned int mask = (1 << fls(max)) - 1;
3104	unsigned int invert = mc->invert;
3105
3106	ucontrol->value.integer.value[0] =
3107		(snd_soc_read(codec, reg) >> shift) & mask;
3108	if (invert)
3109		ucontrol->value.integer.value[0] =
3110			max - ucontrol->value.integer.value[0];
3111	ucontrol->value.integer.value[0] =
3112		ucontrol->value.integer.value[0] - min;
3113
3114	if (snd_soc_volsw_is_stereo(mc)) {
3115		ucontrol->value.integer.value[1] =
3116			(snd_soc_read(codec, rreg) >> shift) & mask;
3117		if (invert)
3118			ucontrol->value.integer.value[1] =
3119				max - ucontrol->value.integer.value[1];
3120		ucontrol->value.integer.value[1] =
3121			ucontrol->value.integer.value[1] - min;
3122	}
3123
3124	return 0;
3125}
3126EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range);
3127
3128/**
3129 * snd_soc_limit_volume - Set new limit to an existing volume control.
3130 *
3131 * @codec: where to look for the control
3132 * @name: Name of the control
3133 * @max: new maximum limit
3134 *
3135 * Return 0 for success, else error.
3136 */
3137int snd_soc_limit_volume(struct snd_soc_codec *codec,
3138	const char *name, int max)
3139{
3140	struct snd_card *card = codec->card->snd_card;
3141	struct snd_kcontrol *kctl;
3142	struct soc_mixer_control *mc;
3143	int found = 0;
3144	int ret = -EINVAL;
3145
3146	/* Sanity check for name and max */
3147	if (unlikely(!name || max <= 0))
3148		return -EINVAL;
3149
3150	list_for_each_entry(kctl, &card->controls, list) {
3151		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
3152			found = 1;
3153			break;
3154		}
3155	}
3156	if (found) {
3157		mc = (struct soc_mixer_control *)kctl->private_value;
3158		if (max <= mc->max) {
3159			mc->platform_max = max;
3160			ret = 0;
3161		}
3162	}
3163	return ret;
3164}
3165EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
3166
3167int snd_soc_bytes_info(struct snd_kcontrol *kcontrol,
3168		       struct snd_ctl_elem_info *uinfo)
3169{
3170	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3171	struct soc_bytes *params = (void *)kcontrol->private_value;
3172
3173	uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
3174	uinfo->count = params->num_regs * codec->val_bytes;
3175
3176	return 0;
3177}
3178EXPORT_SYMBOL_GPL(snd_soc_bytes_info);
3179
3180int snd_soc_bytes_get(struct snd_kcontrol *kcontrol,
3181		      struct snd_ctl_elem_value *ucontrol)
3182{
3183	struct soc_bytes *params = (void *)kcontrol->private_value;
3184	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3185	int ret;
3186
3187	if (codec->using_regmap)
3188		ret = regmap_raw_read(codec->control_data, params->base,
3189				      ucontrol->value.bytes.data,
3190				      params->num_regs * codec->val_bytes);
3191	else
3192		ret = -EINVAL;
3193
3194	/* Hide any masked bytes to ensure consistent data reporting */
3195	if (ret == 0 && params->mask) {
3196		switch (codec->val_bytes) {
3197		case 1:
3198			ucontrol->value.bytes.data[0] &= ~params->mask;
3199			break;
3200		case 2:
3201			((u16 *)(&ucontrol->value.bytes.data))[0]
3202				&= cpu_to_be16(~params->mask);
3203			break;
3204		case 4:
3205			((u32 *)(&ucontrol->value.bytes.data))[0]
3206				&= cpu_to_be32(~params->mask);
3207			break;
3208		default:
3209			return -EINVAL;
3210		}
3211	}
3212
3213	return ret;
3214}
3215EXPORT_SYMBOL_GPL(snd_soc_bytes_get);
3216
3217int snd_soc_bytes_put(struct snd_kcontrol *kcontrol,
3218		      struct snd_ctl_elem_value *ucontrol)
3219{
3220	struct soc_bytes *params = (void *)kcontrol->private_value;
3221	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3222	int ret, len;
3223	unsigned int val, mask;
3224	void *data;
3225
3226	if (!codec->using_regmap)
3227		return -EINVAL;
3228
3229	len = params->num_regs * codec->val_bytes;
3230
3231	data = kmemdup(ucontrol->value.bytes.data, len, GFP_KERNEL | GFP_DMA);
3232	if (!data)
3233		return -ENOMEM;
3234
3235	/*
3236	 * If we've got a mask then we need to preserve the register
3237	 * bits.  We shouldn't modify the incoming data so take a
3238	 * copy.
3239	 */
3240	if (params->mask) {
3241		ret = regmap_read(codec->control_data, params->base, &val);
3242		if (ret != 0)
3243			goto out;
3244
3245		val &= params->mask;
3246
3247		switch (codec->val_bytes) {
3248		case 1:
3249			((u8 *)data)[0] &= ~params->mask;
3250			((u8 *)data)[0] |= val;
3251			break;
3252		case 2:
3253			mask = ~params->mask;
3254			ret = regmap_parse_val(codec->control_data,
3255							&mask, &mask);
3256			if (ret != 0)
3257				goto out;
3258
3259			((u16 *)data)[0] &= mask;
3260
3261			ret = regmap_parse_val(codec->control_data,
3262							&val, &val);
3263			if (ret != 0)
3264				goto out;
3265
3266			((u16 *)data)[0] |= val;
3267			break;
3268		case 4:
3269			mask = ~params->mask;
3270			ret = regmap_parse_val(codec->control_data,
3271							&mask, &mask);
3272			if (ret != 0)
3273				goto out;
3274
3275			((u32 *)data)[0] &= mask;
3276
3277			ret = regmap_parse_val(codec->control_data,
3278							&val, &val);
3279			if (ret != 0)
3280				goto out;
3281
3282			((u32 *)data)[0] |= val;
3283			break;
3284		default:
3285			ret = -EINVAL;
3286			goto out;
3287		}
3288	}
3289
3290	ret = regmap_raw_write(codec->control_data, params->base,
3291			       data, len);
3292
3293out:
3294	kfree(data);
3295
3296	return ret;
3297}
3298EXPORT_SYMBOL_GPL(snd_soc_bytes_put);
3299
3300/**
3301 * snd_soc_info_xr_sx - signed multi register info callback
3302 * @kcontrol: mreg control
3303 * @uinfo: control element information
3304 *
3305 * Callback to provide information of a control that can
3306 * span multiple codec registers which together
3307 * forms a single signed value in a MSB/LSB manner.
3308 *
3309 * Returns 0 for success.
3310 */
3311int snd_soc_info_xr_sx(struct snd_kcontrol *kcontrol,
3312	struct snd_ctl_elem_info *uinfo)
3313{
3314	struct soc_mreg_control *mc =
3315		(struct soc_mreg_control *)kcontrol->private_value;
3316	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
3317	uinfo->count = 1;
3318	uinfo->value.integer.min = mc->min;
3319	uinfo->value.integer.max = mc->max;
3320
3321	return 0;
3322}
3323EXPORT_SYMBOL_GPL(snd_soc_info_xr_sx);
3324
3325/**
3326 * snd_soc_get_xr_sx - signed multi register get callback
3327 * @kcontrol: mreg control
3328 * @ucontrol: control element information
3329 *
3330 * Callback to get the value of a control that can span
3331 * multiple codec registers which together forms a single
3332 * signed value in a MSB/LSB manner. The control supports
3333 * specifying total no of bits used to allow for bitfields
3334 * across the multiple codec registers.
3335 *
3336 * Returns 0 for success.
3337 */
3338int snd_soc_get_xr_sx(struct snd_kcontrol *kcontrol,
3339	struct snd_ctl_elem_value *ucontrol)
3340{
3341	struct soc_mreg_control *mc =
3342		(struct soc_mreg_control *)kcontrol->private_value;
3343	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3344	unsigned int regbase = mc->regbase;
3345	unsigned int regcount = mc->regcount;
3346	unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE;
3347	unsigned int regwmask = (1<<regwshift)-1;
3348	unsigned int invert = mc->invert;
3349	unsigned long mask = (1UL<<mc->nbits)-1;
3350	long min = mc->min;
3351	long max = mc->max;
3352	long val = 0;
3353	unsigned long regval;
3354	unsigned int i;
3355
3356	for (i = 0; i < regcount; i++) {
3357		regval = snd_soc_read(codec, regbase+i) & regwmask;
3358		val |= regval << (regwshift*(regcount-i-1));
3359	}
3360	val &= mask;
3361	if (min < 0 && val > max)
3362		val |= ~mask;
3363	if (invert)
3364		val = max - val;
3365	ucontrol->value.integer.value[0] = val;
3366
3367	return 0;
3368}
3369EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx);
3370
3371/**
3372 * snd_soc_put_xr_sx - signed multi register get callback
3373 * @kcontrol: mreg control
3374 * @ucontrol: control element information
3375 *
3376 * Callback to set the value of a control that can span
3377 * multiple codec registers which together forms a single
3378 * signed value in a MSB/LSB manner. The control supports
3379 * specifying total no of bits used to allow for bitfields
3380 * across the multiple codec registers.
3381 *
3382 * Returns 0 for success.
3383 */
3384int snd_soc_put_xr_sx(struct snd_kcontrol *kcontrol,
3385	struct snd_ctl_elem_value *ucontrol)
3386{
3387	struct soc_mreg_control *mc =
3388		(struct soc_mreg_control *)kcontrol->private_value;
3389	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3390	unsigned int regbase = mc->regbase;
3391	unsigned int regcount = mc->regcount;
3392	unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE;
3393	unsigned int regwmask = (1<<regwshift)-1;
3394	unsigned int invert = mc->invert;
3395	unsigned long mask = (1UL<<mc->nbits)-1;
3396	long max = mc->max;
3397	long val = ucontrol->value.integer.value[0];
3398	unsigned int i, regval, regmask;
3399	int err;
3400
3401	if (invert)
3402		val = max - val;
3403	val &= mask;
3404	for (i = 0; i < regcount; i++) {
3405		regval = (val >> (regwshift*(regcount-i-1))) & regwmask;
3406		regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask;
3407		err = snd_soc_update_bits_locked(codec, regbase+i,
3408				regmask, regval);
3409		if (err < 0)
3410			return err;
3411	}
3412
3413	return 0;
3414}
3415EXPORT_SYMBOL_GPL(snd_soc_put_xr_sx);
3416
3417/**
3418 * snd_soc_get_strobe - strobe get callback
3419 * @kcontrol: mixer control
3420 * @ucontrol: control element information
3421 *
3422 * Callback get the value of a strobe mixer control.
3423 *
3424 * Returns 0 for success.
3425 */
3426int snd_soc_get_strobe(struct snd_kcontrol *kcontrol,
3427	struct snd_ctl_elem_value *ucontrol)
3428{
3429	struct soc_mixer_control *mc =
3430		(struct soc_mixer_control *)kcontrol->private_value;
3431	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3432	unsigned int reg = mc->reg;
3433	unsigned int shift = mc->shift;
3434	unsigned int mask = 1 << shift;
3435	unsigned int invert = mc->invert != 0;
3436	unsigned int val = snd_soc_read(codec, reg) & mask;
3437
3438	if (shift != 0 && val != 0)
3439		val = val >> shift;
3440	ucontrol->value.enumerated.item[0] = val ^ invert;
3441
3442	return 0;
3443}
3444EXPORT_SYMBOL_GPL(snd_soc_get_strobe);
3445
3446/**
3447 * snd_soc_put_strobe - strobe put callback
3448 * @kcontrol: mixer control
3449 * @ucontrol: control element information
3450 *
3451 * Callback strobe a register bit to high then low (or the inverse)
3452 * in one pass of a single mixer enum control.
3453 *
3454 * Returns 1 for success.
3455 */
3456int snd_soc_put_strobe(struct snd_kcontrol *kcontrol,
3457	struct snd_ctl_elem_value *ucontrol)
3458{
3459	struct soc_mixer_control *mc =
3460		(struct soc_mixer_control *)kcontrol->private_value;
3461	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3462	unsigned int reg = mc->reg;
3463	unsigned int shift = mc->shift;
3464	unsigned int mask = 1 << shift;
3465	unsigned int invert = mc->invert != 0;
3466	unsigned int strobe = ucontrol->value.enumerated.item[0] != 0;
3467	unsigned int val1 = (strobe ^ invert) ? mask : 0;
3468	unsigned int val2 = (strobe ^ invert) ? 0 : mask;
3469	int err;
3470
3471	err = snd_soc_update_bits_locked(codec, reg, mask, val1);
3472	if (err < 0)
3473		return err;
3474
3475	err = snd_soc_update_bits_locked(codec, reg, mask, val2);
3476	return err;
3477}
3478EXPORT_SYMBOL_GPL(snd_soc_put_strobe);
3479
3480/**
3481 * snd_soc_dai_set_sysclk - configure DAI system or master clock.
3482 * @dai: DAI
3483 * @clk_id: DAI specific clock ID
3484 * @freq: new clock frequency in Hz
3485 * @dir: new clock direction - input/output.
3486 *
3487 * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
3488 */
3489int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
3490	unsigned int freq, int dir)
3491{
3492	if (dai->driver && dai->driver->ops->set_sysclk)
3493		return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
3494	else if (dai->codec && dai->codec->driver->set_sysclk)
3495		return dai->codec->driver->set_sysclk(dai->codec, clk_id, 0,
3496						      freq, dir);
3497	else
3498		return -ENOTSUPP;
3499}
3500EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
3501
3502/**
3503 * snd_soc_codec_set_sysclk - configure CODEC system or master clock.
3504 * @codec: CODEC
3505 * @clk_id: DAI specific clock ID
3506 * @source: Source for the clock
3507 * @freq: new clock frequency in Hz
3508 * @dir: new clock direction - input/output.
3509 *
3510 * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
3511 */
3512int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id,
3513			     int source, unsigned int freq, int dir)
3514{
3515	if (codec->driver->set_sysclk)
3516		return codec->driver->set_sysclk(codec, clk_id, source,
3517						 freq, dir);
3518	else
3519		return -ENOTSUPP;
3520}
3521EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk);
3522
3523/**
3524 * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
3525 * @dai: DAI
3526 * @div_id: DAI specific clock divider ID
3527 * @div: new clock divisor.
3528 *
3529 * Configures the clock dividers. This is used to derive the best DAI bit and
3530 * frame clocks from the system or master clock. It's best to set the DAI bit
3531 * and frame clocks as low as possible to save system power.
3532 */
3533int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
3534	int div_id, int div)
3535{
3536	if (dai->driver && dai->driver->ops->set_clkdiv)
3537		return dai->driver->ops->set_clkdiv(dai, div_id, div);
3538	else
3539		return -EINVAL;
3540}
3541EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
3542
3543/**
3544 * snd_soc_dai_set_pll - configure DAI PLL.
3545 * @dai: DAI
3546 * @pll_id: DAI specific PLL ID
3547 * @source: DAI specific source for the PLL
3548 * @freq_in: PLL input clock frequency in Hz
3549 * @freq_out: requested PLL output clock frequency in Hz
3550 *
3551 * Configures and enables PLL to generate output clock based on input clock.
3552 */
3553int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
3554	unsigned int freq_in, unsigned int freq_out)
3555{
3556	if (dai->driver && dai->driver->ops->set_pll)
3557		return dai->driver->ops->set_pll(dai, pll_id, source,
3558					 freq_in, freq_out);
3559	else if (dai->codec && dai->codec->driver->set_pll)
3560		return dai->codec->driver->set_pll(dai->codec, pll_id, source,
3561						   freq_in, freq_out);
3562	else
3563		return -EINVAL;
3564}
3565EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
3566
3567/*
3568 * snd_soc_codec_set_pll - configure codec PLL.
3569 * @codec: CODEC
3570 * @pll_id: DAI specific PLL ID
3571 * @source: DAI specific source for the PLL
3572 * @freq_in: PLL input clock frequency in Hz
3573 * @freq_out: requested PLL output clock frequency in Hz
3574 *
3575 * Configures and enables PLL to generate output clock based on input clock.
3576 */
3577int snd_soc_codec_set_pll(struct snd_soc_codec *codec, int pll_id, int source,
3578			  unsigned int freq_in, unsigned int freq_out)
3579{
3580	if (codec->driver->set_pll)
3581		return codec->driver->set_pll(codec, pll_id, source,
3582					      freq_in, freq_out);
3583	else
3584		return -EINVAL;
3585}
3586EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll);
3587
3588/**
3589 * snd_soc_dai_set_bclk_ratio - configure BCLK to sample rate ratio.
3590 * @dai: DAI
3591 * @ratio Ratio of BCLK to Sample rate.
3592 *
3593 * Configures the DAI for a preset BCLK to sample rate ratio.
3594 */
3595int snd_soc_dai_set_bclk_ratio(struct snd_soc_dai *dai, unsigned int ratio)
3596{
3597	if (dai->driver && dai->driver->ops->set_bclk_ratio)
3598		return dai->driver->ops->set_bclk_ratio(dai, ratio);
3599	else
3600		return -EINVAL;
3601}
3602EXPORT_SYMBOL_GPL(snd_soc_dai_set_bclk_ratio);
3603
3604/**
3605 * snd_soc_dai_set_fmt - configure DAI hardware audio format.
3606 * @dai: DAI
3607 * @fmt: SND_SOC_DAIFMT_ format value.
3608 *
3609 * Configures the DAI hardware format and clocking.
3610 */
3611int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
3612{
3613	if (dai->driver == NULL)
3614		return -EINVAL;
3615	if (dai->driver->ops->set_fmt == NULL)
3616		return -ENOTSUPP;
3617	return dai->driver->ops->set_fmt(dai, fmt);
3618}
3619EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
3620
3621/**
3622 * snd_soc_xlate_tdm_slot - generate tx/rx slot mask.
3623 * @slots: Number of slots in use.
3624 * @tx_mask: bitmask representing active TX slots.
3625 * @rx_mask: bitmask representing active RX slots.
3626 *
3627 * Generates the TDM tx and rx slot default masks for DAI.
3628 */
3629static int snd_soc_xlate_tdm_slot_mask(unsigned int slots,
3630					  unsigned int *tx_mask,
3631					  unsigned int *rx_mask)
3632{
3633	if (*tx_mask || *rx_mask)
3634		return 0;
3635
3636	if (!slots)
3637		return -EINVAL;
3638
3639	*tx_mask = (1 << slots) - 1;
3640	*rx_mask = (1 << slots) - 1;
3641
3642	return 0;
3643}
3644
3645/**
3646 * snd_soc_dai_set_tdm_slot - configure DAI TDM.
3647 * @dai: DAI
3648 * @tx_mask: bitmask representing active TX slots.
3649 * @rx_mask: bitmask representing active RX slots.
3650 * @slots: Number of slots in use.
3651 * @slot_width: Width in bits for each slot.
3652 *
3653 * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
3654 * specific.
3655 */
3656int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
3657	unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
3658{
3659	if (dai->driver && dai->driver->ops->xlate_tdm_slot_mask)
3660		dai->driver->ops->xlate_tdm_slot_mask(slots,
3661						&tx_mask, &rx_mask);
3662	else
3663		snd_soc_xlate_tdm_slot_mask(slots, &tx_mask, &rx_mask);
3664
3665	if (dai->driver && dai->driver->ops->set_tdm_slot)
3666		return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
3667				slots, slot_width);
3668	else
3669		return -ENOTSUPP;
3670}
3671EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
3672
3673/**
3674 * snd_soc_dai_set_channel_map - configure DAI audio channel map
3675 * @dai: DAI
3676 * @tx_num: how many TX channels
3677 * @tx_slot: pointer to an array which imply the TX slot number channel
3678 *           0~num-1 uses
3679 * @rx_num: how many RX channels
3680 * @rx_slot: pointer to an array which imply the RX slot number channel
3681 *           0~num-1 uses
3682 *
3683 * configure the relationship between channel number and TDM slot number.
3684 */
3685int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
3686	unsigned int tx_num, unsigned int *tx_slot,
3687	unsigned int rx_num, unsigned int *rx_slot)
3688{
3689	if (dai->driver && dai->driver->ops->set_channel_map)
3690		return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
3691			rx_num, rx_slot);
3692	else
3693		return -EINVAL;
3694}
3695EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
3696
3697/**
3698 * snd_soc_dai_set_tristate - configure DAI system or master clock.
3699 * @dai: DAI
3700 * @tristate: tristate enable
3701 *
3702 * Tristates the DAI so that others can use it.
3703 */
3704int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
3705{
3706	if (dai->driver && dai->driver->ops->set_tristate)
3707		return dai->driver->ops->set_tristate(dai, tristate);
3708	else
3709		return -EINVAL;
3710}
3711EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
3712
3713/**
3714 * snd_soc_dai_digital_mute - configure DAI system or master clock.
3715 * @dai: DAI
3716 * @mute: mute enable
3717 * @direction: stream to mute
3718 *
3719 * Mutes the DAI DAC.
3720 */
3721int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute,
3722			     int direction)
3723{
3724	if (!dai->driver)
3725		return -ENOTSUPP;
3726
3727	if (dai->driver->ops->mute_stream)
3728		return dai->driver->ops->mute_stream(dai, mute, direction);
3729	else if (direction == SNDRV_PCM_STREAM_PLAYBACK &&
3730		 dai->driver->ops->digital_mute)
3731		return dai->driver->ops->digital_mute(dai, mute);
3732	else
3733		return -ENOTSUPP;
3734}
3735EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
3736
3737/**
3738 * snd_soc_register_card - Register a card with the ASoC core
3739 *
3740 * @card: Card to register
3741 *
3742 */
3743int snd_soc_register_card(struct snd_soc_card *card)
3744{
3745	int i, ret;
3746
3747	if (!card->name || !card->dev)
3748		return -EINVAL;
3749
3750	for (i = 0; i < card->num_links; i++) {
3751		struct snd_soc_dai_link *link = &card->dai_link[i];
3752
3753		/*
3754		 * Codec must be specified by 1 of name or OF node,
3755		 * not both or neither.
3756		 */
3757		if (!!link->codec_name == !!link->codec_of_node) {
3758			dev_err(card->dev,
3759				"ASoC: Neither/both codec name/of_node are set for %s\n",
3760				link->name);
3761			return -EINVAL;
3762		}
3763		/* Codec DAI name must be specified */
3764		if (!link->codec_dai_name) {
3765			dev_err(card->dev,
3766				"ASoC: codec_dai_name not set for %s\n",
3767				link->name);
3768			return -EINVAL;
3769		}
3770
3771		/*
3772		 * Platform may be specified by either name or OF node, but
3773		 * can be left unspecified, and a dummy platform will be used.
3774		 */
3775		if (link->platform_name && link->platform_of_node) {
3776			dev_err(card->dev,
3777				"ASoC: Both platform name/of_node are set for %s\n",
3778				link->name);
3779			return -EINVAL;
3780		}
3781
3782		/*
3783		 * CPU device may be specified by either name or OF node, but
3784		 * can be left unspecified, and will be matched based on DAI
3785		 * name alone..
3786		 */
3787		if (link->cpu_name && link->cpu_of_node) {
3788			dev_err(card->dev,
3789				"ASoC: Neither/both cpu name/of_node are set for %s\n",
3790				link->name);
3791			return -EINVAL;
3792		}
3793		/*
3794		 * At least one of CPU DAI name or CPU device name/node must be
3795		 * specified
3796		 */
3797		if (!link->cpu_dai_name &&
3798		    !(link->cpu_name || link->cpu_of_node)) {
3799			dev_err(card->dev,
3800				"ASoC: Neither cpu_dai_name nor cpu_name/of_node are set for %s\n",
3801				link->name);
3802			return -EINVAL;
3803		}
3804	}
3805
3806	dev_set_drvdata(card->dev, card);
3807
3808	snd_soc_initialize_card_lists(card);
 
 
 
 
 
 
 
 
 
3809
3810	soc_init_card_debugfs(card);
3811
3812	card->rtd = devm_kzalloc(card->dev,
3813				 sizeof(struct snd_soc_pcm_runtime) *
3814				 (card->num_links + card->num_aux_devs),
3815				 GFP_KERNEL);
3816	if (card->rtd == NULL)
3817		return -ENOMEM;
3818	card->num_rtd = 0;
3819	card->rtd_aux = &card->rtd[card->num_links];
3820
3821	for (i = 0; i < card->num_links; i++)
3822		card->rtd[i].dai_link = &card->dai_link[i];
3823
3824	INIT_LIST_HEAD(&card->list);
3825	INIT_LIST_HEAD(&card->dapm_dirty);
3826	card->instantiated = 0;
3827	mutex_init(&card->mutex);
3828	mutex_init(&card->dapm_mutex);
 
 
3829
3830	ret = snd_soc_instantiate_card(card);
3831	if (ret != 0)
3832		soc_cleanup_card_debugfs(card);
 
 
 
 
 
 
 
 
 
 
3833
3834	/* deactivate pins to sleep state */
3835	for (i = 0; i < card->num_rtd; i++) {
3836		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3837		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
3838		if (!codec_dai->active)
3839			pinctrl_pm_select_sleep_state(codec_dai->dev);
3840		if (!cpu_dai->active)
3841			pinctrl_pm_select_sleep_state(cpu_dai->dev);
3842	}
3843
3844	return ret;
3845}
3846EXPORT_SYMBOL_GPL(snd_soc_register_card);
3847
3848/**
3849 * snd_soc_unregister_card - Unregister a card with the ASoC core
3850 *
3851 * @card: Card to unregister
3852 *
3853 */
3854int snd_soc_unregister_card(struct snd_soc_card *card)
3855{
3856	if (card->instantiated)
3857		soc_cleanup_card_resources(card);
 
3858	dev_dbg(card->dev, "ASoC: Unregistered card '%s'\n", card->name);
3859
3860	return 0;
3861}
3862EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
3863
3864/*
3865 * Simplify DAI link configuration by removing ".-1" from device names
3866 * and sanitizing names.
3867 */
3868static char *fmt_single_name(struct device *dev, int *id)
3869{
3870	char *found, name[NAME_SIZE];
3871	int id1, id2;
3872
3873	if (dev_name(dev) == NULL)
3874		return NULL;
3875
3876	strlcpy(name, dev_name(dev), NAME_SIZE);
3877
3878	/* are we a "%s.%d" name (platform and SPI components) */
3879	found = strstr(name, dev->driver->name);
3880	if (found) {
3881		/* get ID */
3882		if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
3883
3884			/* discard ID from name if ID == -1 */
3885			if (*id == -1)
3886				found[strlen(dev->driver->name)] = '\0';
3887		}
3888
3889	} else {
3890		/* I2C component devices are named "bus-addr"  */
3891		if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
3892			char tmp[NAME_SIZE];
3893
3894			/* create unique ID number from I2C addr and bus */
3895			*id = ((id1 & 0xffff) << 16) + id2;
3896
3897			/* sanitize component name for DAI link creation */
3898			snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
 
3899			strlcpy(name, tmp, NAME_SIZE);
3900		} else
3901			*id = 0;
3902	}
3903
3904	return kstrdup(name, GFP_KERNEL);
3905}
3906
3907/*
3908 * Simplify DAI link naming for single devices with multiple DAIs by removing
3909 * any ".-1" and using the DAI name (instead of device name).
3910 */
3911static inline char *fmt_multiple_name(struct device *dev,
3912		struct snd_soc_dai_driver *dai_drv)
3913{
3914	if (dai_drv->name == NULL) {
3915		dev_err(dev,
3916			"ASoC: error - multiple DAI %s registered with no name\n",
3917			dev_name(dev));
3918		return NULL;
3919	}
3920
3921	return kstrdup(dai_drv->name, GFP_KERNEL);
3922}
3923
3924/**
3925 * snd_soc_unregister_dai - Unregister DAIs from the ASoC core
3926 *
3927 * @component: The component for which the DAIs should be unregistered
3928 */
3929static void snd_soc_unregister_dais(struct snd_soc_component *component)
3930{
3931	struct snd_soc_dai *dai, *_dai;
3932
3933	list_for_each_entry_safe(dai, _dai, &component->dai_list, list) {
3934		dev_dbg(component->dev, "ASoC: Unregistered DAI '%s'\n",
3935			dai->name);
3936		list_del(&dai->list);
3937		kfree(dai->name);
3938		kfree(dai);
3939	}
3940}
3941
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3942/**
3943 * snd_soc_register_dais - Register a DAI with the ASoC core
3944 *
3945 * @component: The component the DAIs are registered for
3946 * @codec: The CODEC that the DAIs are registered for, NULL if the component is
3947 *         not a CODEC.
3948 * @dai_drv: DAI driver to use for the DAIs
3949 * @count: Number of DAIs
3950 * @legacy_dai_naming: Use the legacy naming scheme and let the DAI inherit the
3951 *                     parent's name.
3952 */
3953static int snd_soc_register_dais(struct snd_soc_component *component,
3954	struct snd_soc_codec *codec, struct snd_soc_dai_driver *dai_drv,
3955	size_t count, bool legacy_dai_naming)
3956{
3957	struct device *dev = component->dev;
3958	struct snd_soc_dai *dai;
3959	unsigned int i;
3960	int ret;
3961
3962	dev_dbg(dev, "ASoC: dai register %s #%Zu\n", dev_name(dev), count);
3963
3964	for (i = 0; i < count; i++) {
3965
3966		dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
 
3967		if (dai == NULL) {
3968			ret = -ENOMEM;
3969			goto err;
3970		}
3971
3972		/*
3973		 * Back in the old days when we still had component-less DAIs,
3974		 * instead of having a static name, component-less DAIs would
3975		 * inherit the name of the parent device so it is possible to
3976		 * register multiple instances of the DAI. We still need to keep
3977		 * the same naming style even though those DAIs are not
3978		 * component-less anymore.
3979		 */
3980		if (count == 1 && legacy_dai_naming) {
3981			dai->name = fmt_single_name(dev, &dai->id);
3982		} else {
3983			dai->name = fmt_multiple_name(dev, &dai_drv[i]);
3984			if (dai_drv[i].id)
3985				dai->id = dai_drv[i].id;
3986			else
3987				dai->id = i;
3988		}
3989		if (dai->name == NULL) {
3990			kfree(dai);
3991			ret = -ENOMEM;
3992			goto err;
3993		}
3994
3995		dai->component = component;
3996		dai->codec = codec;
3997		dai->dev = dev;
3998		dai->driver = &dai_drv[i];
3999		dai->dapm.dev = dev;
4000		if (!dai->driver->ops)
4001			dai->driver->ops = &null_dai_ops;
4002
4003		if (!dai->codec)
4004			dai->dapm.idle_bias_off = 1;
4005
4006		list_add(&dai->list, &component->dai_list);
4007
4008		dev_dbg(dev, "ASoC: Registered DAI '%s'\n", dai->name);
4009	}
4010
4011	return 0;
4012
4013err:
4014	snd_soc_unregister_dais(component);
4015
4016	return ret;
4017}
4018
4019/**
4020 * snd_soc_register_component - Register a component with the ASoC core
4021 *
 
 
 
 
 
 
4022 */
4023static int
4024__snd_soc_register_component(struct device *dev,
4025			     struct snd_soc_component *cmpnt,
4026			     const struct snd_soc_component_driver *cmpnt_drv,
4027			     struct snd_soc_codec *codec,
4028			     struct snd_soc_dai_driver *dai_drv,
4029			     int num_dai, bool allow_single_dai)
4030{
 
 
 
4031	int ret;
4032
4033	dev_dbg(dev, "component register %s\n", dev_name(dev));
4034
4035	if (!cmpnt) {
4036		dev_err(dev, "ASoC: Failed to connecting component\n");
4037		return -ENOMEM;
4038	}
4039
4040	cmpnt->name = fmt_single_name(dev, &cmpnt->id);
4041	if (!cmpnt->name) {
4042		dev_err(dev, "ASoC: Failed to simplifying name\n");
4043		return -ENOMEM;
4044	}
4045
4046	cmpnt->dev	= dev;
4047	cmpnt->driver	= cmpnt_drv;
4048	cmpnt->dai_drv	= dai_drv;
4049	cmpnt->num_dai	= num_dai;
4050	INIT_LIST_HEAD(&cmpnt->dai_list);
4051
4052	ret = snd_soc_register_dais(cmpnt, codec, dai_drv, num_dai,
4053		allow_single_dai);
4054	if (ret < 0) {
4055		dev_err(dev, "ASoC: Failed to regster DAIs: %d\n", ret);
4056		goto error_component_name;
4057	}
4058
4059	mutex_lock(&client_mutex);
4060	list_add(&cmpnt->list, &component_list);
4061	mutex_unlock(&client_mutex);
4062
4063	dev_dbg(cmpnt->dev, "ASoC: Registered component '%s'\n", cmpnt->name);
4064
4065	return ret;
 
 
4066
4067error_component_name:
4068	kfree(cmpnt->name);
4069
4070	return ret;
4071}
 
 
4072
4073int snd_soc_register_component(struct device *dev,
4074			       const struct snd_soc_component_driver *cmpnt_drv,
4075			       struct snd_soc_dai_driver *dai_drv,
4076			       int num_dai)
4077{
4078	struct snd_soc_component *cmpnt;
4079
4080	cmpnt = devm_kzalloc(dev, sizeof(*cmpnt), GFP_KERNEL);
4081	if (!cmpnt) {
4082		dev_err(dev, "ASoC: Failed to allocate memory\n");
4083		return -ENOMEM;
4084	}
4085
4086	cmpnt->ignore_pmdown_time = true;
 
4087
4088	return __snd_soc_register_component(dev, cmpnt, cmpnt_drv, NULL,
4089					    dai_drv, num_dai, true);
4090}
4091EXPORT_SYMBOL_GPL(snd_soc_register_component);
4092
4093/**
4094 * snd_soc_unregister_component - Unregister a component from the ASoC core
4095 *
4096 */
4097void snd_soc_unregister_component(struct device *dev)
4098{
4099	struct snd_soc_component *cmpnt;
4100
4101	list_for_each_entry(cmpnt, &component_list, list) {
4102		if (dev == cmpnt->dev)
4103			goto found;
4104	}
4105	return;
4106
4107found:
4108	snd_soc_unregister_dais(cmpnt);
4109
4110	mutex_lock(&client_mutex);
4111	list_del(&cmpnt->list);
4112	mutex_unlock(&client_mutex);
4113
4114	dev_dbg(dev, "ASoC: Unregistered component '%s'\n", cmpnt->name);
4115	kfree(cmpnt->name);
4116}
4117EXPORT_SYMBOL_GPL(snd_soc_unregister_component);
4118
4119/**
4120 * snd_soc_add_platform - Add a platform to the ASoC core
4121 * @dev: The parent device for the platform
4122 * @platform: The platform to add
4123 * @platform_driver: The driver for the platform
 
 
 
 
 
4124 */
4125int snd_soc_add_platform(struct device *dev, struct snd_soc_platform *platform,
4126		const struct snd_soc_platform_driver *platform_drv)
4127{
4128	/* create platform component name */
4129	platform->name = fmt_single_name(dev, &platform->id);
4130	if (platform->name == NULL)
4131		return -ENOMEM;
4132
4133	platform->dev = dev;
4134	platform->driver = platform_drv;
4135	platform->dapm.dev = dev;
4136	platform->dapm.platform = platform;
4137	platform->dapm.stream_event = platform_drv->stream_event;
4138	mutex_init(&platform->mutex);
4139
4140	mutex_lock(&client_mutex);
4141	list_add(&platform->list, &platform_list);
4142	mutex_unlock(&client_mutex);
4143
4144	dev_dbg(dev, "ASoC: Registered platform '%s'\n", platform->name);
4145
4146	return 0;
4147}
4148EXPORT_SYMBOL_GPL(snd_soc_add_platform);
4149
4150/**
4151 * snd_soc_register_platform - Register a platform with the ASoC core
 
 
 
 
 
4152 *
4153 * @platform: platform to register
 
4154 */
4155int snd_soc_register_platform(struct device *dev,
4156		const struct snd_soc_platform_driver *platform_drv)
4157{
4158	struct snd_soc_platform *platform;
4159	int ret;
 
 
4160
4161	dev_dbg(dev, "ASoC: platform register %s\n", dev_name(dev));
4162
4163	platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
4164	if (platform == NULL)
4165		return -ENOMEM;
4166
4167	ret = snd_soc_add_platform(dev, platform, platform_drv);
4168	if (ret)
4169		kfree(platform);
 
 
 
 
4170
4171	return ret;
4172}
4173EXPORT_SYMBOL_GPL(snd_soc_register_platform);
4174
4175/**
4176 * snd_soc_remove_platform - Remove a platform from the ASoC core
4177 * @platform: the platform to remove
4178 */
4179void snd_soc_remove_platform(struct snd_soc_platform *platform)
4180{
4181	mutex_lock(&client_mutex);
4182	list_del(&platform->list);
4183	mutex_unlock(&client_mutex);
4184
4185	dev_dbg(platform->dev, "ASoC: Unregistered platform '%s'\n",
4186		platform->name);
4187	kfree(platform->name);
4188}
4189EXPORT_SYMBOL_GPL(snd_soc_remove_platform);
4190
4191struct snd_soc_platform *snd_soc_lookup_platform(struct device *dev)
4192{
4193	struct snd_soc_platform *platform;
4194
4195	list_for_each_entry(platform, &platform_list, list) {
4196		if (dev == platform->dev)
4197			return platform;
4198	}
4199
4200	return NULL;
4201}
4202EXPORT_SYMBOL_GPL(snd_soc_lookup_platform);
4203
4204/**
4205 * snd_soc_unregister_platform - Unregister a platform from the ASoC core
4206 *
4207 * @platform: platform to unregister
4208 */
4209void snd_soc_unregister_platform(struct device *dev)
4210{
4211	struct snd_soc_platform *platform;
4212
4213	platform = snd_soc_lookup_platform(dev);
4214	if (!platform)
4215		return;
4216
4217	snd_soc_remove_platform(platform);
4218	kfree(platform);
4219}
4220EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
4221
4222static u64 codec_format_map[] = {
4223	SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
4224	SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
4225	SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
4226	SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
4227	SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
4228	SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
4229	SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
4230	SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
4231	SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
4232	SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
4233	SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
4234	SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
4235	SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
4236	SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
4237	SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
4238	| SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
4239};
4240
4241/* Fix up the DAI formats for endianness: codecs don't actually see
 
4242 * the endianness of the data but we're using the CPU format
4243 * definitions which do need to include endianness so we ensure that
4244 * codec DAIs always have both big and little endian variants set.
4245 */
4246static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
4247{
4248	int i;
4249
4250	for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
4251		if (stream->formats & codec_format_map[i])
4252			stream->formats |= codec_format_map[i];
4253}
4254
4255/**
4256 * snd_soc_register_codec - Register a codec with the ASoC core
4257 *
4258 * @codec: codec to register
4259 */
4260int snd_soc_register_codec(struct device *dev,
4261			   const struct snd_soc_codec_driver *codec_drv,
4262			   struct snd_soc_dai_driver *dai_drv,
4263			   int num_dai)
4264{
4265	struct snd_soc_codec *codec;
4266	int ret, i;
 
 
 
 
4267
4268	dev_dbg(dev, "codec register %s\n", dev_name(dev));
 
 
 
 
 
 
 
4269
4270	codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
4271	if (codec == NULL)
4272		return -ENOMEM;
4273
4274	/* create CODEC component name */
4275	codec->name = fmt_single_name(dev, &codec->id);
4276	if (codec->name == NULL) {
4277		ret = -ENOMEM;
4278		goto fail_codec;
4279	}
4280
4281	codec->write = codec_drv->write;
4282	codec->read = codec_drv->read;
4283	codec->volatile_register = codec_drv->volatile_register;
4284	codec->readable_register = codec_drv->readable_register;
4285	codec->writable_register = codec_drv->writable_register;
4286	codec->component.ignore_pmdown_time = codec_drv->ignore_pmdown_time;
4287	codec->dapm.bias_level = SND_SOC_BIAS_OFF;
4288	codec->dapm.dev = dev;
4289	codec->dapm.codec = codec;
4290	codec->dapm.seq_notifier = codec_drv->seq_notifier;
4291	codec->dapm.stream_event = codec_drv->stream_event;
4292	codec->dev = dev;
4293	codec->driver = codec_drv;
4294	codec->num_dai = num_dai;
4295	mutex_init(&codec->mutex);
4296
4297	for (i = 0; i < num_dai; i++) {
4298		fixup_codec_formats(&dai_drv[i].playback);
4299		fixup_codec_formats(&dai_drv[i].capture);
4300	}
4301
4302	mutex_lock(&client_mutex);
4303	list_add(&codec->list, &codec_list);
4304	mutex_unlock(&client_mutex);
4305
4306	/* register component */
4307	ret = __snd_soc_register_component(dev, &codec->component,
4308					   &codec_drv->component_driver,
4309					   codec, dai_drv, num_dai, false);
4310	if (ret < 0) {
4311		dev_err(codec->dev, "ASoC: Failed to regster component: %d\n", ret);
4312		goto fail_codec_name;
4313	}
4314
4315	dev_dbg(codec->dev, "ASoC: Registered codec '%s'\n", codec->name);
 
 
4316	return 0;
4317
4318fail_codec_name:
4319	mutex_lock(&client_mutex);
4320	list_del(&codec->list);
4321	mutex_unlock(&client_mutex);
 
 
 
 
 
 
 
 
 
 
 
 
 
4322
4323	kfree(codec->name);
4324fail_codec:
4325	kfree(codec);
4326	return ret;
4327}
4328EXPORT_SYMBOL_GPL(snd_soc_register_codec);
4329
4330/**
4331 * snd_soc_unregister_codec - Unregister a codec from the ASoC core
 
4332 *
4333 * @codec: codec to unregister
4334 */
4335void snd_soc_unregister_codec(struct device *dev)
4336{
4337	struct snd_soc_codec *codec;
 
4338
4339	list_for_each_entry(codec, &codec_list, list) {
4340		if (dev == codec->dev)
4341			goto found;
 
 
 
 
 
 
 
4342	}
4343	return;
 
 
 
4344
4345found:
4346	snd_soc_unregister_component(dev);
4347
 
 
 
 
 
 
 
 
 
 
 
 
 
 
4348	mutex_lock(&client_mutex);
4349	list_del(&codec->list);
 
 
 
 
 
 
 
 
 
 
 
4350	mutex_unlock(&client_mutex);
4351
4352	dev_dbg(codec->dev, "ASoC: Unregistered codec '%s'\n", codec->name);
4353
4354	snd_soc_cache_exit(codec);
4355	kfree(codec->name);
4356	kfree(codec);
4357}
4358EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
4359
4360/* Retrieve a card's name from device tree */
4361int snd_soc_of_parse_card_name(struct snd_soc_card *card,
4362			       const char *propname)
4363{
4364	struct device_node *np = card->dev->of_node;
4365	int ret;
4366
 
 
 
 
 
 
 
4367	ret = of_property_read_string_index(np, propname, 0, &card->name);
4368	/*
4369	 * EINVAL means the property does not exist. This is fine providing
4370	 * card->name was previously set, which is checked later in
4371	 * snd_soc_register_card.
4372	 */
4373	if (ret < 0 && ret != -EINVAL) {
4374		dev_err(card->dev,
4375			"ASoC: Property '%s' could not be read: %d\n",
4376			propname, ret);
4377		return ret;
4378	}
4379
4380	return 0;
4381}
4382EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
4383
4384static const struct snd_soc_dapm_widget simple_widgets[] = {
4385	SND_SOC_DAPM_MIC("Microphone", NULL),
4386	SND_SOC_DAPM_LINE("Line", NULL),
4387	SND_SOC_DAPM_HP("Headphone", NULL),
4388	SND_SOC_DAPM_SPK("Speaker", NULL),
4389};
4390
4391int snd_soc_of_parse_audio_simple_widgets(struct snd_soc_card *card,
4392					  const char *propname)
4393{
4394	struct device_node *np = card->dev->of_node;
4395	struct snd_soc_dapm_widget *widgets;
4396	const char *template, *wname;
4397	int i, j, num_widgets, ret;
4398
4399	num_widgets = of_property_count_strings(np, propname);
4400	if (num_widgets < 0) {
4401		dev_err(card->dev,
4402			"ASoC: Property '%s' does not exist\n",	propname);
4403		return -EINVAL;
4404	}
4405	if (num_widgets & 1) {
4406		dev_err(card->dev,
4407			"ASoC: Property '%s' length is not even\n", propname);
4408		return -EINVAL;
4409	}
4410
4411	num_widgets /= 2;
4412	if (!num_widgets) {
4413		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
4414			propname);
4415		return -EINVAL;
4416	}
4417
4418	widgets = devm_kcalloc(card->dev, num_widgets, sizeof(*widgets),
4419			       GFP_KERNEL);
4420	if (!widgets) {
4421		dev_err(card->dev,
4422			"ASoC: Could not allocate memory for widgets\n");
4423		return -ENOMEM;
4424	}
4425
4426	for (i = 0; i < num_widgets; i++) {
4427		ret = of_property_read_string_index(np, propname,
4428			2 * i, &template);
4429		if (ret) {
4430			dev_err(card->dev,
4431				"ASoC: Property '%s' index %d read error:%d\n",
4432				propname, 2 * i, ret);
4433			return -EINVAL;
4434		}
4435
4436		for (j = 0; j < ARRAY_SIZE(simple_widgets); j++) {
4437			if (!strncmp(template, simple_widgets[j].name,
4438				     strlen(simple_widgets[j].name))) {
4439				widgets[i] = simple_widgets[j];
4440				break;
4441			}
4442		}
4443
4444		if (j >= ARRAY_SIZE(simple_widgets)) {
4445			dev_err(card->dev,
4446				"ASoC: DAPM widget '%s' is not supported\n",
4447				template);
4448			return -EINVAL;
4449		}
4450
4451		ret = of_property_read_string_index(np, propname,
4452						    (2 * i) + 1,
4453						    &wname);
4454		if (ret) {
4455			dev_err(card->dev,
4456				"ASoC: Property '%s' index %d read error:%d\n",
4457				propname, (2 * i) + 1, ret);
4458			return -EINVAL;
4459		}
4460
4461		widgets[i].name = wname;
4462	}
4463
4464	card->dapm_widgets = widgets;
4465	card->num_dapm_widgets = num_widgets;
4466
4467	return 0;
4468}
4469EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_simple_widgets);
4470
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
4471int snd_soc_of_parse_tdm_slot(struct device_node *np,
 
 
4472			      unsigned int *slots,
4473			      unsigned int *slot_width)
4474{
4475	u32 val;
4476	int ret;
4477
 
 
 
 
 
4478	if (of_property_read_bool(np, "dai-tdm-slot-num")) {
4479		ret = of_property_read_u32(np, "dai-tdm-slot-num", &val);
4480		if (ret)
4481			return ret;
4482
4483		if (slots)
4484			*slots = val;
4485	}
4486
4487	if (of_property_read_bool(np, "dai-tdm-slot-width")) {
4488		ret = of_property_read_u32(np, "dai-tdm-slot-width", &val);
4489		if (ret)
4490			return ret;
4491
4492		if (slot_width)
4493			*slot_width = val;
4494	}
4495
4496	return 0;
4497}
4498EXPORT_SYMBOL_GPL(snd_soc_of_parse_tdm_slot);
4499
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
4500int snd_soc_of_parse_audio_routing(struct snd_soc_card *card,
4501				   const char *propname)
4502{
4503	struct device_node *np = card->dev->of_node;
4504	int num_routes;
4505	struct snd_soc_dapm_route *routes;
4506	int i, ret;
4507
4508	num_routes = of_property_count_strings(np, propname);
4509	if (num_routes < 0 || num_routes & 1) {
4510		dev_err(card->dev,
4511			"ASoC: Property '%s' does not exist or its length is not even\n",
4512			propname);
4513		return -EINVAL;
4514	}
4515	num_routes /= 2;
4516	if (!num_routes) {
4517		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
4518			propname);
4519		return -EINVAL;
4520	}
4521
4522	routes = devm_kzalloc(card->dev, num_routes * sizeof(*routes),
4523			      GFP_KERNEL);
4524	if (!routes) {
4525		dev_err(card->dev,
4526			"ASoC: Could not allocate DAPM route table\n");
4527		return -EINVAL;
4528	}
4529
4530	for (i = 0; i < num_routes; i++) {
4531		ret = of_property_read_string_index(np, propname,
4532			2 * i, &routes[i].sink);
4533		if (ret) {
4534			dev_err(card->dev,
4535				"ASoC: Property '%s' index %d could not be read: %d\n",
4536				propname, 2 * i, ret);
4537			return -EINVAL;
4538		}
4539		ret = of_property_read_string_index(np, propname,
4540			(2 * i) + 1, &routes[i].source);
4541		if (ret) {
4542			dev_err(card->dev,
4543				"ASoC: Property '%s' index %d could not be read: %d\n",
4544				propname, (2 * i) + 1, ret);
4545			return -EINVAL;
4546		}
4547	}
4548
4549	card->num_dapm_routes = num_routes;
4550	card->dapm_routes = routes;
4551
4552	return 0;
4553}
4554EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
4555
4556unsigned int snd_soc_of_parse_daifmt(struct device_node *np,
4557				     const char *prefix)
 
 
4558{
4559	int ret, i;
4560	char prop[128];
4561	unsigned int format = 0;
4562	int bit, frame;
4563	const char *str;
4564	struct {
4565		char *name;
4566		unsigned int val;
4567	} of_fmt_table[] = {
4568		{ "i2s",	SND_SOC_DAIFMT_I2S },
4569		{ "right_j",	SND_SOC_DAIFMT_RIGHT_J },
4570		{ "left_j",	SND_SOC_DAIFMT_LEFT_J },
4571		{ "dsp_a",	SND_SOC_DAIFMT_DSP_A },
4572		{ "dsp_b",	SND_SOC_DAIFMT_DSP_B },
4573		{ "ac97",	SND_SOC_DAIFMT_AC97 },
4574		{ "pdm",	SND_SOC_DAIFMT_PDM},
4575		{ "msb",	SND_SOC_DAIFMT_MSB },
4576		{ "lsb",	SND_SOC_DAIFMT_LSB },
4577	};
4578
4579	if (!prefix)
4580		prefix = "";
4581
4582	/*
4583	 * check "[prefix]format = xxx"
 
4584	 * SND_SOC_DAIFMT_FORMAT_MASK area
4585	 */
4586	snprintf(prop, sizeof(prop), "%sformat", prefix);
4587	ret = of_property_read_string(np, prop, &str);
 
 
 
4588	if (ret == 0) {
4589		for (i = 0; i < ARRAY_SIZE(of_fmt_table); i++) {
4590			if (strcmp(str, of_fmt_table[i].name) == 0) {
4591				format |= of_fmt_table[i].val;
4592				break;
4593			}
4594		}
4595	}
4596
4597	/*
4598	 * check "[prefix]continuous-clock"
4599	 * SND_SOC_DAIFMT_CLOCK_MASK area
4600	 */
4601	snprintf(prop, sizeof(prop), "%scontinuous-clock", prefix);
4602	if (of_get_property(np, prop, NULL))
4603		format |= SND_SOC_DAIFMT_CONT;
4604	else
4605		format |= SND_SOC_DAIFMT_GATED;
4606
4607	/*
4608	 * check "[prefix]bitclock-inversion"
4609	 * check "[prefix]frame-inversion"
4610	 * SND_SOC_DAIFMT_INV_MASK area
4611	 */
4612	snprintf(prop, sizeof(prop), "%sbitclock-inversion", prefix);
4613	bit = !!of_get_property(np, prop, NULL);
4614
4615	snprintf(prop, sizeof(prop), "%sframe-inversion", prefix);
4616	frame = !!of_get_property(np, prop, NULL);
4617
4618	switch ((bit << 4) + frame) {
4619	case 0x11:
4620		format |= SND_SOC_DAIFMT_IB_IF;
4621		break;
4622	case 0x10:
4623		format |= SND_SOC_DAIFMT_IB_NF;
4624		break;
4625	case 0x01:
4626		format |= SND_SOC_DAIFMT_NB_IF;
4627		break;
4628	default:
4629		/* SND_SOC_DAIFMT_NB_NF is default */
4630		break;
4631	}
4632
4633	/*
4634	 * check "[prefix]bitclock-master"
4635	 * check "[prefix]frame-master"
4636	 * SND_SOC_DAIFMT_MASTER_MASK area
4637	 */
4638	snprintf(prop, sizeof(prop), "%sbitclock-master", prefix);
4639	bit = !!of_get_property(np, prop, NULL);
 
 
4640
4641	snprintf(prop, sizeof(prop), "%sframe-master", prefix);
4642	frame = !!of_get_property(np, prop, NULL);
 
 
4643
4644	switch ((bit << 4) + frame) {
4645	case 0x11:
4646		format |= SND_SOC_DAIFMT_CBM_CFM;
4647		break;
4648	case 0x10:
4649		format |= SND_SOC_DAIFMT_CBM_CFS;
4650		break;
4651	case 0x01:
4652		format |= SND_SOC_DAIFMT_CBS_CFM;
4653		break;
4654	default:
4655		format |= SND_SOC_DAIFMT_CBS_CFS;
4656		break;
4657	}
4658
4659	return format;
4660}
4661EXPORT_SYMBOL_GPL(snd_soc_of_parse_daifmt);
4662
4663int snd_soc_of_get_dai_name(struct device_node *of_node,
4664			    const char **dai_name)
4665{
4666	struct snd_soc_component *pos;
4667	struct of_phandle_args args;
4668	int ret;
4669
4670	ret = of_parse_phandle_with_args(of_node, "sound-dai",
4671					 "#sound-dai-cells", 0, &args);
4672	if (ret)
4673		return ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
4674
4675	ret = -EPROBE_DEFER;
 
 
 
 
 
4676
4677	mutex_lock(&client_mutex);
4678	list_for_each_entry(pos, &component_list, list) {
4679		if (pos->dev->of_node != args.np)
 
 
4680			continue;
4681
4682		if (pos->driver->of_xlate_dai_name) {
4683			ret = pos->driver->of_xlate_dai_name(pos, &args, dai_name);
4684		} else {
4685			int id = -1;
4686
4687			switch (args.args_count) {
4688			case 0:
4689				id = 0; /* same as dai_drv[0] */
4690				break;
4691			case 1:
4692				id = args.args[0];
4693				break;
4694			default:
4695				/* not supported */
4696				break;
4697			}
4698
4699			if (id < 0 || id >= pos->num_dai) {
4700				ret = -EINVAL;
4701				break;
4702			}
4703
4704			ret = 0;
4705
4706			*dai_name = pos->dai_drv[id].name;
 
 
 
 
 
 
 
4707			if (!*dai_name)
4708				*dai_name = pos->name;
4709		}
4710
4711		break;
4712	}
4713	mutex_unlock(&client_mutex);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
4714
4715	of_node_put(args.np);
4716
4717	return ret;
4718}
4719EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_name);
4720
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
4721static int __init snd_soc_init(void)
4722{
4723#ifdef CONFIG_DEBUG_FS
4724	snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
4725	if (IS_ERR(snd_soc_debugfs_root) || !snd_soc_debugfs_root) {
4726		pr_warn("ASoC: Failed to create debugfs directory\n");
4727		snd_soc_debugfs_root = NULL;
4728	}
4729
4730	if (!debugfs_create_file("codecs", 0444, snd_soc_debugfs_root, NULL,
4731				 &codec_list_fops))
4732		pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
4733
4734	if (!debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
4735				 &dai_list_fops))
4736		pr_warn("ASoC: Failed to create DAI list debugfs file\n");
4737
4738	if (!debugfs_create_file("platforms", 0444, snd_soc_debugfs_root, NULL,
4739				 &platform_list_fops))
4740		pr_warn("ASoC: Failed to create platform list debugfs file\n");
4741#endif
4742
4743	snd_soc_util_init();
4744
4745	return platform_driver_register(&soc_driver);
4746}
4747module_init(snd_soc_init);
4748
4749static void __exit snd_soc_exit(void)
4750{
4751	snd_soc_util_exit();
 
4752
4753#ifdef CONFIG_DEBUG_FS
4754	debugfs_remove_recursive(snd_soc_debugfs_root);
4755#endif
4756	platform_driver_unregister(&soc_driver);
4757}
4758module_exit(snd_soc_exit);
4759
4760/* Module information */
4761MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
4762MODULE_DESCRIPTION("ALSA SoC Core");
4763MODULE_LICENSE("GPL");
4764MODULE_ALIAS("platform:soc-audio");