soc-dapm.c 97.4 KB
Newer Older
1 2 3 4
/*
 * soc-dapm.c  --  ALSA SoC Dynamic Audio Power Management
 *
 * Copyright 2005 Wolfson Microelectronics PLC.
5
 * Author: Liam Girdwood <lrg@slimlogic.co.uk>
6 7 8 9 10 11 12 13 14
 *
 *  This program is free software; you can redistribute  it and/or modify it
 *  under  the terms of  the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the  License, or (at your
 *  option) any later version.
 *
 *  Features:
 *    o Changes power status of internal codec blocks depending on the
 *      dynamic configuration of codec internal audio paths and active
M
Mark Brown 已提交
15
 *      DACs/ADCs.
16
 *    o Platform power domain - can support external components i.e. amps and
17
 *      mic/headphone insertion events.
18 19 20
 *    o Automatic Mic Bias support
 *    o Jack insertion power event initiation - e.g. hp insertion will enable
 *      sinks, dacs, etc
21
 *    o Delayed power down of audio subsystem to reduce pops between a quick
22 23 24 25 26 27 28
 *      device reopen.
 *
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/init.h>
29
#include <linux/async.h>
30 31 32 33 34
#include <linux/delay.h>
#include <linux/pm.h>
#include <linux/bitops.h>
#include <linux/platform_device.h>
#include <linux/jiffies.h>
35
#include <linux/debugfs.h>
36
#include <linux/pm_runtime.h>
37
#include <linux/regulator/consumer.h>
38
#include <linux/clk.h>
39
#include <linux/slab.h>
40 41 42
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
L
Liam Girdwood 已提交
43
#include <sound/soc.h>
44 45
#include <sound/initval.h>

M
Mark Brown 已提交
46 47
#include <trace/events/asoc.h>

48 49
#define DAPM_UPDATE_STAT(widget, val) widget->dapm->card->dapm_stats.val++;

50 51 52 53 54 55 56 57 58
static int snd_soc_dapm_add_path(struct snd_soc_dapm_context *dapm,
	struct snd_soc_dapm_widget *wsource, struct snd_soc_dapm_widget *wsink,
	const char *control,
	int (*connected)(struct snd_soc_dapm_widget *source,
			 struct snd_soc_dapm_widget *sink));
static struct snd_soc_dapm_widget *
snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
			 const struct snd_soc_dapm_widget *widget);

59 60
/* dapm power sequences - make this per codec in the future */
static int dapm_up_seq[] = {
61
	[snd_soc_dapm_pre] = 0,
62
	[snd_soc_dapm_regulator_supply] = 1,
63
	[snd_soc_dapm_clock_supply] = 1,
64 65
	[snd_soc_dapm_supply] = 2,
	[snd_soc_dapm_micbias] = 3,
66
	[snd_soc_dapm_dai_link] = 2,
67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86
	[snd_soc_dapm_dai_in] = 4,
	[snd_soc_dapm_dai_out] = 4,
	[snd_soc_dapm_aif_in] = 4,
	[snd_soc_dapm_aif_out] = 4,
	[snd_soc_dapm_mic] = 5,
	[snd_soc_dapm_mux] = 6,
	[snd_soc_dapm_virt_mux] = 6,
	[snd_soc_dapm_value_mux] = 6,
	[snd_soc_dapm_dac] = 7,
	[snd_soc_dapm_switch] = 8,
	[snd_soc_dapm_mixer] = 8,
	[snd_soc_dapm_mixer_named_ctl] = 8,
	[snd_soc_dapm_pga] = 9,
	[snd_soc_dapm_adc] = 10,
	[snd_soc_dapm_out_drv] = 11,
	[snd_soc_dapm_hp] = 11,
	[snd_soc_dapm_spk] = 11,
	[snd_soc_dapm_line] = 11,
	[snd_soc_dapm_kcontrol] = 12,
	[snd_soc_dapm_post] = 13,
87
};
88

89
static int dapm_down_seq[] = {
90
	[snd_soc_dapm_pre] = 0,
91 92 93 94 95 96
	[snd_soc_dapm_kcontrol] = 1,
	[snd_soc_dapm_adc] = 2,
	[snd_soc_dapm_hp] = 3,
	[snd_soc_dapm_spk] = 3,
	[snd_soc_dapm_line] = 3,
	[snd_soc_dapm_out_drv] = 3,
97
	[snd_soc_dapm_pga] = 4,
98
	[snd_soc_dapm_switch] = 5,
99
	[snd_soc_dapm_mixer_named_ctl] = 5,
100 101 102 103 104
	[snd_soc_dapm_mixer] = 5,
	[snd_soc_dapm_dac] = 6,
	[snd_soc_dapm_mic] = 7,
	[snd_soc_dapm_micbias] = 8,
	[snd_soc_dapm_mux] = 9,
105
	[snd_soc_dapm_virt_mux] = 9,
106
	[snd_soc_dapm_value_mux] = 9,
107 108
	[snd_soc_dapm_aif_in] = 10,
	[snd_soc_dapm_aif_out] = 10,
109 110
	[snd_soc_dapm_dai_in] = 10,
	[snd_soc_dapm_dai_out] = 10,
111 112
	[snd_soc_dapm_dai_link] = 11,
	[snd_soc_dapm_supply] = 12,
113 114 115
	[snd_soc_dapm_clock_supply] = 13,
	[snd_soc_dapm_regulator_supply] = 13,
	[snd_soc_dapm_post] = 14,
116 117
};

118
static void pop_wait(u32 pop_time)
119 120 121 122 123
{
	if (pop_time)
		schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
}

124
static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
125 126
{
	va_list args;
127
	char *buf;
128

129 130
	if (!pop_time)
		return;
131

132 133 134
	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
	if (buf == NULL)
		return;
135

136 137
	va_start(args, fmt);
	vsnprintf(buf, PAGE_SIZE, fmt, args);
138
	dev_info(dev, "%s", buf);
139
	va_end(args);
140 141

	kfree(buf);
142 143
}

144 145 146 147 148
static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w)
{
	return !list_empty(&w->dirty);
}

149
void dapm_mark_dirty(struct snd_soc_dapm_widget *w, const char *reason)
150
{
151 152 153
	if (!dapm_dirty_widget(w)) {
		dev_vdbg(w->dapm->dev, "Marking %s dirty due to %s\n",
			 w->name, reason);
154
		list_add_tail(&w->dirty, &w->dapm->card->dapm_dirty);
155
	}
156
}
157
EXPORT_SYMBOL_GPL(dapm_mark_dirty);
158

159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180
void dapm_mark_io_dirty(struct snd_soc_dapm_context *dapm)
{
	struct snd_soc_card *card = dapm->card;
	struct snd_soc_dapm_widget *w;

	mutex_lock(&card->dapm_mutex);

	list_for_each_entry(w, &card->widgets, list) {
		switch (w->id) {
		case snd_soc_dapm_input:
		case snd_soc_dapm_output:
			dapm_mark_dirty(w, "Rechecking inputs and outputs");
			break;
		default:
			break;
		}
	}

	mutex_unlock(&card->dapm_mutex);
}
EXPORT_SYMBOL_GPL(dapm_mark_io_dirty);

181
/* create a new dapm widget */
182
static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
183 184
	const struct snd_soc_dapm_widget *_widget)
{
185
	return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
186 187
}

188
struct dapm_kcontrol_data {
189
	unsigned int value;
190
	struct snd_soc_dapm_widget *widget;
191
	struct list_head paths;
192
	struct snd_soc_dapm_widget_list *wlist;
193 194 195 196 197 198
};

static int dapm_kcontrol_data_alloc(struct snd_soc_dapm_widget *widget,
	struct snd_kcontrol *kcontrol)
{
	struct dapm_kcontrol_data *data;
199
	struct soc_mixer_control *mc;
200

201
	data = kzalloc(sizeof(*data), GFP_KERNEL);
202 203 204 205 206 207 208
	if (!data) {
		dev_err(widget->dapm->dev,
				"ASoC: can't allocate kcontrol data for %s\n",
				widget->name);
		return -ENOMEM;
	}

209
	INIT_LIST_HEAD(&data->paths);
210

211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231
	switch (widget->id) {
	case snd_soc_dapm_switch:
	case snd_soc_dapm_mixer:
	case snd_soc_dapm_mixer_named_ctl:
		mc = (struct soc_mixer_control *)kcontrol->private_value;

		if (mc->autodisable) {
			struct snd_soc_dapm_widget template;

			memset(&template, 0, sizeof(template));
			template.reg = mc->reg;
			template.mask = (1 << fls(mc->max)) - 1;
			template.shift = mc->shift;
			if (mc->invert)
				template.off_val = mc->max;
			else
				template.off_val = 0;
			template.on_val = template.off_val;
			template.id = snd_soc_dapm_kcontrol;
			template.name = kcontrol->id.name;

232 233
			data->value = template.on_val;

234 235 236 237 238 239 240 241 242 243 244 245
			data->widget = snd_soc_dapm_new_control(widget->dapm,
				&template);
			if (!data->widget) {
				kfree(data);
				return -ENOMEM;
			}
		}
		break;
	default:
		break;
	}

246 247 248 249 250 251 252 253
	kcontrol->private_data = data;

	return 0;
}

static void dapm_kcontrol_free(struct snd_kcontrol *kctl)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kctl);
254
	kfree(data->widget);
255
	kfree(data->wlist);
256 257 258 259 260 261 262 263
	kfree(data);
}

static struct snd_soc_dapm_widget_list *dapm_kcontrol_get_wlist(
	const struct snd_kcontrol *kcontrol)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);

264
	return data->wlist;
265 266 267 268 269 270
}

static int dapm_kcontrol_add_widget(struct snd_kcontrol *kcontrol,
	struct snd_soc_dapm_widget *widget)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);
271 272
	struct snd_soc_dapm_widget_list *new_wlist;
	unsigned int n;
273

274 275 276 277 278 279 280 281
	if (data->wlist)
		n = data->wlist->num_widgets + 1;
	else
		n = 1;

	new_wlist = krealloc(data->wlist,
			sizeof(*new_wlist) + sizeof(widget) * n, GFP_KERNEL);
	if (!new_wlist)
282 283
		return -ENOMEM;

284 285
	new_wlist->widgets[n - 1] = widget;
	new_wlist->num_widgets = n;
286

287
	data->wlist = new_wlist;
288 289 290 291

	return 0;
}

292 293 294 295 296 297
static void dapm_kcontrol_add_path(const struct snd_kcontrol *kcontrol,
	struct snd_soc_dapm_path *path)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);

	list_add_tail(&path->list_kcontrol, &data->paths);
298 299 300 301 302 303 304 305 306 307 308 309 310 311 312

	if (data->widget) {
		snd_soc_dapm_add_path(data->widget->dapm, data->widget,
		    path->source, NULL, NULL);
	}
}

static bool dapm_kcontrol_is_powered(const struct snd_kcontrol *kcontrol)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);

	if (!data->widget)
		return true;

	return data->widget->power;
313 314 315 316 317 318 319 320 321 322 323 324 325 326
}

static struct list_head *dapm_kcontrol_get_path_list(
	const struct snd_kcontrol *kcontrol)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);

	return &data->paths;
}

#define dapm_kcontrol_for_each_path(path, kcontrol) \
	list_for_each_entry(path, dapm_kcontrol_get_path_list(kcontrol), \
		list_kcontrol)

327 328 329 330 331 332 333 334 335 336 337 338 339 340 341
static unsigned int dapm_kcontrol_get_value(const struct snd_kcontrol *kcontrol)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);

	return data->value;
}

static bool dapm_kcontrol_set_value(const struct snd_kcontrol *kcontrol,
	unsigned int value)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);

	if (data->value == value)
		return false;

342 343 344
	if (data->widget)
		data->widget->on_val = value;

345 346 347 348 349
	data->value = value;

	return true;
}

350 351 352 353 354 355
/**
 * snd_soc_dapm_kcontrol_codec() - Returns the codec associated to a kcontrol
 * @kcontrol: The kcontrol
 */
struct snd_soc_codec *snd_soc_dapm_kcontrol_codec(struct snd_kcontrol *kcontrol)
{
356
	return dapm_kcontrol_get_wlist(kcontrol)->widgets[0]->codec;
357 358 359
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_kcontrol_codec);

360 361 362 363 364 365 366
static void dapm_reset(struct snd_soc_card *card)
{
	struct snd_soc_dapm_widget *w;

	memset(&card->dapm_stats, 0, sizeof(card->dapm_stats));

	list_for_each_entry(w, &card->widgets, list) {
367
		w->new_power = w->power;
368 369 370 371 372 373
		w->power_checked = false;
		w->inputs = -1;
		w->outputs = -1;
	}
}

374 375 376 377
static int soc_widget_read(struct snd_soc_dapm_widget *w, int reg)
{
	if (w->codec)
		return snd_soc_read(w->codec, reg);
378 379 380
	else if (w->platform)
		return snd_soc_platform_read(w->platform, reg);

381
	dev_err(w->dapm->dev, "ASoC: no valid widget read method\n");
382
	return -1;
383 384 385 386 387 388
}

static int soc_widget_write(struct snd_soc_dapm_widget *w, int reg, int val)
{
	if (w->codec)
		return snd_soc_write(w->codec, reg, val);
389 390 391
	else if (w->platform)
		return snd_soc_platform_write(w->platform, reg, val);

392
	dev_err(w->dapm->dev, "ASoC: no valid widget write method\n");
393
	return -1;
394 395
}

396 397
static inline void soc_widget_lock(struct snd_soc_dapm_widget *w)
{
398
	if (w->codec && !w->codec->using_regmap)
399 400 401 402 403 404 405
		mutex_lock(&w->codec->mutex);
	else if (w->platform)
		mutex_lock(&w->platform->mutex);
}

static inline void soc_widget_unlock(struct snd_soc_dapm_widget *w)
{
406
	if (w->codec && !w->codec->using_regmap)
407 408 409 410 411
		mutex_unlock(&w->codec->mutex);
	else if (w->platform)
		mutex_unlock(&w->platform->mutex);
}

412 413 414 415 416 417
static void soc_dapm_async_complete(struct snd_soc_dapm_context *dapm)
{
	if (dapm->codec && dapm->codec->using_regmap)
		regmap_async_complete(dapm->codec->control_data);
}

418
static int soc_widget_update_bits_locked(struct snd_soc_dapm_widget *w,
419 420
	unsigned short reg, unsigned int mask, unsigned int value)
{
421
	bool change;
422 423 424
	unsigned int old, new;
	int ret;

425
	if (w->codec && w->codec->using_regmap) {
426 427 428
		ret = regmap_update_bits_check_async(w->codec->control_data,
						     reg, mask, value,
						     &change);
429 430 431
		if (ret != 0)
			return ret;
	} else {
432
		soc_widget_lock(w);
433
		ret = soc_widget_read(w, reg);
434 435
		if (ret < 0) {
			soc_widget_unlock(w);
436
			return ret;
437
		}
438 439 440 441 442 443

		old = ret;
		new = (old & ~mask) | (value & mask);
		change = old != new;
		if (change) {
			ret = soc_widget_write(w, reg, new);
444 445
			if (ret < 0) {
				soc_widget_unlock(w);
446
				return ret;
447
			}
448
		}
449
		soc_widget_unlock(w);
450 451 452 453 454
	}

	return change;
}

455 456
/**
 * snd_soc_dapm_set_bias_level - set the bias level for the system
457
 * @dapm: DAPM context
458 459 460 461 462 463
 * @level: level to configure
 *
 * Configure the bias (power) levels for the SoC audio device.
 *
 * Returns 0 for success else error.
 */
464
static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
L
Liam Girdwood 已提交
465
				       enum snd_soc_bias_level level)
466
{
467
	struct snd_soc_card *card = dapm->card;
468 469
	int ret = 0;

M
Mark Brown 已提交
470 471
	trace_snd_soc_bias_level_start(card, level);

472
	if (card && card->set_bias_level)
473
		ret = card->set_bias_level(card, dapm, level);
474 475 476
	if (ret != 0)
		goto out;

477 478 479 480
	if (dapm->codec) {
		if (dapm->codec->driver->set_bias_level)
			ret = dapm->codec->driver->set_bias_level(dapm->codec,
								  level);
481 482
		else
			dapm->bias_level = level;
483
	} else if (!card || dapm != &card->dapm) {
484
		dapm->bias_level = level;
485
	}
486

487 488 489 490
	if (ret != 0)
		goto out;

	if (card && card->set_bias_level_post)
491
		ret = card->set_bias_level_post(card, dapm, level);
492
out:
M
Mark Brown 已提交
493 494
	trace_snd_soc_bias_level_done(card, level);

495 496 497
	return ret;
}

498 499 500 501 502 503
/* set up initial codec paths */
static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
	struct snd_soc_dapm_path *p, int i)
{
	switch (w->id) {
	case snd_soc_dapm_switch:
504 505
	case snd_soc_dapm_mixer:
	case snd_soc_dapm_mixer_named_ctl: {
506
		int val;
507
		struct soc_mixer_control *mc = (struct soc_mixer_control *)
508
			w->kcontrol_news[i].private_value;
509
		int reg = mc->reg;
510
		unsigned int shift = mc->shift;
511
		int max = mc->max;
512 513
		unsigned int mask = (1 << fls(max)) - 1;
		unsigned int invert = mc->invert;
514

515 516 517 518 519 520 521 522 523
		if (reg != SND_SOC_NOPM) {
			val = soc_widget_read(w, reg);
			val = (val >> shift) & mask;
			if (invert)
				val = max - val;
			p->connect = !!val;
		} else {
			p->connect = 0;
		}
524 525 526 527

	}
	break;
	case snd_soc_dapm_mux: {
528 529
		struct soc_enum *e = (struct soc_enum *)
			w->kcontrol_news[i].private_value;
530
		int val, item;
531

532
		val = soc_widget_read(w, e->reg);
533
		item = (val >> e->shift_l) & e->mask;
534

535 536 537 538
		if (item < e->max && !strcmp(p->name, e->texts[item]))
			p->connect = 1;
		else
			p->connect = 0;
539 540
	}
	break;
541
	case snd_soc_dapm_virt_mux: {
542 543
		struct soc_enum *e = (struct soc_enum *)
			w->kcontrol_news[i].private_value;
544 545 546 547 548 549 550 551 552 553 554 555

		p->connect = 0;
		/* since a virtual mux has no backing registers to
		 * decide which path to connect, it will try to match
		 * with the first enumeration.  This is to ensure
		 * that the default mux choice (the first) will be
		 * correctly powered up during initialization.
		 */
		if (!strcmp(p->name, e->texts[0]))
			p->connect = 1;
	}
	break;
P
Peter Ujfalusi 已提交
556
	case snd_soc_dapm_value_mux: {
557
		struct soc_enum *e = (struct soc_enum *)
558
			w->kcontrol_news[i].private_value;
P
Peter Ujfalusi 已提交
559 560
		int val, item;

561
		val = soc_widget_read(w, e->reg);
P
Peter Ujfalusi 已提交
562 563 564 565 566 567
		val = (val >> e->shift_l) & e->mask;
		for (item = 0; item < e->max; item++) {
			if (val == e->values[item])
				break;
		}

568 569 570 571
		if (item < e->max && !strcmp(p->name, e->texts[item]))
			p->connect = 1;
		else
			p->connect = 0;
P
Peter Ujfalusi 已提交
572 573
	}
	break;
574
	/* does not affect routing - always connected */
575
	case snd_soc_dapm_pga:
576
	case snd_soc_dapm_out_drv:
577 578 579
	case snd_soc_dapm_output:
	case snd_soc_dapm_adc:
	case snd_soc_dapm_input:
580
	case snd_soc_dapm_siggen:
581 582 583
	case snd_soc_dapm_dac:
	case snd_soc_dapm_micbias:
	case snd_soc_dapm_vmid:
584
	case snd_soc_dapm_supply:
585
	case snd_soc_dapm_regulator_supply:
586
	case snd_soc_dapm_clock_supply:
587 588
	case snd_soc_dapm_aif_in:
	case snd_soc_dapm_aif_out:
589 590
	case snd_soc_dapm_dai_in:
	case snd_soc_dapm_dai_out:
591 592 593 594
	case snd_soc_dapm_hp:
	case snd_soc_dapm_mic:
	case snd_soc_dapm_spk:
	case snd_soc_dapm_line:
595
	case snd_soc_dapm_dai_link:
596
	case snd_soc_dapm_kcontrol:
597 598 599
		p->connect = 1;
	break;
	/* does affect routing - dynamically connected */
600 601 602 603 604 605 606
	case snd_soc_dapm_pre:
	case snd_soc_dapm_post:
		p->connect = 0;
	break;
	}
}

M
Mark Brown 已提交
607
/* connect mux widget to its interconnecting audio paths */
L
Liam Girdwood 已提交
608
static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
609 610 611 612 613 614 615
	struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
	struct snd_soc_dapm_path *path, const char *control_name,
	const struct snd_kcontrol_new *kcontrol)
{
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
	int i;

616
	for (i = 0; i < e->max; i++) {
617
		if (!(strcmp(control_name, e->texts[i]))) {
618
			list_add(&path->list, &dapm->card->paths);
619 620 621 622 623 624 625 626 627 628 629
			list_add(&path->list_sink, &dest->sources);
			list_add(&path->list_source, &src->sinks);
			path->name = (char*)e->texts[i];
			dapm_set_path_status(dest, path, 0);
			return 0;
		}
	}

	return -ENODEV;
}

M
Mark Brown 已提交
630
/* connect mixer widget to its interconnecting audio paths */
L
Liam Girdwood 已提交
631
static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
632 633 634 635 636 637 638
	struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
	struct snd_soc_dapm_path *path, const char *control_name)
{
	int i;

	/* search for mixer kcontrol */
	for (i = 0; i < dest->num_kcontrols; i++) {
639
		if (!strcmp(control_name, dest->kcontrol_news[i].name)) {
640
			list_add(&path->list, &dapm->card->paths);
641 642
			list_add(&path->list_sink, &dest->sources);
			list_add(&path->list_source, &src->sinks);
643
			path->name = dest->kcontrol_news[i].name;
644 645 646 647 648 649 650
			dapm_set_path_status(dest, path, i);
			return 0;
		}
	}
	return -ENODEV;
}

651
static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
652
	struct snd_soc_dapm_widget *kcontrolw,
653 654 655 656 657 658 659 660 661
	const struct snd_kcontrol_new *kcontrol_new,
	struct snd_kcontrol **kcontrol)
{
	struct snd_soc_dapm_widget *w;
	int i;

	*kcontrol = NULL;

	list_for_each_entry(w, &dapm->card->widgets, list) {
662 663
		if (w == kcontrolw || w->dapm != kcontrolw->dapm)
			continue;
664 665 666 667 668 669 670 671 672 673 674 675
		for (i = 0; i < w->num_kcontrols; i++) {
			if (&w->kcontrol_news[i] == kcontrol_new) {
				if (w->kcontrols)
					*kcontrol = w->kcontrols[i];
				return 1;
			}
		}
	}

	return 0;
}

676 677 678 679 680
/*
 * Determine if a kcontrol is shared. If it is, look it up. If it isn't,
 * create it. Either way, add the widget into the control's widget list
 */
static int dapm_create_or_share_mixmux_kcontrol(struct snd_soc_dapm_widget *w,
681
	int kci)
682
{
683
	struct snd_soc_dapm_context *dapm = w->dapm;
684
	struct snd_card *card = dapm->card->snd_card;
685
	const char *prefix;
686 687 688 689 690 691 692
	size_t prefix_len;
	int shared;
	struct snd_kcontrol *kcontrol;
	bool wname_in_long_name, kcname_in_long_name;
	char *long_name;
	const char *name;
	int ret;
693 694 695 696 697

	if (dapm->codec)
		prefix = dapm->codec->name_prefix;
	else
		prefix = NULL;
698

699 700 701 702 703
	if (prefix)
		prefix_len = strlen(prefix) + 1;
	else
		prefix_len = 0;

704 705
	shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[kci],
					 &kcontrol);
706

707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729
	if (!kcontrol) {
		if (shared) {
			wname_in_long_name = false;
			kcname_in_long_name = true;
		} else {
			switch (w->id) {
			case snd_soc_dapm_switch:
			case snd_soc_dapm_mixer:
				wname_in_long_name = true;
				kcname_in_long_name = true;
				break;
			case snd_soc_dapm_mixer_named_ctl:
				wname_in_long_name = false;
				kcname_in_long_name = true;
				break;
			case snd_soc_dapm_mux:
			case snd_soc_dapm_virt_mux:
			case snd_soc_dapm_value_mux:
				wname_in_long_name = true;
				kcname_in_long_name = false;
				break;
			default:
				return -EINVAL;
730
			}
731 732 733 734 735 736 737 738
		}

		if (wname_in_long_name && kcname_in_long_name) {
			/*
			 * The control will get a prefix from the control
			 * creation process but we're also using the same
			 * prefix for widgets so cut the prefix off the
			 * front of the widget name.
739
			 */
740
			long_name = kasprintf(GFP_KERNEL, "%s %s",
741 742
				 w->name + prefix_len,
				 w->kcontrol_news[kci].name);
743
			if (long_name == NULL)
744
				return -ENOMEM;
745 746 747 748 749 750 751 752 753

			name = long_name;
		} else if (wname_in_long_name) {
			long_name = NULL;
			name = w->name + prefix_len;
		} else {
			long_name = NULL;
			name = w->kcontrol_news[kci].name;
		}
754

755
		kcontrol = snd_soc_cnew(&w->kcontrol_news[kci], NULL, name,
756
					prefix);
757
		kfree(long_name);
758 759 760
		if (!kcontrol)
			return -ENOMEM;
		kcontrol->private_free = dapm_kcontrol_free;
761 762 763 764 765 766 767

		ret = dapm_kcontrol_data_alloc(w, kcontrol);
		if (ret) {
			snd_ctl_free_one(kcontrol);
			return ret;
		}

768 769 770 771 772 773 774 775
		ret = snd_ctl_add(card, kcontrol);
		if (ret < 0) {
			dev_err(dapm->dev,
				"ASoC: failed to add widget %s dapm kcontrol %s: %d\n",
				w->name, name, ret);
			return ret;
		}
	}
776

777 778 779 780
	ret = dapm_kcontrol_add_widget(kcontrol, w);
	if (ret)
		return ret;

781
	w->kcontrols[kci] = kcontrol;
782

783 784
	return 0;
}
785

786 787 788 789 790 791 792 793 794 795 796 797 798 799 800
/* create new dapm mixer control */
static int dapm_new_mixer(struct snd_soc_dapm_widget *w)
{
	int i, ret;
	struct snd_soc_dapm_path *path;

	/* add kcontrol */
	for (i = 0; i < w->num_kcontrols; i++) {
		/* match name */
		list_for_each_entry(path, &w->sources, list_sink) {
			/* mixer/mux paths name must match control name */
			if (path->name != (char *)w->kcontrol_news[i].name)
				continue;

			if (w->kcontrols[i]) {
801
				dapm_kcontrol_add_path(w->kcontrols[i], path);
802
				continue;
803
			}
804

805
			ret = dapm_create_or_share_mixmux_kcontrol(w, i);
806 807
			if (ret < 0)
				return ret;
808 809

			dapm_kcontrol_add_path(w->kcontrols[i], path);
810 811
		}
	}
812 813

	return 0;
814 815 816
}

/* create new dapm mux control */
817
static int dapm_new_mux(struct snd_soc_dapm_widget *w)
818
{
819
	struct snd_soc_dapm_context *dapm = w->dapm;
820
	struct snd_soc_dapm_path *path;
821
	int ret;
822

823 824
	if (w->num_kcontrols != 1) {
		dev_err(dapm->dev,
825
			"ASoC: mux %s has incorrect number of controls\n",
826
			w->name);
827 828 829
		return -EINVAL;
	}

830
	if (list_empty(&w->sources)) {
831 832
		dev_err(dapm->dev, "ASoC: mux %s has no paths\n", w->name);
		return -EINVAL;
833
	}
L
Liam Girdwood 已提交
834

835
	ret = dapm_create_or_share_mixmux_kcontrol(w, 0);
836 837
	if (ret < 0)
		return ret;
838

839
	list_for_each_entry(path, &w->sources, list_sink)
840
		dapm_kcontrol_add_path(w->kcontrols[0], path);
841

842
	return 0;
843 844 845
}

/* create new dapm volume control */
846
static int dapm_new_pga(struct snd_soc_dapm_widget *w)
847
{
848
	if (w->num_kcontrols)
849
		dev_err(w->dapm->dev,
850
			"ASoC: PGA controls not supported: '%s'\n", w->name);
851

852
	return 0;
853 854 855
}

/* reset 'walked' bit for each dapm path */
856 857
static void dapm_clear_walk_output(struct snd_soc_dapm_context *dapm,
				   struct list_head *sink)
858 859 860
{
	struct snd_soc_dapm_path *p;

861 862 863 864 865 866
	list_for_each_entry(p, sink, list_source) {
		if (p->walked) {
			p->walked = 0;
			dapm_clear_walk_output(dapm, &p->sink->sinks);
		}
	}
867 868
}

869 870
static void dapm_clear_walk_input(struct snd_soc_dapm_context *dapm,
				  struct list_head *source)
871 872 873
{
	struct snd_soc_dapm_path *p;

874 875 876 877 878 879
	list_for_each_entry(p, source, list_sink) {
		if (p->walked) {
			p->walked = 0;
			dapm_clear_walk_input(dapm, &p->source->sources);
		}
	}
880 881
}

882

883 884 885 886 887 888
/* We implement power down on suspend by checking the power state of
 * the ALSA card - when we are suspending the ALSA state for the card
 * is set to D3.
 */
static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget)
{
889
	int level = snd_power_get_state(widget->dapm->card->snd_card);
890

891
	switch (level) {
892 893
	case SNDRV_CTL_POWER_D3hot:
	case SNDRV_CTL_POWER_D3cold:
894
		if (widget->ignore_suspend)
895
			dev_dbg(widget->dapm->dev, "ASoC: %s ignoring suspend\n",
896
				widget->name);
897
		return widget->ignore_suspend;
898 899 900 901 902
	default:
		return 1;
	}
}

903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926
/* add widget to list if it's not already in the list */
static int dapm_list_add_widget(struct snd_soc_dapm_widget_list **list,
	struct snd_soc_dapm_widget *w)
{
	struct snd_soc_dapm_widget_list *wlist;
	int wlistsize, wlistentries, i;

	if (*list == NULL)
		return -EINVAL;

	wlist = *list;

	/* is this widget already in the list */
	for (i = 0; i < wlist->num_widgets; i++) {
		if (wlist->widgets[i] == w)
			return 0;
	}

	/* allocate some new space */
	wlistentries = wlist->num_widgets + 1;
	wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
			wlistentries * sizeof(struct snd_soc_dapm_widget *);
	*list = krealloc(wlist, wlistsize, GFP_KERNEL);
	if (*list == NULL) {
927
		dev_err(w->dapm->dev, "ASoC: can't allocate widget list for %s\n",
928 929 930 931 932 933
			w->name);
		return -ENOMEM;
	}
	wlist = *list;

	/* insert the widget */
934
	dev_dbg(w->dapm->dev, "ASoC: added %s in widget list pos %d\n",
935 936 937 938 939 940 941
			w->name, wlist->num_widgets);

	wlist->widgets[wlist->num_widgets] = w;
	wlist->num_widgets++;
	return 1;
}

942 943 944 945
/*
 * Recursively check for a completed path to an active or physically connected
 * output widget. Returns number of complete paths.
 */
946 947
static int is_connected_output_ep(struct snd_soc_dapm_widget *widget,
	struct snd_soc_dapm_widget_list **list)
948 949 950 951
{
	struct snd_soc_dapm_path *path;
	int con = 0;

952 953 954
	if (widget->outputs >= 0)
		return widget->outputs;

955 956
	DAPM_UPDATE_STAT(widget, path_checks);

957 958 959
	switch (widget->id) {
	case snd_soc_dapm_supply:
	case snd_soc_dapm_regulator_supply:
960
	case snd_soc_dapm_clock_supply:
961
	case snd_soc_dapm_kcontrol:
962
		return 0;
963 964 965
	default:
		break;
	}
966

967 968 969
	switch (widget->id) {
	case snd_soc_dapm_adc:
	case snd_soc_dapm_aif_out:
970
	case snd_soc_dapm_dai_out:
971 972 973 974
		if (widget->active) {
			widget->outputs = snd_soc_dapm_suspend_check(widget);
			return widget->outputs;
		}
975 976 977
	default:
		break;
	}
978 979 980

	if (widget->connected) {
		/* connected pin ? */
981 982 983 984
		if (widget->id == snd_soc_dapm_output && !widget->ext) {
			widget->outputs = snd_soc_dapm_suspend_check(widget);
			return widget->outputs;
		}
985 986

		/* connected jack or spk ? */
987 988 989 990 991 992 993
		if (widget->id == snd_soc_dapm_hp ||
		    widget->id == snd_soc_dapm_spk ||
		    (widget->id == snd_soc_dapm_line &&
		     !list_empty(&widget->sources))) {
			widget->outputs = snd_soc_dapm_suspend_check(widget);
			return widget->outputs;
		}
994 995 996
	}

	list_for_each_entry(path, &widget->sinks, list_source) {
997 998
		DAPM_UPDATE_STAT(widget, neighbour_checks);

999 1000 1001
		if (path->weak)
			continue;

M
Mark Brown 已提交
1002 1003 1004
		if (path->walking)
			return 1;

1005 1006 1007
		if (path->walked)
			continue;

1008 1009
		trace_snd_soc_dapm_output_path(widget, path);

1010 1011
		if (path->sink && path->connect) {
			path->walked = 1;
M
Mark Brown 已提交
1012
			path->walking = 1;
1013 1014 1015 1016 1017 1018

			/* do we need to add this widget to the list ? */
			if (list) {
				int err;
				err = dapm_list_add_widget(list, path->sink);
				if (err < 0) {
1019 1020
					dev_err(widget->dapm->dev,
						"ASoC: could not add widget %s\n",
1021
						widget->name);
M
Mark Brown 已提交
1022
					path->walking = 0;
1023 1024 1025 1026 1027
					return con;
				}
			}

			con += is_connected_output_ep(path->sink, list);
M
Mark Brown 已提交
1028 1029

			path->walking = 0;
1030 1031 1032
		}
	}

1033 1034
	widget->outputs = con;

1035 1036 1037 1038 1039 1040 1041
	return con;
}

/*
 * Recursively check for a completed path to an active or physically connected
 * input widget. Returns number of complete paths.
 */
1042 1043
static int is_connected_input_ep(struct snd_soc_dapm_widget *widget,
	struct snd_soc_dapm_widget_list **list)
1044 1045 1046 1047
{
	struct snd_soc_dapm_path *path;
	int con = 0;

1048 1049 1050
	if (widget->inputs >= 0)
		return widget->inputs;

1051 1052
	DAPM_UPDATE_STAT(widget, path_checks);

1053 1054 1055
	switch (widget->id) {
	case snd_soc_dapm_supply:
	case snd_soc_dapm_regulator_supply:
1056
	case snd_soc_dapm_clock_supply:
1057
	case snd_soc_dapm_kcontrol:
1058
		return 0;
1059 1060 1061
	default:
		break;
	}
1062

1063
	/* active stream ? */
1064 1065 1066
	switch (widget->id) {
	case snd_soc_dapm_dac:
	case snd_soc_dapm_aif_in:
1067
	case snd_soc_dapm_dai_in:
1068 1069 1070 1071
		if (widget->active) {
			widget->inputs = snd_soc_dapm_suspend_check(widget);
			return widget->inputs;
		}
1072 1073 1074
	default:
		break;
	}
1075 1076 1077

	if (widget->connected) {
		/* connected pin ? */
1078 1079 1080 1081
		if (widget->id == snd_soc_dapm_input && !widget->ext) {
			widget->inputs = snd_soc_dapm_suspend_check(widget);
			return widget->inputs;
		}
1082 1083

		/* connected VMID/Bias for lower pops */
1084 1085 1086 1087
		if (widget->id == snd_soc_dapm_vmid) {
			widget->inputs = snd_soc_dapm_suspend_check(widget);
			return widget->inputs;
		}
1088 1089

		/* connected jack ? */
1090
		if (widget->id == snd_soc_dapm_mic ||
1091 1092 1093 1094 1095 1096
		    (widget->id == snd_soc_dapm_line &&
		     !list_empty(&widget->sinks))) {
			widget->inputs = snd_soc_dapm_suspend_check(widget);
			return widget->inputs;
		}

1097 1098 1099 1100 1101
		/* signal generator */
		if (widget->id == snd_soc_dapm_siggen) {
			widget->inputs = snd_soc_dapm_suspend_check(widget);
			return widget->inputs;
		}
1102 1103 1104
	}

	list_for_each_entry(path, &widget->sources, list_sink) {
1105 1106
		DAPM_UPDATE_STAT(widget, neighbour_checks);

1107 1108 1109
		if (path->weak)
			continue;

M
Mark Brown 已提交
1110 1111 1112
		if (path->walking)
			return 1;

1113 1114 1115
		if (path->walked)
			continue;

1116 1117
		trace_snd_soc_dapm_input_path(widget, path);

1118 1119
		if (path->source && path->connect) {
			path->walked = 1;
M
Mark Brown 已提交
1120
			path->walking = 1;
1121 1122 1123 1124

			/* do we need to add this widget to the list ? */
			if (list) {
				int err;
1125
				err = dapm_list_add_widget(list, path->source);
1126
				if (err < 0) {
1127 1128
					dev_err(widget->dapm->dev,
						"ASoC: could not add widget %s\n",
1129
						widget->name);
M
Mark Brown 已提交
1130
					path->walking = 0;
1131 1132 1133 1134 1135
					return con;
				}
			}

			con += is_connected_input_ep(path->source, list);
M
Mark Brown 已提交
1136 1137

			path->walking = 0;
1138 1139 1140
		}
	}

1141 1142
	widget->inputs = con;

1143 1144 1145
	return con;
}

1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166
/**
 * snd_soc_dapm_get_connected_widgets - query audio path and it's widgets.
 * @dai: the soc DAI.
 * @stream: stream direction.
 * @list: list of active widgets for this stream.
 *
 * Queries DAPM graph as to whether an valid audio stream path exists for
 * the initial stream specified by name. This takes into account
 * current mixer and mux kcontrol settings. Creates list of valid widgets.
 *
 * Returns the number of valid paths or negative error.
 */
int snd_soc_dapm_dai_get_connected_widgets(struct snd_soc_dai *dai, int stream,
	struct snd_soc_dapm_widget_list **list)
{
	struct snd_soc_card *card = dai->card;
	int paths;

	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
	dapm_reset(card);

1167
	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
1168
		paths = is_connected_output_ep(dai->playback_widget, list);
1169 1170 1171
		dapm_clear_walk_output(&card->dapm,
				       &dai->playback_widget->sinks);
	} else {
1172
		paths = is_connected_input_ep(dai->capture_widget, list);
1173 1174 1175
		dapm_clear_walk_input(&card->dapm,
				      &dai->capture_widget->sources);
	}
1176 1177 1178 1179 1180 1181 1182

	trace_snd_soc_dapm_connected(paths, stream);
	mutex_unlock(&card->dapm_mutex);

	return paths;
}

1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195
/*
 * Handler for generic register modifier widget.
 */
int dapm_reg_event(struct snd_soc_dapm_widget *w,
		   struct snd_kcontrol *kcontrol, int event)
{
	unsigned int val;

	if (SND_SOC_DAPM_EVENT_ON(event))
		val = w->on_val;
	else
		val = w->off_val;

1196
	soc_widget_update_bits_locked(w, -(w->reg + 1),
1197 1198 1199 1200
			    w->mask << w->shift, val << w->shift);

	return 0;
}
1201
EXPORT_SYMBOL_GPL(dapm_reg_event);
1202

1203 1204 1205 1206 1207 1208
/*
 * Handler for regulator supply widget.
 */
int dapm_regulator_event(struct snd_soc_dapm_widget *w,
		   struct snd_kcontrol *kcontrol, int event)
{
1209 1210
	int ret;

1211 1212
	soc_dapm_async_complete(w->dapm);

1213
	if (SND_SOC_DAPM_EVENT_ON(event)) {
1214
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
1215
			ret = regulator_allow_bypass(w->regulator, false);
1216 1217
			if (ret != 0)
				dev_warn(w->dapm->dev,
1218
					 "ASoC: Failed to bypass %s: %d\n",
1219 1220 1221
					 w->name, ret);
		}

1222
		return regulator_enable(w->regulator);
1223
	} else {
1224
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
1225
			ret = regulator_allow_bypass(w->regulator, true);
1226 1227
			if (ret != 0)
				dev_warn(w->dapm->dev,
1228
					 "ASoC: Failed to unbypass %s: %d\n",
1229 1230 1231
					 w->name, ret);
		}

1232
		return regulator_disable_deferred(w->regulator, w->shift);
1233
	}
1234 1235 1236
}
EXPORT_SYMBOL_GPL(dapm_regulator_event);

1237 1238 1239 1240 1241 1242 1243 1244 1245
/*
 * Handler for clock supply widget.
 */
int dapm_clock_event(struct snd_soc_dapm_widget *w,
		   struct snd_kcontrol *kcontrol, int event)
{
	if (!w->clk)
		return -EIO;

1246 1247
	soc_dapm_async_complete(w->dapm);

1248
#ifdef CONFIG_HAVE_CLK
1249
	if (SND_SOC_DAPM_EVENT_ON(event)) {
1250
		return clk_prepare_enable(w->clk);
1251
	} else {
1252
		clk_disable_unprepare(w->clk);
1253 1254
		return 0;
	}
1255
#endif
1256
	return 0;
1257 1258 1259
}
EXPORT_SYMBOL_GPL(dapm_clock_event);

1260 1261
static int dapm_widget_power_check(struct snd_soc_dapm_widget *w)
{
1262 1263 1264
	if (w->power_checked)
		return w->new_power;

1265
	if (w->force)
1266
		w->new_power = 1;
1267
	else
1268 1269 1270 1271 1272
		w->new_power = w->power_check(w);

	w->power_checked = true;

	return w->new_power;
1273 1274
}

1275 1276 1277 1278 1279 1280
/* Generic check to see if a widget should be powered.
 */
static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
{
	int in, out;

1281 1282
	DAPM_UPDATE_STAT(w, power_checks);

1283
	in = is_connected_input_ep(w, NULL);
1284
	dapm_clear_walk_input(w->dapm, &w->sources);
1285
	out = is_connected_output_ep(w, NULL);
1286
	dapm_clear_walk_output(w->dapm, &w->sinks);
1287 1288 1289
	return out != 0 && in != 0;
}

1290 1291 1292 1293 1294
/* Check to see if an ADC has power */
static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
{
	int in;

1295 1296
	DAPM_UPDATE_STAT(w, power_checks);

1297
	if (w->active) {
1298
		in = is_connected_input_ep(w, NULL);
1299
		dapm_clear_walk_input(w->dapm, &w->sources);
1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310
		return in != 0;
	} else {
		return dapm_generic_check_power(w);
	}
}

/* Check to see if a DAC has power */
static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
{
	int out;

1311 1312
	DAPM_UPDATE_STAT(w, power_checks);

1313
	if (w->active) {
1314
		out = is_connected_output_ep(w, NULL);
1315
		dapm_clear_walk_output(w->dapm, &w->sinks);
1316 1317 1318 1319 1320 1321
		return out != 0;
	} else {
		return dapm_generic_check_power(w);
	}
}

1322 1323 1324 1325 1326
/* Check to see if a power supply is needed */
static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
{
	struct snd_soc_dapm_path *path;

1327 1328
	DAPM_UPDATE_STAT(w, power_checks);

1329 1330
	/* Check if one of our outputs is connected */
	list_for_each_entry(path, &w->sinks, list_source) {
1331 1332
		DAPM_UPDATE_STAT(w, neighbour_checks);

1333 1334 1335
		if (path->weak)
			continue;

1336 1337 1338 1339
		if (path->connected &&
		    !path->connected(path->source, path->sink))
			continue;

1340 1341 1342
		if (!path->sink)
			continue;

1343 1344
		if (dapm_widget_power_check(path->sink))
			return 1;
1345 1346
	}

1347
	return 0;
1348 1349
}

1350 1351 1352 1353 1354
static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w)
{
	return 1;
}

1355 1356
static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
			    struct snd_soc_dapm_widget *b,
1357
			    bool power_up)
1358
{
1359 1360 1361 1362 1363 1364 1365
	int *sort;

	if (power_up)
		sort = dapm_up_seq;
	else
		sort = dapm_down_seq;

1366 1367
	if (sort[a->id] != sort[b->id])
		return sort[a->id] - sort[b->id];
1368 1369 1370 1371 1372 1373
	if (a->subseq != b->subseq) {
		if (power_up)
			return a->subseq - b->subseq;
		else
			return b->subseq - a->subseq;
	}
1374 1375
	if (a->reg != b->reg)
		return a->reg - b->reg;
1376 1377
	if (a->dapm != b->dapm)
		return (unsigned long)a->dapm - (unsigned long)b->dapm;
1378

1379 1380
	return 0;
}
1381

1382 1383 1384
/* Insert a widget in order into a DAPM power sequence. */
static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
			    struct list_head *list,
1385
			    bool power_up)
1386 1387 1388 1389
{
	struct snd_soc_dapm_widget *w;

	list_for_each_entry(w, list, power_list)
1390
		if (dapm_seq_compare(new_widget, w, power_up) < 0) {
1391 1392 1393 1394 1395 1396 1397
			list_add_tail(&new_widget->power_list, &w->power_list);
			return;
		}

	list_add_tail(&new_widget->power_list, list);
}

1398
static void dapm_seq_check_event(struct snd_soc_card *card,
1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420
				 struct snd_soc_dapm_widget *w, int event)
{
	const char *ev_name;
	int power, ret;

	switch (event) {
	case SND_SOC_DAPM_PRE_PMU:
		ev_name = "PRE_PMU";
		power = 1;
		break;
	case SND_SOC_DAPM_POST_PMU:
		ev_name = "POST_PMU";
		power = 1;
		break;
	case SND_SOC_DAPM_PRE_PMD:
		ev_name = "PRE_PMD";
		power = 0;
		break;
	case SND_SOC_DAPM_POST_PMD:
		ev_name = "POST_PMD";
		power = 0;
		break;
1421 1422 1423 1424 1425 1426 1427 1428
	case SND_SOC_DAPM_WILL_PMU:
		ev_name = "WILL_PMU";
		power = 1;
		break;
	case SND_SOC_DAPM_WILL_PMD:
		ev_name = "WILL_PMD";
		power = 0;
		break;
1429
	default:
T
Takashi Iwai 已提交
1430
		WARN(1, "Unknown event %d\n", event);
1431 1432 1433
		return;
	}

1434
	if (w->new_power != power)
1435 1436 1437
		return;

	if (w->event && (w->event_flags & event)) {
1438
		pop_dbg(w->dapm->dev, card->pop_time, "pop test : %s %s\n",
1439
			w->name, ev_name);
1440
		soc_dapm_async_complete(w->dapm);
M
Mark Brown 已提交
1441
		trace_snd_soc_dapm_widget_event_start(w, event);
1442
		ret = w->event(w, NULL, event);
M
Mark Brown 已提交
1443
		trace_snd_soc_dapm_widget_event_done(w, event);
1444
		if (ret < 0)
1445
			dev_err(w->dapm->dev, "ASoC: %s: %s event failed: %d\n",
1446 1447 1448 1449
			       ev_name, w->name, ret);
	}
}

1450
/* Apply the coalesced changes from a DAPM sequence */
1451
static void dapm_seq_run_coalesced(struct snd_soc_card *card,
1452
				   struct list_head *pending)
1453
{
1454
	struct snd_soc_dapm_widget *w;
1455
	int reg;
1456 1457 1458 1459 1460 1461 1462
	unsigned int value = 0;
	unsigned int mask = 0;

	reg = list_first_entry(pending, struct snd_soc_dapm_widget,
			       power_list)->reg;

	list_for_each_entry(w, pending, power_list) {
1463
		WARN_ON(reg != w->reg);
1464
		w->power = w->new_power;
1465

1466 1467 1468
		mask |= w->mask << w->shift;
		if (w->power)
			value |= w->on_val << w->shift;
1469
		else
1470
			value |= w->off_val << w->shift;
1471

1472
		pop_dbg(w->dapm->dev, card->pop_time,
1473 1474
			"pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
			w->name, reg, value, mask);
1475

1476
		/* Check for events */
1477 1478
		dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMU);
		dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMD);
1479 1480 1481
	}

	if (reg >= 0) {
1482 1483 1484 1485 1486 1487
		/* Any widget will do, they should all be updating the
		 * same register.
		 */
		w = list_first_entry(pending, struct snd_soc_dapm_widget,
				     power_list);

1488
		pop_dbg(w->dapm->dev, card->pop_time,
1489
			"pop test : Applying 0x%x/0x%x to %x in %dms\n",
1490 1491
			value, mask, reg, card->pop_time);
		pop_wait(card->pop_time);
1492
		soc_widget_update_bits_locked(w, reg, mask, value);
1493 1494
	}

1495
	list_for_each_entry(w, pending, power_list) {
1496 1497
		dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMU);
		dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMD);
1498
	}
1499
}
1500

1501 1502 1503 1504 1505 1506 1507 1508
/* Apply a DAPM power sequence.
 *
 * We walk over a pre-sorted list of widgets to apply power to.  In
 * order to minimise the number of writes to the device required
 * multiple widgets will be updated in a single write where possible.
 * Currently anything that requires more than a single write is not
 * handled.
 */
1509 1510
static void dapm_seq_run(struct snd_soc_card *card,
	struct list_head *list, int event, bool power_up)
1511 1512
{
	struct snd_soc_dapm_widget *w, *n;
1513
	struct snd_soc_dapm_context *d;
1514 1515
	LIST_HEAD(pending);
	int cur_sort = -1;
1516
	int cur_subseq = -1;
1517
	int cur_reg = SND_SOC_NOPM;
1518
	struct snd_soc_dapm_context *cur_dapm = NULL;
1519
	int ret, i;
1520 1521 1522 1523 1524 1525
	int *sort;

	if (power_up)
		sort = dapm_up_seq;
	else
		sort = dapm_down_seq;
1526

1527 1528 1529 1530
	list_for_each_entry_safe(w, n, list, power_list) {
		ret = 0;

		/* Do we need to apply any queued changes? */
1531
		if (sort[w->id] != cur_sort || w->reg != cur_reg ||
1532
		    w->dapm != cur_dapm || w->subseq != cur_subseq) {
1533
			if (!list_empty(&pending))
1534
				dapm_seq_run_coalesced(card, &pending);
1535

1536 1537 1538 1539
			if (cur_dapm && cur_dapm->seq_notifier) {
				for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
					if (sort[i] == cur_sort)
						cur_dapm->seq_notifier(cur_dapm,
1540 1541
								       i,
								       cur_subseq);
1542 1543
			}

1544 1545 1546
			if (cur_dapm && w->dapm != cur_dapm)
				soc_dapm_async_complete(cur_dapm);

1547 1548
			INIT_LIST_HEAD(&pending);
			cur_sort = -1;
1549
			cur_subseq = INT_MIN;
1550
			cur_reg = SND_SOC_NOPM;
1551
			cur_dapm = NULL;
1552 1553
		}

1554 1555 1556
		switch (w->id) {
		case snd_soc_dapm_pre:
			if (!w->event)
1557 1558
				list_for_each_entry_safe_continue(w, n, list,
								  power_list);
1559

1560
			if (event == SND_SOC_DAPM_STREAM_START)
1561 1562
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_PRE_PMU);
1563
			else if (event == SND_SOC_DAPM_STREAM_STOP)
1564 1565 1566 1567 1568 1569
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_PRE_PMD);
			break;

		case snd_soc_dapm_post:
			if (!w->event)
1570 1571
				list_for_each_entry_safe_continue(w, n, list,
								  power_list);
1572

1573
			if (event == SND_SOC_DAPM_STREAM_START)
1574 1575
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_POST_PMU);
1576
			else if (event == SND_SOC_DAPM_STREAM_STOP)
1577 1578 1579 1580
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_POST_PMD);
			break;

1581
		default:
1582 1583
			/* Queue it up for application */
			cur_sort = sort[w->id];
1584
			cur_subseq = w->subseq;
1585
			cur_reg = w->reg;
1586
			cur_dapm = w->dapm;
1587 1588
			list_move(&w->power_list, &pending);
			break;
1589
		}
1590 1591

		if (ret < 0)
1592
			dev_err(w->dapm->dev,
1593
				"ASoC: Failed to apply widget power: %d\n", ret);
1594
	}
1595 1596

	if (!list_empty(&pending))
1597
		dapm_seq_run_coalesced(card, &pending);
1598 1599 1600 1601 1602

	if (cur_dapm && cur_dapm->seq_notifier) {
		for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
			if (sort[i] == cur_sort)
				cur_dapm->seq_notifier(cur_dapm,
1603
						       i, cur_subseq);
1604
	}
1605 1606 1607 1608

	list_for_each_entry(d, &card->dapm_list, list) {
		soc_dapm_async_complete(d);
	}
1609 1610
}

1611
static void dapm_widget_update(struct snd_soc_card *card)
1612
{
1613
	struct snd_soc_dapm_update *update = card->update;
1614 1615 1616
	struct snd_soc_dapm_widget_list *wlist;
	struct snd_soc_dapm_widget *w = NULL;
	unsigned int wi;
1617 1618
	int ret;

1619
	if (!update || !dapm_kcontrol_is_powered(update->kcontrol))
1620 1621
		return;

1622
	wlist = dapm_kcontrol_get_wlist(update->kcontrol);
1623

1624 1625 1626 1627 1628 1629
	for (wi = 0; wi < wlist->num_widgets; wi++) {
		w = wlist->widgets[wi];

		if (w->event && (w->event_flags & SND_SOC_DAPM_PRE_REG)) {
			ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG);
			if (ret != 0)
1630
				dev_err(w->dapm->dev, "ASoC: %s DAPM pre-event failed: %d\n",
1631 1632
					   w->name, ret);
		}
1633 1634
	}

1635 1636 1637
	if (!w)
		return;

1638
	ret = soc_widget_update_bits_locked(w, update->reg, update->mask,
1639 1640
				  update->val);
	if (ret < 0)
1641
		dev_err(w->dapm->dev, "ASoC: %s DAPM update failed: %d\n",
1642
			w->name, ret);
1643

1644 1645 1646 1647 1648 1649
	for (wi = 0; wi < wlist->num_widgets; wi++) {
		w = wlist->widgets[wi];

		if (w->event && (w->event_flags & SND_SOC_DAPM_POST_REG)) {
			ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG);
			if (ret != 0)
1650
				dev_err(w->dapm->dev, "ASoC: %s DAPM post-event failed: %d\n",
1651 1652
					   w->name, ret);
		}
1653 1654 1655
	}
}

1656 1657 1658 1659 1660 1661 1662 1663
/* Async callback run prior to DAPM sequences - brings to _PREPARE if
 * they're changing state.
 */
static void dapm_pre_sequence_async(void *data, async_cookie_t cookie)
{
	struct snd_soc_dapm_context *d = data;
	int ret;

1664 1665 1666
	/* If we're off and we're not supposed to be go into STANDBY */
	if (d->bias_level == SND_SOC_BIAS_OFF &&
	    d->target_bias_level != SND_SOC_BIAS_OFF) {
1667 1668 1669
		if (d->dev)
			pm_runtime_get_sync(d->dev);

1670 1671 1672
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
		if (ret != 0)
			dev_err(d->dev,
1673
				"ASoC: Failed to turn on bias: %d\n", ret);
1674 1675
	}

1676 1677
	/* Prepare for a STADDBY->ON or ON->STANDBY transition */
	if (d->bias_level != d->target_bias_level) {
1678 1679 1680
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
		if (ret != 0)
			dev_err(d->dev,
1681
				"ASoC: Failed to prepare bias: %d\n", ret);
1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693
	}
}

/* Async callback run prior to DAPM sequences - brings to their final
 * state.
 */
static void dapm_post_sequence_async(void *data, async_cookie_t cookie)
{
	struct snd_soc_dapm_context *d = data;
	int ret;

	/* If we just powered the last thing off drop to standby bias */
1694 1695 1696
	if (d->bias_level == SND_SOC_BIAS_PREPARE &&
	    (d->target_bias_level == SND_SOC_BIAS_STANDBY ||
	     d->target_bias_level == SND_SOC_BIAS_OFF)) {
1697 1698
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
		if (ret != 0)
1699
			dev_err(d->dev, "ASoC: Failed to apply standby bias: %d\n",
1700 1701
				ret);
	}
1702

1703
	/* If we're in standby and can support bias off then do that */
1704 1705
	if (d->bias_level == SND_SOC_BIAS_STANDBY &&
	    d->target_bias_level == SND_SOC_BIAS_OFF) {
1706 1707
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
		if (ret != 0)
1708 1709
			dev_err(d->dev, "ASoC: Failed to turn off bias: %d\n",
				ret);
1710 1711

		if (d->dev)
1712
			pm_runtime_put(d->dev);
1713 1714 1715
	}

	/* If we just powered up then move to active bias */
1716 1717
	if (d->bias_level == SND_SOC_BIAS_PREPARE &&
	    d->target_bias_level == SND_SOC_BIAS_ON) {
1718 1719
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
		if (ret != 0)
1720
			dev_err(d->dev, "ASoC: Failed to apply active bias: %d\n",
1721 1722 1723
				ret);
	}
}
1724

1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736
static void dapm_widget_set_peer_power(struct snd_soc_dapm_widget *peer,
				       bool power, bool connect)
{
	/* If a connection is being made or broken then that update
	 * will have marked the peer dirty, otherwise the widgets are
	 * not connected and this update has no impact. */
	if (!connect)
		return;

	/* If the peer is already in the state we're moving to then we
	 * won't have an impact on it. */
	if (power != peer->power)
1737
		dapm_mark_dirty(peer, "peer state change");
1738 1739
}

1740 1741 1742 1743
static void dapm_widget_set_power(struct snd_soc_dapm_widget *w, bool power,
				  struct list_head *up_list,
				  struct list_head *down_list)
{
1744 1745
	struct snd_soc_dapm_path *path;

1746 1747 1748 1749 1750
	if (w->power == power)
		return;

	trace_snd_soc_dapm_widget_power(w, power);

1751
	/* If we changed our power state perhaps our neigbours changed
1752
	 * also.
1753 1754 1755
	 */
	list_for_each_entry(path, &w->sources, list_sink) {
		if (path->source) {
1756 1757
			dapm_widget_set_peer_power(path->source, power,
						   path->connect);
1758 1759
		}
	}
1760 1761
	switch (w->id) {
	case snd_soc_dapm_supply:
1762
	case snd_soc_dapm_regulator_supply:
1763
	case snd_soc_dapm_clock_supply:
1764
	case snd_soc_dapm_kcontrol:
1765 1766 1767 1768 1769 1770 1771 1772
		/* Supplies can't affect their outputs, only their inputs */
		break;
	default:
		list_for_each_entry(path, &w->sinks, list_source) {
			if (path->sink) {
				dapm_widget_set_peer_power(path->sink, power,
							   path->connect);
			}
1773
		}
1774
		break;
1775 1776
	}

1777 1778 1779 1780 1781 1782
	if (power)
		dapm_seq_insert(w, up_list, true);
	else
		dapm_seq_insert(w, down_list, false);
}

1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797
static void dapm_power_one_widget(struct snd_soc_dapm_widget *w,
				  struct list_head *up_list,
				  struct list_head *down_list)
{
	int power;

	switch (w->id) {
	case snd_soc_dapm_pre:
		dapm_seq_insert(w, down_list, false);
		break;
	case snd_soc_dapm_post:
		dapm_seq_insert(w, up_list, true);
		break;

	default:
1798
		power = dapm_widget_power_check(w);
1799

1800
		dapm_widget_set_power(w, power, up_list, down_list);
1801 1802 1803 1804
		break;
	}
}

1805 1806 1807 1808 1809 1810 1811 1812 1813
/*
 * Scan each dapm widget for complete audio path.
 * A complete path is a route that has valid endpoints i.e.:-
 *
 *  o DAC to output pin.
 *  o Input Pin to ADC.
 *  o Input pin to Output pin (bypass, sidetone)
 *  o DAC to ADC (loopback).
 */
1814
static int dapm_power_widgets(struct snd_soc_card *card, int event)
1815 1816
{
	struct snd_soc_dapm_widget *w;
1817
	struct snd_soc_dapm_context *d;
1818 1819
	LIST_HEAD(up_list);
	LIST_HEAD(down_list);
1820
	ASYNC_DOMAIN_EXCLUSIVE(async_domain);
1821
	enum snd_soc_bias_level bias;
1822

M
Mark Brown 已提交
1823 1824
	trace_snd_soc_dapm_start(card);

1825
	list_for_each_entry(d, &card->dapm_list, list) {
1826 1827 1828 1829
		if (d->idle_bias_off)
			d->target_bias_level = SND_SOC_BIAS_OFF;
		else
			d->target_bias_level = SND_SOC_BIAS_STANDBY;
1830
	}
1831

1832
	dapm_reset(card);
1833

1834
	/* Check which widgets we need to power and store them in
1835 1836 1837 1838
	 * lists indicating if they should be powered up or down.  We
	 * only check widgets that have been flagged as dirty but note
	 * that new widgets may be added to the dirty list while we
	 * iterate.
1839
	 */
1840
	list_for_each_entry(w, &card->dapm_dirty, dirty) {
1841
		dapm_power_one_widget(w, &up_list, &down_list);
1842 1843
	}

1844
	list_for_each_entry(w, &card->widgets, list) {
1845 1846 1847 1848 1849 1850 1851 1852 1853
		switch (w->id) {
		case snd_soc_dapm_pre:
		case snd_soc_dapm_post:
			/* These widgets always need to be powered */
			break;
		default:
			list_del_init(&w->dirty);
			break;
		}
1854

1855
		if (w->new_power) {
1856 1857 1858 1859 1860
			d = w->dapm;

			/* Supplies and micbiases only bring the
			 * context up to STANDBY as unless something
			 * else is active and passing audio they
1861 1862 1863
			 * generally don't require full power.  Signal
			 * generators are virtual pins and have no
			 * power impact themselves.
1864 1865
			 */
			switch (w->id) {
1866
			case snd_soc_dapm_siggen:
1867
			case snd_soc_dapm_vmid:
1868
				break;
1869
			case snd_soc_dapm_supply:
1870
			case snd_soc_dapm_regulator_supply:
1871
			case snd_soc_dapm_clock_supply:
1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883
			case snd_soc_dapm_micbias:
				if (d->target_bias_level < SND_SOC_BIAS_STANDBY)
					d->target_bias_level = SND_SOC_BIAS_STANDBY;
				break;
			default:
				d->target_bias_level = SND_SOC_BIAS_ON;
				break;
			}
		}

	}

1884 1885 1886
	/* Force all contexts in the card to the same bias state if
	 * they're not ground referenced.
	 */
1887
	bias = SND_SOC_BIAS_OFF;
1888
	list_for_each_entry(d, &card->dapm_list, list)
1889 1890
		if (d->target_bias_level > bias)
			bias = d->target_bias_level;
1891
	list_for_each_entry(d, &card->dapm_list, list)
1892 1893
		if (!d->idle_bias_off)
			d->target_bias_level = bias;
1894

1895
	trace_snd_soc_dapm_walk_done(card);
1896

1897
	/* Run all the bias changes in parallel */
1898
	list_for_each_entry(d, &card->dapm_list, list)
1899 1900 1901
		async_schedule_domain(dapm_pre_sequence_async, d,
					&async_domain);
	async_synchronize_full_domain(&async_domain);
1902

1903
	list_for_each_entry(w, &down_list, power_list) {
1904
		dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMD);
1905 1906
	}

1907
	list_for_each_entry(w, &up_list, power_list) {
1908
		dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMU);
1909 1910
	}

1911
	/* Power down widgets first; try to avoid amplifying pops. */
1912
	dapm_seq_run(card, &down_list, event, false);
1913

1914
	dapm_widget_update(card);
1915

1916
	/* Now power up. */
1917
	dapm_seq_run(card, &up_list, event, true);
1918

1919
	/* Run all the bias changes in parallel */
1920
	list_for_each_entry(d, &card->dapm_list, list)
1921 1922 1923
		async_schedule_domain(dapm_post_sequence_async, d,
					&async_domain);
	async_synchronize_full_domain(&async_domain);
1924

1925 1926 1927 1928 1929 1930
	/* do we need to notify any clients that DAPM event is complete */
	list_for_each_entry(d, &card->dapm_list, list) {
		if (d->stream_event)
			d->stream_event(d, event);
	}

1931
	pop_dbg(card->dev, card->pop_time,
1932
		"DAPM sequencing finished, waiting %dms\n", card->pop_time);
1933
	pop_wait(card->pop_time);
1934

M
Mark Brown 已提交
1935 1936
	trace_snd_soc_dapm_done(card);

1937
	return 0;
1938 1939
}

1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954
#ifdef CONFIG_DEBUG_FS
static ssize_t dapm_widget_power_read_file(struct file *file,
					   char __user *user_buf,
					   size_t count, loff_t *ppos)
{
	struct snd_soc_dapm_widget *w = file->private_data;
	char *buf;
	int in, out;
	ssize_t ret;
	struct snd_soc_dapm_path *p = NULL;

	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
	if (!buf)
		return -ENOMEM;

1955
	in = is_connected_input_ep(w, NULL);
1956
	dapm_clear_walk_input(w->dapm, &w->sources);
1957
	out = is_connected_output_ep(w, NULL);
1958
	dapm_clear_walk_output(w->dapm, &w->sinks);
1959

1960 1961 1962
	ret = snprintf(buf, PAGE_SIZE, "%s: %s%s  in %d out %d",
		       w->name, w->power ? "On" : "Off",
		       w->force ? " (forced)" : "", in, out);
1963

1964 1965
	if (w->reg >= 0)
		ret += snprintf(buf + ret, PAGE_SIZE - ret,
1966 1967
				" - R%d(0x%x) mask 0x%x",
				w->reg, w->reg, w->mask << w->shift);
1968 1969 1970

	ret += snprintf(buf + ret, PAGE_SIZE - ret, "\n");

1971 1972 1973 1974
	if (w->sname)
		ret += snprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
				w->sname,
				w->active ? "active" : "inactive");
1975 1976

	list_for_each_entry(p, &w->sources, list_sink) {
1977
		if (p->connected && !p->connected(w, p->source))
1978 1979
			continue;

1980 1981
		if (p->connect)
			ret += snprintf(buf + ret, PAGE_SIZE - ret,
1982
					" in  \"%s\" \"%s\"\n",
1983 1984 1985 1986
					p->name ? p->name : "static",
					p->source->name);
	}
	list_for_each_entry(p, &w->sinks, list_source) {
1987 1988 1989
		if (p->connected && !p->connected(w, p->sink))
			continue;

1990 1991
		if (p->connect)
			ret += snprintf(buf + ret, PAGE_SIZE - ret,
1992
					" out \"%s\" \"%s\"\n",
1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003
					p->name ? p->name : "static",
					p->sink->name);
	}

	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);

	kfree(buf);
	return ret;
}

static const struct file_operations dapm_widget_power_fops = {
2004
	.open = simple_open,
2005
	.read = dapm_widget_power_read_file,
2006
	.llseek = default_llseek,
2007 2008
};

2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028
static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf,
				   size_t count, loff_t *ppos)
{
	struct snd_soc_dapm_context *dapm = file->private_data;
	char *level;

	switch (dapm->bias_level) {
	case SND_SOC_BIAS_ON:
		level = "On\n";
		break;
	case SND_SOC_BIAS_PREPARE:
		level = "Prepare\n";
		break;
	case SND_SOC_BIAS_STANDBY:
		level = "Standby\n";
		break;
	case SND_SOC_BIAS_OFF:
		level = "Off\n";
		break;
	default:
T
Takashi Iwai 已提交
2029
		WARN(1, "Unknown bias_level %d\n", dapm->bias_level);
2030 2031 2032 2033 2034 2035 2036 2037 2038
		level = "Unknown\n";
		break;
	}

	return simple_read_from_buffer(user_buf, count, ppos, level,
				       strlen(level));
}

static const struct file_operations dapm_bias_fops = {
2039
	.open = simple_open,
2040 2041 2042 2043
	.read = dapm_bias_read_file,
	.llseek = default_llseek,
};

2044 2045
void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
	struct dentry *parent)
2046 2047 2048
{
	struct dentry *d;

2049 2050 2051
	dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);

	if (!dapm->debugfs_dapm) {
2052
		dev_warn(dapm->dev,
2053
		       "ASoC: Failed to create DAPM debugfs directory\n");
2054
		return;
2055
	}
2056

2057 2058 2059 2060 2061 2062
	d = debugfs_create_file("bias_level", 0444,
				dapm->debugfs_dapm, dapm,
				&dapm_bias_fops);
	if (!d)
		dev_warn(dapm->dev,
			 "ASoC: Failed to create bias level debugfs file\n");
2063
}
2064

2065 2066 2067 2068
static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
{
	struct snd_soc_dapm_context *dapm = w->dapm;
	struct dentry *d;
2069

2070 2071 2072 2073 2074 2075 2076 2077 2078 2079
	if (!dapm->debugfs_dapm || !w->name)
		return;

	d = debugfs_create_file(w->name, 0444,
				dapm->debugfs_dapm, w,
				&dapm_widget_power_fops);
	if (!d)
		dev_warn(w->dapm->dev,
			"ASoC: Failed to create %s debugfs file\n",
			w->name);
2080
}
2081

2082 2083 2084 2085 2086
static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
{
	debugfs_remove_recursive(dapm->debugfs_dapm);
}

2087
#else
2088 2089
void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
	struct dentry *parent)
2090 2091
{
}
2092 2093 2094 2095 2096

static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
{
}

2097 2098 2099 2100
static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
{
}

2101 2102
#endif

2103
/* test and update the power status of a mux widget */
2104
static int soc_dapm_mux_update_power(struct snd_soc_card *card,
2105
				 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e)
2106 2107 2108 2109 2110
{
	struct snd_soc_dapm_path *path;
	int found = 0;

	/* find dapm widget path assoc with kcontrol */
2111
	dapm_kcontrol_for_each_path(path, kcontrol) {
2112
		if (!path->name || !e->texts[mux])
2113 2114 2115 2116
			continue;

		found = 1;
		/* we now need to match the string in the enum to the path */
2117
		if (!(strcmp(path->name, e->texts[mux]))) {
2118
			path->connect = 1; /* new connection */
2119
			dapm_mark_dirty(path->source, "mux connection");
2120 2121
		} else {
			if (path->connect)
2122 2123
				dapm_mark_dirty(path->source,
						"mux disconnection");
2124
			path->connect = 0; /* old connection must be powered down */
2125
		}
2126
		dapm_mark_dirty(path->sink, "mux change");
2127 2128
	}

2129
	if (found)
2130
		dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
2131

2132
	return found;
2133
}
2134

2135
int snd_soc_dapm_mux_update_power(struct snd_soc_dapm_context *dapm,
2136 2137
	struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e,
	struct snd_soc_dapm_update *update)
2138
{
2139
	struct snd_soc_card *card = dapm->card;
2140 2141
	int ret;

2142
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2143
	card->update = update;
2144
	ret = soc_dapm_mux_update_power(card, kcontrol, mux, e);
2145
	card->update = NULL;
2146
	mutex_unlock(&card->dapm_mutex);
2147
	if (ret > 0)
2148
		soc_dpcm_runtime_update(card);
2149 2150
	return ret;
}
2151
EXPORT_SYMBOL_GPL(snd_soc_dapm_mux_update_power);
2152

2153
/* test and update the power status of a mixer or switch widget */
2154
static int soc_dapm_mixer_update_power(struct snd_soc_card *card,
2155
				   struct snd_kcontrol *kcontrol, int connect)
2156 2157 2158 2159 2160
{
	struct snd_soc_dapm_path *path;
	int found = 0;

	/* find dapm widget path assoc with kcontrol */
2161
	dapm_kcontrol_for_each_path(path, kcontrol) {
2162
		found = 1;
2163
		path->connect = connect;
2164
		dapm_mark_dirty(path->source, "mixer connection");
2165
		dapm_mark_dirty(path->sink, "mixer update");
2166 2167
	}

2168
	if (found)
2169
		dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
2170

2171
	return found;
2172
}
2173

2174
int snd_soc_dapm_mixer_update_power(struct snd_soc_dapm_context *dapm,
2175 2176
	struct snd_kcontrol *kcontrol, int connect,
	struct snd_soc_dapm_update *update)
2177
{
2178
	struct snd_soc_card *card = dapm->card;
2179 2180
	int ret;

2181
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2182
	card->update = update;
2183
	ret = soc_dapm_mixer_update_power(card, kcontrol, connect);
2184
	card->update = NULL;
2185
	mutex_unlock(&card->dapm_mutex);
2186
	if (ret > 0)
2187
		soc_dpcm_runtime_update(card);
2188 2189
	return ret;
}
2190
EXPORT_SYMBOL_GPL(snd_soc_dapm_mixer_update_power);
2191 2192 2193 2194 2195

/* show dapm widget status in sys fs */
static ssize_t dapm_widget_show(struct device *dev,
	struct device_attribute *attr, char *buf)
{
2196
	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
2197
	struct snd_soc_codec *codec =rtd->codec;
2198 2199 2200 2201
	struct snd_soc_dapm_widget *w;
	int count = 0;
	char *state = "not set";

2202 2203 2204
	list_for_each_entry(w, &codec->card->widgets, list) {
		if (w->dapm != &codec->dapm)
			continue;
2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215

		/* only display widgets that burnm power */
		switch (w->id) {
		case snd_soc_dapm_hp:
		case snd_soc_dapm_mic:
		case snd_soc_dapm_spk:
		case snd_soc_dapm_line:
		case snd_soc_dapm_micbias:
		case snd_soc_dapm_dac:
		case snd_soc_dapm_adc:
		case snd_soc_dapm_pga:
2216
		case snd_soc_dapm_out_drv:
2217
		case snd_soc_dapm_mixer:
2218
		case snd_soc_dapm_mixer_named_ctl:
2219
		case snd_soc_dapm_supply:
2220
		case snd_soc_dapm_regulator_supply:
2221
		case snd_soc_dapm_clock_supply:
2222 2223 2224 2225 2226 2227 2228 2229 2230
			if (w->name)
				count += sprintf(buf + count, "%s: %s\n",
					w->name, w->power ? "On":"Off");
		break;
		default:
		break;
		}
	}

L
Liam Girdwood 已提交
2231
	switch (codec->dapm.bias_level) {
2232 2233
	case SND_SOC_BIAS_ON:
		state = "On";
2234
		break;
2235 2236
	case SND_SOC_BIAS_PREPARE:
		state = "Prepare";
2237
		break;
2238 2239
	case SND_SOC_BIAS_STANDBY:
		state = "Standby";
2240
		break;
2241 2242
	case SND_SOC_BIAS_OFF:
		state = "Off";
2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253
		break;
	}
	count += sprintf(buf + count, "PM State: %s\n", state);

	return count;
}

static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);

int snd_soc_dapm_sys_add(struct device *dev)
{
2254
	return device_create_file(dev, &dev_attr_dapm_widget);
2255 2256 2257 2258
}

static void snd_soc_dapm_sys_remove(struct device *dev)
{
2259
	device_remove_file(dev, &dev_attr_dapm_widget);
2260 2261
}

2262 2263 2264 2265
static void dapm_free_path(struct snd_soc_dapm_path *path)
{
	list_del(&path->list_sink);
	list_del(&path->list_source);
2266
	list_del(&path->list_kcontrol);
2267 2268 2269 2270
	list_del(&path->list);
	kfree(path);
}

2271
/* free all dapm widgets and resources */
L
Liam Girdwood 已提交
2272
static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
2273 2274 2275 2276
{
	struct snd_soc_dapm_widget *w, *next_w;
	struct snd_soc_dapm_path *p, *next_p;

2277 2278 2279
	list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
		if (w->dapm != dapm)
			continue;
2280
		list_del(&w->list);
2281 2282 2283 2284 2285
		/*
		 * remove source and sink paths associated to this widget.
		 * While removing the path, remove reference to it from both
		 * source and sink widgets so that path is removed only once.
		 */
2286 2287 2288 2289 2290 2291
		list_for_each_entry_safe(p, next_p, &w->sources, list_sink)
			dapm_free_path(p);

		list_for_each_entry_safe(p, next_p, &w->sinks, list_source)
			dapm_free_path(p);

2292
		kfree(w->kcontrols);
2293
		kfree(w->name);
2294 2295 2296 2297
		kfree(w);
	}
}

2298 2299 2300
static struct snd_soc_dapm_widget *dapm_find_widget(
			struct snd_soc_dapm_context *dapm, const char *pin,
			bool search_other_contexts)
2301 2302
{
	struct snd_soc_dapm_widget *w;
2303
	struct snd_soc_dapm_widget *fallback = NULL;
2304

2305
	list_for_each_entry(w, &dapm->card->widgets, list) {
2306
		if (!strcmp(w->name, pin)) {
2307 2308 2309 2310
			if (w->dapm == dapm)
				return w;
			else
				fallback = w;
2311 2312 2313
		}
	}

2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325
	if (search_other_contexts)
		return fallback;

	return NULL;
}

static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
				const char *pin, int status)
{
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);

	if (!w) {
2326
		dev_err(dapm->dev, "ASoC: DAPM unknown pin %s\n", pin);
2327
		return -EINVAL;
2328 2329
	}

2330 2331 2332
	if (w->connected != status)
		dapm_mark_dirty(w, "pin configuration");

2333 2334 2335 2336 2337
	w->connected = status;
	if (status == 0)
		w->force = 0;

	return 0;
2338 2339
}

2340
/**
2341
 * snd_soc_dapm_sync - scan and power dapm paths
L
Liam Girdwood 已提交
2342
 * @dapm: DAPM context
2343 2344 2345 2346 2347 2348
 *
 * Walks all dapm audio paths and powers widgets according to their
 * stream or path usage.
 *
 * Returns 0 for success.
 */
L
Liam Girdwood 已提交
2349
int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
2350
{
2351 2352
	int ret;

2353 2354 2355 2356 2357 2358 2359
	/*
	 * Suppress early reports (eg, jacks syncing their state) to avoid
	 * silly DAPM runs during card startup.
	 */
	if (!dapm->card || !dapm->card->instantiated)
		return 0;

2360
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2361
	ret = dapm_power_widgets(dapm->card, SND_SOC_DAPM_STREAM_NOP);
2362 2363
	mutex_unlock(&dapm->card->dapm_mutex);
	return ret;
2364
}
2365
EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
2366

2367 2368 2369 2370 2371
static int snd_soc_dapm_add_path(struct snd_soc_dapm_context *dapm,
	struct snd_soc_dapm_widget *wsource, struct snd_soc_dapm_widget *wsink,
	const char *control,
	int (*connected)(struct snd_soc_dapm_widget *source,
			 struct snd_soc_dapm_widget *sink))
2372 2373
{
	struct snd_soc_dapm_path *path;
2374
	int ret;
2375 2376 2377 2378 2379 2380 2381

	path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
	if (!path)
		return -ENOMEM;

	path->source = wsource;
	path->sink = wsink;
2382
	path->connected = connected;
2383
	INIT_LIST_HEAD(&path->list);
2384
	INIT_LIST_HEAD(&path->list_kcontrol);
2385 2386 2387 2388 2389 2390 2391
	INIT_LIST_HEAD(&path->list_source);
	INIT_LIST_HEAD(&path->list_sink);

	/* check for external widgets */
	if (wsink->id == snd_soc_dapm_input) {
		if (wsource->id == snd_soc_dapm_micbias ||
			wsource->id == snd_soc_dapm_mic ||
2392 2393
			wsource->id == snd_soc_dapm_line ||
			wsource->id == snd_soc_dapm_output)
2394 2395 2396 2397 2398
			wsink->ext = 1;
	}
	if (wsource->id == snd_soc_dapm_output) {
		if (wsink->id == snd_soc_dapm_spk ||
			wsink->id == snd_soc_dapm_hp ||
2399 2400
			wsink->id == snd_soc_dapm_line ||
			wsink->id == snd_soc_dapm_input)
2401 2402 2403
			wsource->ext = 1;
	}

2404 2405 2406
	dapm_mark_dirty(wsource, "Route added");
	dapm_mark_dirty(wsink, "Route added");

2407 2408
	/* connect static paths */
	if (control == NULL) {
2409
		list_add(&path->list, &dapm->card->paths);
2410 2411 2412 2413 2414 2415 2416
		list_add(&path->list_sink, &wsink->sources);
		list_add(&path->list_source, &wsource->sinks);
		path->connect = 1;
		return 0;
	}

	/* connect dynamic paths */
2417
	switch (wsink->id) {
2418 2419 2420
	case snd_soc_dapm_adc:
	case snd_soc_dapm_dac:
	case snd_soc_dapm_pga:
2421
	case snd_soc_dapm_out_drv:
2422 2423
	case snd_soc_dapm_input:
	case snd_soc_dapm_output:
2424
	case snd_soc_dapm_siggen:
2425 2426 2427 2428
	case snd_soc_dapm_micbias:
	case snd_soc_dapm_vmid:
	case snd_soc_dapm_pre:
	case snd_soc_dapm_post:
2429
	case snd_soc_dapm_supply:
2430
	case snd_soc_dapm_regulator_supply:
2431
	case snd_soc_dapm_clock_supply:
2432 2433
	case snd_soc_dapm_aif_in:
	case snd_soc_dapm_aif_out:
2434 2435
	case snd_soc_dapm_dai_in:
	case snd_soc_dapm_dai_out:
2436
	case snd_soc_dapm_dai_link:
2437
	case snd_soc_dapm_kcontrol:
2438
		list_add(&path->list, &dapm->card->paths);
2439 2440 2441 2442 2443
		list_add(&path->list_sink, &wsink->sources);
		list_add(&path->list_source, &wsource->sinks);
		path->connect = 1;
		return 0;
	case snd_soc_dapm_mux:
2444
	case snd_soc_dapm_virt_mux:
2445
	case snd_soc_dapm_value_mux:
L
Liam Girdwood 已提交
2446
		ret = dapm_connect_mux(dapm, wsource, wsink, path, control,
2447
			&wsink->kcontrol_news[0]);
2448 2449 2450 2451 2452
		if (ret != 0)
			goto err;
		break;
	case snd_soc_dapm_switch:
	case snd_soc_dapm_mixer:
2453
	case snd_soc_dapm_mixer_named_ctl:
L
Liam Girdwood 已提交
2454
		ret = dapm_connect_mixer(dapm, wsource, wsink, path, control);
2455 2456 2457 2458 2459 2460 2461
		if (ret != 0)
			goto err;
		break;
	case snd_soc_dapm_hp:
	case snd_soc_dapm_mic:
	case snd_soc_dapm_line:
	case snd_soc_dapm_spk:
2462
		list_add(&path->list, &dapm->card->paths);
2463 2464 2465 2466 2467
		list_add(&path->list_sink, &wsink->sources);
		list_add(&path->list_source, &wsource->sinks);
		path->connect = 0;
		return 0;
	}
2468

2469
	return 0;
2470 2471 2472 2473
err:
	kfree(path);
	return ret;
}
2474

2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537
static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
				  const struct snd_soc_dapm_route *route)
{
	struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
	struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
	const char *sink;
	const char *source;
	char prefixed_sink[80];
	char prefixed_source[80];
	int ret;

	if (dapm->codec && dapm->codec->name_prefix) {
		snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
			 dapm->codec->name_prefix, route->sink);
		sink = prefixed_sink;
		snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
			 dapm->codec->name_prefix, route->source);
		source = prefixed_source;
	} else {
		sink = route->sink;
		source = route->source;
	}

	/*
	 * find src and dest widgets over all widgets but favor a widget from
	 * current DAPM context
	 */
	list_for_each_entry(w, &dapm->card->widgets, list) {
		if (!wsink && !(strcmp(w->name, sink))) {
			wtsink = w;
			if (w->dapm == dapm)
				wsink = w;
			continue;
		}
		if (!wsource && !(strcmp(w->name, source))) {
			wtsource = w;
			if (w->dapm == dapm)
				wsource = w;
		}
	}
	/* use widget from another DAPM context if not found from this */
	if (!wsink)
		wsink = wtsink;
	if (!wsource)
		wsource = wtsource;

	if (wsource == NULL) {
		dev_err(dapm->dev, "ASoC: no source widget found for %s\n",
			route->source);
		return -ENODEV;
	}
	if (wsink == NULL) {
		dev_err(dapm->dev, "ASoC: no sink widget found for %s\n",
			route->sink);
		return -ENODEV;
	}

	ret = snd_soc_dapm_add_path(dapm, wsource, wsink, route->control,
		route->connected);
	if (ret)
		goto err;

	return 0;
2538
err:
2539
	dev_warn(dapm->dev, "ASoC: no dapm match for %s --> %s --> %s\n",
2540
		 source, route->control, sink);
2541 2542
	return ret;
}
2543

2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554
static int snd_soc_dapm_del_route(struct snd_soc_dapm_context *dapm,
				  const struct snd_soc_dapm_route *route)
{
	struct snd_soc_dapm_path *path, *p;
	const char *sink;
	const char *source;
	char prefixed_sink[80];
	char prefixed_source[80];

	if (route->control) {
		dev_err(dapm->dev,
2555
			"ASoC: Removal of routes with controls not supported\n");
2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577 2578 2579 2580 2581 2582 2583 2584
		return -EINVAL;
	}

	if (dapm->codec && dapm->codec->name_prefix) {
		snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
			 dapm->codec->name_prefix, route->sink);
		sink = prefixed_sink;
		snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
			 dapm->codec->name_prefix, route->source);
		source = prefixed_source;
	} else {
		sink = route->sink;
		source = route->source;
	}

	path = NULL;
	list_for_each_entry(p, &dapm->card->paths, list) {
		if (strcmp(p->source->name, source) != 0)
			continue;
		if (strcmp(p->sink->name, sink) != 0)
			continue;
		path = p;
		break;
	}

	if (path) {
		dapm_mark_dirty(path->source, "Route removed");
		dapm_mark_dirty(path->sink, "Route removed");

2585
		dapm_free_path(path);
2586
	} else {
2587
		dev_warn(dapm->dev, "ASoC: Route %s->%s does not exist\n",
2588 2589 2590 2591 2592 2593
			 source, sink);
	}

	return 0;
}

2594 2595
/**
 * snd_soc_dapm_add_routes - Add routes between DAPM widgets
L
Liam Girdwood 已提交
2596
 * @dapm: DAPM context
2597 2598 2599 2600 2601 2602 2603 2604 2605 2606
 * @route: audio routes
 * @num: number of routes
 *
 * Connects 2 dapm widgets together via a named audio path. The sink is
 * the widget receiving the audio signal, whilst the source is the sender
 * of the audio signal.
 *
 * Returns 0 for success else error. On error all resources can be freed
 * with a call to snd_soc_card_free().
 */
L
Liam Girdwood 已提交
2607
int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
2608 2609
			    const struct snd_soc_dapm_route *route, int num)
{
2610
	int i, r, ret = 0;
2611

2612
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
2613
	for (i = 0; i < num; i++) {
2614 2615
		r = snd_soc_dapm_add_route(dapm, route);
		if (r < 0) {
2616 2617 2618 2619
			dev_err(dapm->dev, "ASoC: Failed to add route %s -> %s -> %s\n",
				route->source,
				route->control ? route->control : "direct",
				route->sink);
2620
			ret = r;
2621 2622 2623
		}
		route++;
	}
2624
	mutex_unlock(&dapm->card->dapm_mutex);
2625

2626
	return ret;
2627 2628 2629
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);

2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653
/**
 * snd_soc_dapm_del_routes - Remove routes between DAPM widgets
 * @dapm: DAPM context
 * @route: audio routes
 * @num: number of routes
 *
 * Removes routes from the DAPM context.
 */
int snd_soc_dapm_del_routes(struct snd_soc_dapm_context *dapm,
			    const struct snd_soc_dapm_route *route, int num)
{
	int i, ret = 0;

	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
	for (i = 0; i < num; i++) {
		snd_soc_dapm_del_route(dapm, route);
		route++;
	}
	mutex_unlock(&dapm->card->dapm_mutex);

	return ret;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_del_routes);

2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664 2665 2666
static int snd_soc_dapm_weak_route(struct snd_soc_dapm_context *dapm,
				   const struct snd_soc_dapm_route *route)
{
	struct snd_soc_dapm_widget *source = dapm_find_widget(dapm,
							      route->source,
							      true);
	struct snd_soc_dapm_widget *sink = dapm_find_widget(dapm,
							    route->sink,
							    true);
	struct snd_soc_dapm_path *path;
	int count = 0;

	if (!source) {
2667
		dev_err(dapm->dev, "ASoC: Unable to find source %s for weak route\n",
2668 2669 2670 2671 2672
			route->source);
		return -ENODEV;
	}

	if (!sink) {
2673
		dev_err(dapm->dev, "ASoC: Unable to find sink %s for weak route\n",
2674 2675 2676 2677 2678
			route->sink);
		return -ENODEV;
	}

	if (route->control || route->connected)
2679
		dev_warn(dapm->dev, "ASoC: Ignoring control for weak route %s->%s\n",
2680 2681 2682 2683 2684 2685 2686 2687 2688 2689
			 route->source, route->sink);

	list_for_each_entry(path, &source->sinks, list_source) {
		if (path->sink == sink) {
			path->weak = 1;
			count++;
		}
	}

	if (count == 0)
2690
		dev_err(dapm->dev, "ASoC: No path found for weak route %s->%s\n",
2691 2692
			route->source, route->sink);
	if (count > 1)
2693
		dev_warn(dapm->dev, "ASoC: %d paths found for weak route %s->%s\n",
2694 2695 2696 2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720
			 count, route->source, route->sink);

	return 0;
}

/**
 * snd_soc_dapm_weak_routes - Mark routes between DAPM widgets as weak
 * @dapm: DAPM context
 * @route: audio routes
 * @num: number of routes
 *
 * Mark existing routes matching those specified in the passed array
 * as being weak, meaning that they are ignored for the purpose of
 * power decisions.  The main intended use case is for sidetone paths
 * which couple audio between other independent paths if they are both
 * active in order to make the combination work better at the user
 * level but which aren't intended to be "used".
 *
 * Note that CODEC drivers should not use this as sidetone type paths
 * can frequently also be used as bypass paths.
 */
int snd_soc_dapm_weak_routes(struct snd_soc_dapm_context *dapm,
			     const struct snd_soc_dapm_route *route, int num)
{
	int i, err;
	int ret = 0;

2721
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
2722 2723 2724 2725 2726 2727
	for (i = 0; i < num; i++) {
		err = snd_soc_dapm_weak_route(dapm, route);
		if (err)
			ret = err;
		route++;
	}
2728
	mutex_unlock(&dapm->card->dapm_mutex);
2729 2730 2731 2732 2733

	return ret;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_weak_routes);

2734 2735
/**
 * snd_soc_dapm_new_widgets - add new dapm widgets
L
Liam Girdwood 已提交
2736
 * @dapm: DAPM context
2737 2738 2739 2740 2741
 *
 * Checks the codec for any new dapm widgets and creates them if found.
 *
 * Returns 0 for success.
 */
2742
int snd_soc_dapm_new_widgets(struct snd_soc_card *card)
2743 2744
{
	struct snd_soc_dapm_widget *w;
2745
	unsigned int val;
2746

2747
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
2748

2749
	list_for_each_entry(w, &card->widgets, list)
2750 2751 2752 2753
	{
		if (w->new)
			continue;

2754 2755 2756 2757
		if (w->num_kcontrols) {
			w->kcontrols = kzalloc(w->num_kcontrols *
						sizeof(struct snd_kcontrol *),
						GFP_KERNEL);
2758
			if (!w->kcontrols) {
2759
				mutex_unlock(&card->dapm_mutex);
2760
				return -ENOMEM;
2761
			}
2762 2763
		}

2764 2765 2766
		switch(w->id) {
		case snd_soc_dapm_switch:
		case snd_soc_dapm_mixer:
2767
		case snd_soc_dapm_mixer_named_ctl:
2768
			dapm_new_mixer(w);
2769 2770
			break;
		case snd_soc_dapm_mux:
2771
		case snd_soc_dapm_virt_mux:
P
Peter Ujfalusi 已提交
2772
		case snd_soc_dapm_value_mux:
2773
			dapm_new_mux(w);
2774 2775
			break;
		case snd_soc_dapm_pga:
2776
		case snd_soc_dapm_out_drv:
2777
			dapm_new_pga(w);
2778
			break;
2779
		default:
2780 2781
			break;
		}
2782 2783 2784

		/* Read the initial power state from the device */
		if (w->reg >= 0) {
2785 2786 2787
			val = soc_widget_read(w, w->reg) >> w->shift;
			val &= w->mask;
			if (val == w->on_val)
2788 2789 2790
				w->power = 1;
		}

2791
		w->new = 1;
2792

2793
		dapm_mark_dirty(w, "new widget");
2794
		dapm_debugfs_add_widget(w);
2795 2796
	}

2797 2798
	dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
	mutex_unlock(&card->dapm_mutex);
2799 2800 2801 2802 2803 2804 2805
	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);

/**
 * snd_soc_dapm_get_volsw - dapm mixer get callback
 * @kcontrol: mixer control
M
Mark Brown 已提交
2806
 * @ucontrol: control element information
2807 2808 2809 2810 2811 2812 2813 2814
 *
 * Callback to get the value of a dapm mixer control.
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
2815
	struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
2816
	struct snd_soc_card *card = codec->card;
2817 2818
	struct soc_mixer_control *mc =
		(struct soc_mixer_control *)kcontrol->private_value;
2819
	int reg = mc->reg;
2820
	unsigned int shift = mc->shift;
2821
	int max = mc->max;
2822
	unsigned int mask = (1 << fls(max)) - 1;
2823
	unsigned int invert = mc->invert;
2824
	unsigned int val;
2825 2826

	if (snd_soc_volsw_is_stereo(mc))
2827
		dev_warn(codec->dapm.dev,
2828
			 "ASoC: Control '%s' is stereo, which is not supported\n",
2829
			 kcontrol->id.name);
2830

2831
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2832
	if (dapm_kcontrol_is_powered(kcontrol) && reg != SND_SOC_NOPM)
2833 2834 2835 2836 2837
		val = (snd_soc_read(codec, reg) >> shift) & mask;
	else
		val = dapm_kcontrol_get_value(kcontrol);
	mutex_unlock(&card->dapm_mutex);

2838
	if (invert)
2839 2840 2841
		ucontrol->value.integer.value[0] = max - val;
	else
		ucontrol->value.integer.value[0] = val;
2842 2843 2844 2845 2846 2847 2848 2849

	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);

/**
 * snd_soc_dapm_put_volsw - dapm mixer set callback
 * @kcontrol: mixer control
M
Mark Brown 已提交
2850
 * @ucontrol: control element information
2851 2852 2853 2854 2855 2856 2857 2858
 *
 * Callback to set the value of a dapm mixer control.
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
2859
	struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
2860
	struct snd_soc_card *card = codec->card;
2861 2862
	struct soc_mixer_control *mc =
		(struct soc_mixer_control *)kcontrol->private_value;
2863
	int reg = mc->reg;
2864
	unsigned int shift = mc->shift;
2865
	int max = mc->max;
2866 2867
	unsigned int mask = (1 << fls(max)) - 1;
	unsigned int invert = mc->invert;
2868
	unsigned int val;
2869 2870
	int connect, change;
	struct snd_soc_dapm_update update;
2871
	int ret = 0;
2872

2873
	if (snd_soc_volsw_is_stereo(mc))
2874
		dev_warn(codec->dapm.dev,
2875
			 "ASoC: Control '%s' is stereo, which is not supported\n",
2876 2877
			 kcontrol->id.name);

2878
	val = (ucontrol->value.integer.value[0] & mask);
2879
	connect = !!val;
2880 2881

	if (invert)
P
Philipp Zabel 已提交
2882
		val = max - val;
2883

2884
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2885

2886
	change = dapm_kcontrol_set_value(kcontrol, val);
2887

2888 2889 2890 2891 2892 2893
	if (reg != SND_SOC_NOPM) {
		mask = mask << shift;
		val = val << shift;

		change = snd_soc_test_bits(codec, reg, mask, val);
	}
2894

2895
	if (change) {
2896 2897 2898 2899 2900
		if (reg != SND_SOC_NOPM) {
			update.kcontrol = kcontrol;
			update.reg = reg;
			update.mask = mask;
			update.val = val;
2901

2902 2903
			card->update = &update;
		}
2904

2905
		ret = soc_dapm_mixer_update_power(card, kcontrol, connect);
2906

2907
		card->update = NULL;
2908 2909
	}

2910
	mutex_unlock(&card->dapm_mutex);
2911 2912 2913 2914

	if (ret > 0)
		soc_dpcm_runtime_update(card);

2915
	return change;
2916 2917 2918 2919 2920 2921
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);

/**
 * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
 * @kcontrol: mixer control
M
Mark Brown 已提交
2922
 * @ucontrol: control element information
2923 2924 2925 2926 2927 2928 2929 2930
 *
 * Callback to get the value of a dapm enumerated double mixer control.
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
2931
	struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
2932
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2933
	unsigned int val;
2934

2935
	val = snd_soc_read(codec, e->reg);
2936
	ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & e->mask;
2937 2938
	if (e->shift_l != e->shift_r)
		ucontrol->value.enumerated.item[1] =
2939
			(val >> e->shift_r) & e->mask;
2940 2941 2942 2943 2944 2945 2946 2947

	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);

/**
 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
 * @kcontrol: mixer control
M
Mark Brown 已提交
2948
 * @ucontrol: control element information
2949 2950 2951 2952 2953 2954 2955 2956
 *
 * Callback to set the value of a dapm enumerated double mixer control.
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
2957
	struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
2958
	struct snd_soc_card *card = codec->card;
2959
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2960
	unsigned int val, mux, change;
2961
	unsigned int mask;
2962
	struct snd_soc_dapm_update update;
2963
	int ret = 0;
2964

2965
	if (ucontrol->value.enumerated.item[0] > e->max - 1)
2966 2967 2968
		return -EINVAL;
	mux = ucontrol->value.enumerated.item[0];
	val = mux << e->shift_l;
2969
	mask = e->mask << e->shift_l;
2970
	if (e->shift_l != e->shift_r) {
2971
		if (ucontrol->value.enumerated.item[1] > e->max - 1)
2972 2973
			return -EINVAL;
		val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2974
		mask |= e->mask << e->shift_r;
2975 2976
	}

2977
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2978

2979
	change = snd_soc_test_bits(codec, e->reg, mask, val);
2980
	if (change) {
2981 2982 2983 2984
		update.kcontrol = kcontrol;
		update.reg = e->reg;
		update.mask = mask;
		update.val = val;
2985
		card->update = &update;
2986

2987
		ret = soc_dapm_mux_update_power(card, kcontrol, mux, e);
2988

2989
		card->update = NULL;
2990
	}
2991

2992
	mutex_unlock(&card->dapm_mutex);
2993 2994 2995 2996

	if (ret > 0)
		soc_dpcm_runtime_update(card);

2997
	return change;
2998 2999 3000
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);

3001 3002 3003 3004 3005 3006 3007 3008 3009 3010
/**
 * snd_soc_dapm_get_enum_virt - Get virtual DAPM mux
 * @kcontrol: mixer control
 * @ucontrol: control element information
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_get_enum_virt(struct snd_kcontrol *kcontrol,
			       struct snd_ctl_elem_value *ucontrol)
{
3011
	ucontrol->value.enumerated.item[0] = dapm_kcontrol_get_value(kcontrol);
3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025
	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_virt);

/**
 * snd_soc_dapm_put_enum_virt - Set virtual DAPM mux
 * @kcontrol: mixer control
 * @ucontrol: control element information
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_put_enum_virt(struct snd_kcontrol *kcontrol,
			       struct snd_ctl_elem_value *ucontrol)
{
3026
	struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
3027
	struct snd_soc_card *card = codec->card;
3028
	unsigned int value;
3029 3030 3031
	struct soc_enum *e =
		(struct soc_enum *)kcontrol->private_value;
	int change;
3032
	int ret = 0;
3033 3034 3035 3036

	if (ucontrol->value.enumerated.item[0] >= e->max)
		return -EINVAL;

3037
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3038

3039 3040 3041
	value = ucontrol->value.enumerated.item[0];
	change = dapm_kcontrol_set_value(kcontrol, value);
	if (change)
3042
		ret = soc_dapm_mux_update_power(card, kcontrol, value, e);
3043

3044
	mutex_unlock(&card->dapm_mutex);
3045 3046 3047 3048

	if (ret > 0)
		soc_dpcm_runtime_update(card);

3049
	return change;
3050 3051 3052
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_virt);

P
Peter Ujfalusi 已提交
3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068
/**
 * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
 *					callback
 * @kcontrol: mixer control
 * @ucontrol: control element information
 *
 * Callback to get the value of a dapm semi enumerated double mixer control.
 *
 * Semi enumerated mixer: the enumerated items are referred as values. Can be
 * used for handling bitfield coded enumeration for example.
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
3069
	struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
3070
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3071
	unsigned int reg_val, val, mux;
P
Peter Ujfalusi 已提交
3072

3073
	reg_val = snd_soc_read(codec, e->reg);
P
Peter Ujfalusi 已提交
3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108
	val = (reg_val >> e->shift_l) & e->mask;
	for (mux = 0; mux < e->max; mux++) {
		if (val == e->values[mux])
			break;
	}
	ucontrol->value.enumerated.item[0] = mux;
	if (e->shift_l != e->shift_r) {
		val = (reg_val >> e->shift_r) & e->mask;
		for (mux = 0; mux < e->max; mux++) {
			if (val == e->values[mux])
				break;
		}
		ucontrol->value.enumerated.item[1] = mux;
	}

	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);

/**
 * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
 *					callback
 * @kcontrol: mixer control
 * @ucontrol: control element information
 *
 * Callback to set the value of a dapm semi enumerated double mixer control.
 *
 * Semi enumerated mixer: the enumerated items are referred as values. Can be
 * used for handling bitfield coded enumeration for example.
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
3109
	struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
3110
	struct snd_soc_card *card = codec->card;
3111
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3112
	unsigned int val, mux, change;
3113
	unsigned int mask;
3114
	struct snd_soc_dapm_update update;
3115
	int ret = 0;
P
Peter Ujfalusi 已提交
3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128

	if (ucontrol->value.enumerated.item[0] > e->max - 1)
		return -EINVAL;
	mux = ucontrol->value.enumerated.item[0];
	val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
	mask = e->mask << e->shift_l;
	if (e->shift_l != e->shift_r) {
		if (ucontrol->value.enumerated.item[1] > e->max - 1)
			return -EINVAL;
		val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
		mask |= e->mask << e->shift_r;
	}

3129
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3130

3131
	change = snd_soc_test_bits(codec, e->reg, mask, val);
3132
	if (change) {
3133 3134 3135 3136
		update.kcontrol = kcontrol;
		update.reg = e->reg;
		update.mask = mask;
		update.val = val;
3137
		card->update = &update;
3138

3139
		ret = soc_dapm_mux_update_power(card, kcontrol, mux, e);
3140

3141
		card->update = NULL;
3142
	}
P
Peter Ujfalusi 已提交
3143

3144
	mutex_unlock(&card->dapm_mutex);
3145 3146 3147 3148

	if (ret > 0)
		soc_dpcm_runtime_update(card);

3149
	return change;
P
Peter Ujfalusi 已提交
3150 3151 3152
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);

3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181
/**
 * snd_soc_dapm_info_pin_switch - Info for a pin switch
 *
 * @kcontrol: mixer control
 * @uinfo: control element information
 *
 * Callback to provide information about a pin switch control.
 */
int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_info *uinfo)
{
	uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
	uinfo->count = 1;
	uinfo->value.integer.min = 0;
	uinfo->value.integer.max = 1;

	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);

/**
 * snd_soc_dapm_get_pin_switch - Get information for a pin switch
 *
 * @kcontrol: mixer control
 * @ucontrol: Value
 */
int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
				struct snd_ctl_elem_value *ucontrol)
{
3182
	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
3183 3184
	const char *pin = (const char *)kcontrol->private_value;

3185
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3186 3187

	ucontrol->value.integer.value[0] =
3188
		snd_soc_dapm_get_pin_status(&card->dapm, pin);
3189

3190
	mutex_unlock(&card->dapm_mutex);
3191 3192 3193 3194 3195 3196 3197 3198 3199 3200 3201 3202 3203 3204

	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);

/**
 * snd_soc_dapm_put_pin_switch - Set information for a pin switch
 *
 * @kcontrol: mixer control
 * @ucontrol: Value
 */
int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
				struct snd_ctl_elem_value *ucontrol)
{
3205
	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
3206 3207
	const char *pin = (const char *)kcontrol->private_value;

3208
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3209 3210

	if (ucontrol->value.integer.value[0])
3211
		snd_soc_dapm_enable_pin(&card->dapm, pin);
3212
	else
3213
		snd_soc_dapm_disable_pin(&card->dapm, pin);
3214

3215
	mutex_unlock(&card->dapm_mutex);
3216

3217
	snd_soc_dapm_sync(&card->dapm);
3218 3219 3220 3221
	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);

3222 3223 3224
static struct snd_soc_dapm_widget *
snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
			 const struct snd_soc_dapm_widget *widget)
3225 3226
{
	struct snd_soc_dapm_widget *w;
3227
	int ret;
3228 3229

	if ((w = dapm_cnew_widget(widget)) == NULL)
3230
		return NULL;
3231

3232 3233
	switch (w->id) {
	case snd_soc_dapm_regulator_supply:
3234 3235 3236
		w->regulator = devm_regulator_get(dapm->dev, w->name);
		if (IS_ERR(w->regulator)) {
			ret = PTR_ERR(w->regulator);
3237
			dev_err(dapm->dev, "ASoC: Failed to request %s: %d\n",
3238
				w->name, ret);
3239
			return NULL;
3240
		}
3241

3242
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
3243 3244 3245 3246 3247 3248
			ret = regulator_allow_bypass(w->regulator, true);
			if (ret != 0)
				dev_warn(w->dapm->dev,
					 "ASoC: Failed to unbypass %s: %d\n",
					 w->name, ret);
		}
3249
		break;
3250
	case snd_soc_dapm_clock_supply:
3251
#ifdef CONFIG_CLKDEV_LOOKUP
M
Mark Brown 已提交
3252
		w->clk = devm_clk_get(dapm->dev, w->name);
3253 3254
		if (IS_ERR(w->clk)) {
			ret = PTR_ERR(w->clk);
3255
			dev_err(dapm->dev, "ASoC: Failed to request %s: %d\n",
3256 3257 3258
				w->name, ret);
			return NULL;
		}
3259 3260 3261
#else
		return NULL;
#endif
3262
		break;
3263 3264 3265
	default:
		break;
	}
3266

3267
	if (dapm->codec && dapm->codec->name_prefix)
3268 3269 3270 3271 3272
		w->name = kasprintf(GFP_KERNEL, "%s %s",
			dapm->codec->name_prefix, widget->name);
	else
		w->name = kasprintf(GFP_KERNEL, "%s", widget->name);

3273 3274
	if (w->name == NULL) {
		kfree(w);
3275
		return NULL;
3276 3277
	}

3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288
	switch (w->id) {
	case snd_soc_dapm_switch:
	case snd_soc_dapm_mixer:
	case snd_soc_dapm_mixer_named_ctl:
		w->power_check = dapm_generic_check_power;
		break;
	case snd_soc_dapm_mux:
	case snd_soc_dapm_virt_mux:
	case snd_soc_dapm_value_mux:
		w->power_check = dapm_generic_check_power;
		break;
3289
	case snd_soc_dapm_dai_out:
3290 3291
		w->power_check = dapm_adc_check_power;
		break;
3292
	case snd_soc_dapm_dai_in:
3293 3294
		w->power_check = dapm_dac_check_power;
		break;
3295 3296 3297 3298
	case snd_soc_dapm_adc:
	case snd_soc_dapm_aif_out:
	case snd_soc_dapm_dac:
	case snd_soc_dapm_aif_in:
3299 3300 3301 3302 3303 3304 3305 3306 3307
	case snd_soc_dapm_pga:
	case snd_soc_dapm_out_drv:
	case snd_soc_dapm_input:
	case snd_soc_dapm_output:
	case snd_soc_dapm_micbias:
	case snd_soc_dapm_spk:
	case snd_soc_dapm_hp:
	case snd_soc_dapm_mic:
	case snd_soc_dapm_line:
3308
	case snd_soc_dapm_dai_link:
3309 3310 3311
		w->power_check = dapm_generic_check_power;
		break;
	case snd_soc_dapm_supply:
3312
	case snd_soc_dapm_regulator_supply:
3313
	case snd_soc_dapm_clock_supply:
3314
	case snd_soc_dapm_kcontrol:
3315 3316 3317 3318 3319 3320 3321
		w->power_check = dapm_supply_check_power;
		break;
	default:
		w->power_check = dapm_always_on_check_power;
		break;
	}

L
Liam Girdwood 已提交
3322 3323
	w->dapm = dapm;
	w->codec = dapm->codec;
3324
	w->platform = dapm->platform;
3325 3326 3327
	INIT_LIST_HEAD(&w->sources);
	INIT_LIST_HEAD(&w->sinks);
	INIT_LIST_HEAD(&w->list);
3328
	INIT_LIST_HEAD(&w->dirty);
3329
	list_add(&w->list, &dapm->card->widgets);
3330 3331 3332

	/* machine layer set ups unconnected pins and insertions */
	w->connected = 1;
3333
	return w;
3334 3335
}

3336 3337
/**
 * snd_soc_dapm_new_controls - create new dapm controls
L
Liam Girdwood 已提交
3338
 * @dapm: DAPM context
3339 3340 3341 3342 3343 3344 3345
 * @widget: widget array
 * @num: number of widgets
 *
 * Creates new DAPM controls based upon the templates.
 *
 * Returns 0 for success else error.
 */
L
Liam Girdwood 已提交
3346
int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
3347 3348 3349
	const struct snd_soc_dapm_widget *widget,
	int num)
{
3350 3351
	struct snd_soc_dapm_widget *w;
	int i;
3352
	int ret = 0;
3353

3354
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
3355
	for (i = 0; i < num; i++) {
3356 3357
		w = snd_soc_dapm_new_control(dapm, widget);
		if (!w) {
3358
			dev_err(dapm->dev,
3359 3360
				"ASoC: Failed to create DAPM control %s\n",
				widget->name);
3361 3362
			ret = -ENOMEM;
			break;
3363
		}
3364 3365
		widget++;
	}
3366
	mutex_unlock(&dapm->card->dapm_mutex);
3367
	return ret;
3368 3369 3370
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);

3371 3372 3373 3374 3375 3376 3377
static int snd_soc_dai_link_event(struct snd_soc_dapm_widget *w,
				  struct snd_kcontrol *kcontrol, int event)
{
	struct snd_soc_dapm_path *source_p, *sink_p;
	struct snd_soc_dai *source, *sink;
	const struct snd_soc_pcm_stream *config = w->params;
	struct snd_pcm_substream substream;
3378
	struct snd_pcm_hw_params *params = NULL;
3379 3380 3381
	u64 fmt;
	int ret;

3382 3383 3384
	if (WARN_ON(!config) ||
	    WARN_ON(list_empty(&w->sources) || list_empty(&w->sinks)))
		return -EINVAL;
3385 3386 3387 3388 3389 3390 3391

	/* We only support a single source and sink, pick the first */
	source_p = list_first_entry(&w->sources, struct snd_soc_dapm_path,
				    list_sink);
	sink_p = list_first_entry(&w->sinks, struct snd_soc_dapm_path,
				  list_source);

3392 3393 3394 3395
	if (WARN_ON(!source_p || !sink_p) ||
	    WARN_ON(!sink_p->source || !source_p->sink) ||
	    WARN_ON(!source_p->source || !sink_p->sink))
		return -EINVAL;
3396 3397 3398 3399 3400 3401 3402 3403

	source = source_p->source->priv;
	sink = sink_p->sink->priv;

	/* Be a little careful as we don't want to overflow the mask array */
	if (config->formats) {
		fmt = ffs(config->formats) - 1;
	} else {
3404
		dev_warn(w->dapm->dev, "ASoC: Invalid format %llx specified\n",
3405 3406 3407 3408 3409
			 config->formats);
		fmt = 0;
	}

	/* Currently very limited parameter selection */
3410 3411 3412 3413 3414 3415
	params = kzalloc(sizeof(*params), GFP_KERNEL);
	if (!params) {
		ret = -ENOMEM;
		goto out;
	}
	snd_mask_set(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT), fmt);
3416

3417
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->min =
3418
		config->rate_min;
3419
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->max =
3420 3421
		config->rate_max;

3422
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->min
3423
		= config->channels_min;
3424
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->max
3425 3426 3427 3428 3429 3430 3431 3432 3433
		= config->channels_max;

	memset(&substream, 0, sizeof(substream));

	switch (event) {
	case SND_SOC_DAPM_PRE_PMU:
		if (source->driver->ops && source->driver->ops->hw_params) {
			substream.stream = SNDRV_PCM_STREAM_CAPTURE;
			ret = source->driver->ops->hw_params(&substream,
3434
							     params, source);
3435 3436
			if (ret != 0) {
				dev_err(source->dev,
3437
					"ASoC: hw_params() failed: %d\n", ret);
3438
				goto out;
3439 3440 3441 3442 3443
			}
		}

		if (sink->driver->ops && sink->driver->ops->hw_params) {
			substream.stream = SNDRV_PCM_STREAM_PLAYBACK;
3444
			ret = sink->driver->ops->hw_params(&substream, params,
3445 3446 3447
							   sink);
			if (ret != 0) {
				dev_err(sink->dev,
3448
					"ASoC: hw_params() failed: %d\n", ret);
3449
				goto out;
3450 3451 3452 3453 3454
			}
		}
		break;

	case SND_SOC_DAPM_POST_PMU:
3455 3456
		ret = snd_soc_dai_digital_mute(sink, 0,
					       SNDRV_PCM_STREAM_PLAYBACK);
3457
		if (ret != 0 && ret != -ENOTSUPP)
3458
			dev_warn(sink->dev, "ASoC: Failed to unmute: %d\n", ret);
3459
		ret = 0;
3460 3461 3462
		break;

	case SND_SOC_DAPM_PRE_PMD:
3463 3464
		ret = snd_soc_dai_digital_mute(sink, 1,
					       SNDRV_PCM_STREAM_PLAYBACK);
3465
		if (ret != 0 && ret != -ENOTSUPP)
3466
			dev_warn(sink->dev, "ASoC: Failed to mute: %d\n", ret);
3467
		ret = 0;
3468 3469 3470
		break;

	default:
T
Takashi Iwai 已提交
3471
		WARN(1, "Unknown event %d\n", event);
3472 3473 3474
		return -EINVAL;
	}

3475 3476 3477
out:
	kfree(params);
	return ret;
3478 3479 3480 3481 3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494 3495 3496 3497 3498 3499 3500 3501 3502 3503 3504
}

int snd_soc_dapm_new_pcm(struct snd_soc_card *card,
			 const struct snd_soc_pcm_stream *params,
			 struct snd_soc_dapm_widget *source,
			 struct snd_soc_dapm_widget *sink)
{
	struct snd_soc_dapm_route routes[2];
	struct snd_soc_dapm_widget template;
	struct snd_soc_dapm_widget *w;
	size_t len;
	char *link_name;

	len = strlen(source->name) + strlen(sink->name) + 2;
	link_name = devm_kzalloc(card->dev, len, GFP_KERNEL);
	if (!link_name)
		return -ENOMEM;
	snprintf(link_name, len, "%s-%s", source->name, sink->name);

	memset(&template, 0, sizeof(template));
	template.reg = SND_SOC_NOPM;
	template.id = snd_soc_dapm_dai_link;
	template.name = link_name;
	template.event = snd_soc_dai_link_event;
	template.event_flags = SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
		SND_SOC_DAPM_PRE_PMD;

3505
	dev_dbg(card->dev, "ASoC: adding %s widget\n", link_name);
3506 3507 3508

	w = snd_soc_dapm_new_control(&card->dapm, &template);
	if (!w) {
3509
		dev_err(card->dev, "ASoC: Failed to create %s widget\n",
3510 3511 3512 3513 3514 3515 3516 3517 3518 3519 3520 3521 3522 3523 3524 3525 3526
			link_name);
		return -ENOMEM;
	}

	w->params = params;

	memset(&routes, 0, sizeof(routes));

	routes[0].source = source->name;
	routes[0].sink = link_name;
	routes[1].source = link_name;
	routes[1].sink = sink->name;

	return snd_soc_dapm_add_routes(&card->dapm, routes,
				       ARRAY_SIZE(routes));
}

3527 3528
int snd_soc_dapm_new_dai_widgets(struct snd_soc_dapm_context *dapm,
				 struct snd_soc_dai *dai)
3529
{
3530
	struct snd_soc_dapm_widget template;
3531 3532
	struct snd_soc_dapm_widget *w;

3533 3534 3535 3536 3537 3538
	WARN_ON(dapm->dev != dai->dev);

	memset(&template, 0, sizeof(template));
	template.reg = SND_SOC_NOPM;

	if (dai->driver->playback.stream_name) {
3539
		template.id = snd_soc_dapm_dai_in;
3540 3541 3542
		template.name = dai->driver->playback.stream_name;
		template.sname = dai->driver->playback.stream_name;

3543
		dev_dbg(dai->dev, "ASoC: adding %s widget\n",
3544 3545 3546 3547
			template.name);

		w = snd_soc_dapm_new_control(dapm, &template);
		if (!w) {
3548
			dev_err(dapm->dev, "ASoC: Failed to create %s widget\n",
3549
				dai->driver->playback.stream_name);
3550
			return -ENOMEM;
3551 3552 3553 3554 3555 3556 3557
		}

		w->priv = dai;
		dai->playback_widget = w;
	}

	if (dai->driver->capture.stream_name) {
3558
		template.id = snd_soc_dapm_dai_out;
3559 3560 3561
		template.name = dai->driver->capture.stream_name;
		template.sname = dai->driver->capture.stream_name;

3562
		dev_dbg(dai->dev, "ASoC: adding %s widget\n",
3563 3564 3565 3566
			template.name);

		w = snd_soc_dapm_new_control(dapm, &template);
		if (!w) {
3567
			dev_err(dapm->dev, "ASoC: Failed to create %s widget\n",
3568
				dai->driver->capture.stream_name);
3569
			return -ENOMEM;
3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585
		}

		w->priv = dai;
		dai->capture_widget = w;
	}

	return 0;
}

int snd_soc_dapm_link_dai_widgets(struct snd_soc_card *card)
{
	struct snd_soc_dapm_widget *dai_w, *w;
	struct snd_soc_dai *dai;

	/* For each DAI widget... */
	list_for_each_entry(dai_w, &card->widgets, list) {
3586 3587 3588 3589 3590
		switch (dai_w->id) {
		case snd_soc_dapm_dai_in:
		case snd_soc_dapm_dai_out:
			break;
		default:
3591
			continue;
3592
		}
3593 3594 3595 3596 3597 3598 3599 3600

		dai = dai_w->priv;

		/* ...find all widgets with the same stream and link them */
		list_for_each_entry(w, &card->widgets, list) {
			if (w->dapm != dai_w->dapm)
				continue;

3601 3602 3603
			switch (w->id) {
			case snd_soc_dapm_dai_in:
			case snd_soc_dapm_dai_out:
3604
				continue;
3605 3606 3607
			default:
				break;
			}
3608

R
Russell King 已提交
3609
			if (!w->sname || !strstr(w->sname, dai_w->name))
3610 3611 3612 3613 3614 3615
				continue;

			if (dai->driver->playback.stream_name &&
			    strstr(w->sname,
				   dai->driver->playback.stream_name)) {
				dev_dbg(dai->dev, "%s -> %s\n",
3616
					 dai->playback_widget->name, w->name);
3617

3618 3619
				snd_soc_dapm_add_path(w->dapm,
					dai->playback_widget, w, NULL, NULL);
3620 3621 3622 3623 3624 3625
			}

			if (dai->driver->capture.stream_name &&
			    strstr(w->sname,
				   dai->driver->capture.stream_name)) {
				dev_dbg(dai->dev, "%s -> %s\n",
3626
					w->name, dai->capture_widget->name);
3627

3628 3629
				snd_soc_dapm_add_path(w->dapm, w,
					dai->capture_widget, NULL, NULL);
3630 3631 3632 3633
			}
		}
	}

3634 3635
	return 0;
}
3636

3637 3638
static void soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
	int event)
3639
{
3640

3641 3642 3643
	struct snd_soc_dapm_widget *w_cpu, *w_codec;
	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
	struct snd_soc_dai *codec_dai = rtd->codec_dai;
3644

3645 3646 3647 3648 3649 3650 3651
	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
		w_cpu = cpu_dai->playback_widget;
		w_codec = codec_dai->playback_widget;
	} else {
		w_cpu = cpu_dai->capture_widget;
		w_codec = codec_dai->capture_widget;
	}
3652

3653
	if (w_cpu) {
3654

3655 3656 3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678 3679 3680 3681 3682 3683 3684 3685 3686 3687 3688
		dapm_mark_dirty(w_cpu, "stream event");

		switch (event) {
		case SND_SOC_DAPM_STREAM_START:
			w_cpu->active = 1;
			break;
		case SND_SOC_DAPM_STREAM_STOP:
			w_cpu->active = 0;
			break;
		case SND_SOC_DAPM_STREAM_SUSPEND:
		case SND_SOC_DAPM_STREAM_RESUME:
		case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
		case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
			break;
		}
	}

	if (w_codec) {

		dapm_mark_dirty(w_codec, "stream event");

		switch (event) {
		case SND_SOC_DAPM_STREAM_START:
			w_codec->active = 1;
			break;
		case SND_SOC_DAPM_STREAM_STOP:
			w_codec->active = 0;
			break;
		case SND_SOC_DAPM_STREAM_SUSPEND:
		case SND_SOC_DAPM_STREAM_RESUME:
		case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
		case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
			break;
		}
3689 3690
	}

3691
	dapm_power_widgets(rtd->card, event);
L
Liam Girdwood 已提交
3692 3693 3694 3695 3696 3697 3698 3699 3700 3701 3702 3703 3704
}

/**
 * snd_soc_dapm_stream_event - send a stream event to the dapm core
 * @rtd: PCM runtime data
 * @stream: stream name
 * @event: stream event
 *
 * Sends a stream event to the dapm core. The core then makes any
 * necessary widget power changes.
 *
 * Returns 0 for success else error.
 */
3705 3706
void snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
			      int event)
L
Liam Girdwood 已提交
3707
{
3708
	struct snd_soc_card *card = rtd->card;
L
Liam Girdwood 已提交
3709

3710
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3711
	soc_dapm_stream_event(rtd, stream, event);
3712
	mutex_unlock(&card->dapm_mutex);
3713 3714 3715
}

/**
3716
 * snd_soc_dapm_enable_pin - enable pin.
L
Liam Girdwood 已提交
3717
 * @dapm: DAPM context
3718
 * @pin: pin name
3719
 *
M
Mark Brown 已提交
3720
 * Enables input/output pin and its parents or children widgets iff there is
3721 3722 3723
 * a valid audio route and active audio stream.
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
3724
 */
L
Liam Girdwood 已提交
3725
int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
3726
{
L
Liam Girdwood 已提交
3727
	return snd_soc_dapm_set_pin(dapm, pin, 1);
3728 3729
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
3730

3731 3732
/**
 * snd_soc_dapm_force_enable_pin - force a pin to be enabled
L
Liam Girdwood 已提交
3733
 * @dapm: DAPM context
3734 3735 3736 3737 3738 3739 3740 3741 3742
 * @pin: pin name
 *
 * Enables input/output pin regardless of any other state.  This is
 * intended for use with microphone bias supplies used in microphone
 * jack detection.
 *
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
L
Liam Girdwood 已提交
3743 3744
int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
				  const char *pin)
3745
{
3746
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
3747

3748
	if (!w) {
3749
		dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
3750
		return -EINVAL;
3751 3752
	}

3753
	dev_dbg(w->dapm->dev, "ASoC: force enable pin %s\n", pin);
3754 3755
	w->connected = 1;
	w->force = 1;
3756
	dapm_mark_dirty(w, "force enable");
3757

3758
	return 0;
3759 3760 3761
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);

3762 3763
/**
 * snd_soc_dapm_disable_pin - disable pin.
L
Liam Girdwood 已提交
3764
 * @dapm: DAPM context
3765 3766
 * @pin: pin name
 *
M
Mark Brown 已提交
3767
 * Disables input/output pin and its parents or children widgets.
3768 3769 3770
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
L
Liam Girdwood 已提交
3771 3772
int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
			     const char *pin)
3773
{
L
Liam Girdwood 已提交
3774
	return snd_soc_dapm_set_pin(dapm, pin, 0);
3775
}
3776
EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
3777

3778 3779
/**
 * snd_soc_dapm_nc_pin - permanently disable pin.
L
Liam Girdwood 已提交
3780
 * @dapm: DAPM context
3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791
 * @pin: pin name
 *
 * Marks the specified pin as being not connected, disabling it along
 * any parent or child widgets.  At present this is identical to
 * snd_soc_dapm_disable_pin() but in future it will be extended to do
 * additional things such as disabling controls which only affect
 * paths through the pin.
 *
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
L
Liam Girdwood 已提交
3792
int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
3793
{
L
Liam Girdwood 已提交
3794
	return snd_soc_dapm_set_pin(dapm, pin, 0);
3795 3796 3797
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);

3798
/**
3799
 * snd_soc_dapm_get_pin_status - get audio pin status
L
Liam Girdwood 已提交
3800
 * @dapm: DAPM context
3801
 * @pin: audio signal pin endpoint (or start point)
3802
 *
3803
 * Get audio pin status - connected or disconnected.
3804
 *
3805
 * Returns 1 for connected otherwise 0.
3806
 */
L
Liam Girdwood 已提交
3807 3808
int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
				const char *pin)
3809
{
3810
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
3811

3812 3813
	if (w)
		return w->connected;
3814

3815 3816
	return 0;
}
3817
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
3818

3819 3820
/**
 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
L
Liam Girdwood 已提交
3821
 * @dapm: DAPM context
3822 3823 3824 3825 3826 3827 3828 3829
 * @pin: audio signal pin endpoint (or start point)
 *
 * Mark the given endpoint or pin as ignoring suspend.  When the
 * system is disabled a path between two endpoints flagged as ignoring
 * suspend will not be disabled.  The path must already be enabled via
 * normal means at suspend time, it will not be turned on if it was not
 * already enabled.
 */
L
Liam Girdwood 已提交
3830 3831
int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
				const char *pin)
3832
{
3833
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
3834

3835
	if (!w) {
3836
		dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
3837
		return -EINVAL;
3838 3839
	}

3840 3841 3842
	w->ignore_suspend = 1;

	return 0;
3843 3844 3845
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);

3846 3847 3848 3849 3850 3851 3852 3853 3854 3855 3856 3857 3858 3859 3860 3861 3862 3863 3864 3865 3866 3867 3868 3869 3870 3871 3872 3873 3874 3875 3876 3877 3878 3879 3880 3881 3882 3883 3884 3885 3886 3887 3888 3889 3890 3891 3892 3893 3894
static bool snd_soc_dapm_widget_in_card_paths(struct snd_soc_card *card,
					      struct snd_soc_dapm_widget *w)
{
	struct snd_soc_dapm_path *p;

	list_for_each_entry(p, &card->paths, list) {
		if ((p->source == w) || (p->sink == w)) {
			dev_dbg(card->dev,
			    "... Path %s(id:%d dapm:%p) - %s(id:%d dapm:%p)\n",
			    p->source->name, p->source->id, p->source->dapm,
			    p->sink->name, p->sink->id, p->sink->dapm);

			/* Connected to something other than the codec */
			if (p->source->dapm != p->sink->dapm)
				return true;
			/*
			 * Loopback connection from codec external pin to
			 * codec external pin
			 */
			if (p->sink->id == snd_soc_dapm_input) {
				switch (p->source->id) {
				case snd_soc_dapm_output:
				case snd_soc_dapm_micbias:
					return true;
				default:
					break;
				}
			}
		}
	}

	return false;
}

/**
 * snd_soc_dapm_auto_nc_codec_pins - call snd_soc_dapm_nc_pin for unused pins
 * @codec: The codec whose pins should be processed
 *
 * Automatically call snd_soc_dapm_nc_pin() for any external pins in the codec
 * which are unused. Pins are used if they are connected externally to the
 * codec, whether that be to some other device, or a loop-back connection to
 * the codec itself.
 */
void snd_soc_dapm_auto_nc_codec_pins(struct snd_soc_codec *codec)
{
	struct snd_soc_card *card = codec->card;
	struct snd_soc_dapm_context *dapm = &codec->dapm;
	struct snd_soc_dapm_widget *w;

3895
	dev_dbg(codec->dev, "ASoC: Auto NC: DAPMs: card:%p codec:%p\n",
3896 3897 3898 3899 3900 3901 3902 3903 3904
		&card->dapm, &codec->dapm);

	list_for_each_entry(w, &card->widgets, list) {
		if (w->dapm != dapm)
			continue;
		switch (w->id) {
		case snd_soc_dapm_input:
		case snd_soc_dapm_output:
		case snd_soc_dapm_micbias:
3905
			dev_dbg(codec->dev, "ASoC: Auto NC: Checking widget %s\n",
3906 3907
				w->name);
			if (!snd_soc_dapm_widget_in_card_paths(card, w)) {
3908
				dev_dbg(codec->dev,
3909 3910 3911 3912 3913 3914 3915 3916 3917 3918
					"... Not in map; disabling\n");
				snd_soc_dapm_nc_pin(dapm, w->name);
			}
			break;
		default:
			break;
		}
	}
}

3919 3920
/**
 * snd_soc_dapm_free - free dapm resources
3921
 * @dapm: DAPM context
3922 3923 3924
 *
 * Free all dapm widgets and resources.
 */
L
Liam Girdwood 已提交
3925
void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
3926
{
L
Liam Girdwood 已提交
3927
	snd_soc_dapm_sys_remove(dapm->dev);
3928
	dapm_debugfs_cleanup(dapm);
L
Liam Girdwood 已提交
3929
	dapm_free_widgets(dapm);
3930
	list_del(&dapm->list);
3931 3932 3933
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_free);

L
Liam Girdwood 已提交
3934
static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
M
Mark Brown 已提交
3935
{
3936
	struct snd_soc_card *card = dapm->card;
M
Mark Brown 已提交
3937 3938 3939 3940
	struct snd_soc_dapm_widget *w;
	LIST_HEAD(down_list);
	int powerdown = 0;

3941 3942
	mutex_lock(&card->dapm_mutex);

3943 3944 3945
	list_for_each_entry(w, &dapm->card->widgets, list) {
		if (w->dapm != dapm)
			continue;
M
Mark Brown 已提交
3946
		if (w->power) {
3947
			dapm_seq_insert(w, &down_list, false);
3948
			w->power = 0;
M
Mark Brown 已提交
3949 3950 3951 3952 3953 3954 3955 3956
			powerdown = 1;
		}
	}

	/* If there were no widgets to power down we're already in
	 * standby.
	 */
	if (powerdown) {
3957 3958 3959
		if (dapm->bias_level == SND_SOC_BIAS_ON)
			snd_soc_dapm_set_bias_level(dapm,
						    SND_SOC_BIAS_PREPARE);
3960
		dapm_seq_run(card, &down_list, 0, false);
3961 3962 3963
		if (dapm->bias_level == SND_SOC_BIAS_PREPARE)
			snd_soc_dapm_set_bias_level(dapm,
						    SND_SOC_BIAS_STANDBY);
M
Mark Brown 已提交
3964
	}
3965 3966

	mutex_unlock(&card->dapm_mutex);
3967 3968 3969 3970 3971 3972 3973 3974 3975
}

/*
 * snd_soc_dapm_shutdown - callback for system shutdown
 */
void snd_soc_dapm_shutdown(struct snd_soc_card *card)
{
	struct snd_soc_codec *codec;

3976
	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
L
Liam Girdwood 已提交
3977
		soc_dapm_shutdown_codec(&codec->dapm);
3978 3979 3980
		if (codec->dapm.bias_level == SND_SOC_BIAS_STANDBY)
			snd_soc_dapm_set_bias_level(&codec->dapm,
						    SND_SOC_BIAS_OFF);
L
Liam Girdwood 已提交
3981
	}
M
Mark Brown 已提交
3982 3983
}

3984
/* Module information */
3985
MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
3986 3987
MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
MODULE_LICENSE("GPL");