Linux Audio

Check our new training course

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