soc-dapm.c 117.0 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
// SPDX-License-Identifier: GPL-2.0+
//
// soc-dapm.c  --  ALSA SoC Dynamic Audio Power Management
//
// Copyright 2005 Wolfson Microelectronics PLC.
// Author: Liam Girdwood <lrg@slimlogic.co.uk>
//
//  Features:
//    o Changes power status of internal codec blocks depending on the
//      dynamic configuration of codec internal audio paths and active
//      DACs/ADCs.
//    o Platform power domain - can support external components i.e. amps and
//      mic/headphone insertion events.
//    o Automatic Mic Bias support
//    o Jack insertion power event initiation - e.g. hp insertion will enable
//      sinks, dacs, etc
//    o Delayed power down of audio subsystem to reduce pops between a quick
//      device reopen.
19 20 21

#include <linux/module.h>
#include <linux/init.h>
22
#include <linux/async.h>
23 24 25 26 27
#include <linux/delay.h>
#include <linux/pm.h>
#include <linux/bitops.h>
#include <linux/platform_device.h>
#include <linux/jiffies.h>
28
#include <linux/debugfs.h>
29
#include <linux/pm_runtime.h>
30
#include <linux/regulator/consumer.h>
31
#include <linux/pinctrl/consumer.h>
32
#include <linux/clk.h>
33
#include <linux/slab.h>
34 35 36
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
L
Liam Girdwood 已提交
37
#include <sound/soc.h>
38 39
#include <sound/initval.h>

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

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

44 45 46 47 48 49 50
#define SND_SOC_DAPM_DIR_REVERSE(x) ((x == SND_SOC_DAPM_DIR_IN) ? \
	SND_SOC_DAPM_DIR_OUT : SND_SOC_DAPM_DIR_IN)

#define snd_soc_dapm_for_each_direction(dir) \
	for ((dir) = SND_SOC_DAPM_DIR_IN; (dir) <= SND_SOC_DAPM_DIR_OUT; \
		(dir)++)

51 52 53 54 55
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));
56

57
struct snd_soc_dapm_widget *
58 59 60
snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
			 const struct snd_soc_dapm_widget *widget);

61 62
struct snd_soc_dapm_widget *
snd_soc_dapm_new_control_unlocked(struct snd_soc_dapm_context *dapm,
63 64
			 const struct snd_soc_dapm_widget *widget);

65 66
/* dapm power sequences - make this per codec in the future */
static int dapm_up_seq[] = {
67
	[snd_soc_dapm_pre] = 0,
68
	[snd_soc_dapm_regulator_supply] = 1,
69
	[snd_soc_dapm_pinctrl] = 1,
70
	[snd_soc_dapm_clock_supply] = 1,
71 72
	[snd_soc_dapm_supply] = 2,
	[snd_soc_dapm_micbias] = 3,
73
	[snd_soc_dapm_dai_link] = 2,
74 75 76 77 78 79
	[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,
80
	[snd_soc_dapm_demux] = 6,
81 82 83 84 85 86 87 88 89 90 91 92
	[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,
93
};
94

95
static int dapm_down_seq[] = {
96
	[snd_soc_dapm_pre] = 0,
97 98 99 100 101 102
	[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,
103
	[snd_soc_dapm_pga] = 4,
104
	[snd_soc_dapm_switch] = 5,
105
	[snd_soc_dapm_mixer_named_ctl] = 5,
106 107 108 109 110
	[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,
111
	[snd_soc_dapm_demux] = 9,
112 113
	[snd_soc_dapm_aif_in] = 10,
	[snd_soc_dapm_aif_out] = 10,
114 115
	[snd_soc_dapm_dai_in] = 10,
	[snd_soc_dapm_dai_out] = 10,
116 117
	[snd_soc_dapm_dai_link] = 11,
	[snd_soc_dapm_supply] = 12,
118
	[snd_soc_dapm_clock_supply] = 13,
119
	[snd_soc_dapm_pinctrl] = 13,
120 121
	[snd_soc_dapm_regulator_supply] = 13,
	[snd_soc_dapm_post] = 14,
122 123
};

124 125 126 127 128 129
static void dapm_assert_locked(struct snd_soc_dapm_context *dapm)
{
	if (dapm->card && dapm->card->instantiated)
		lockdep_assert_held(&dapm->card->dapm_mutex);
}

130
static void pop_wait(u32 pop_time)
131 132 133 134 135
{
	if (pop_time)
		schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
}

136
static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
137 138
{
	va_list args;
139
	char *buf;
140

141 142
	if (!pop_time)
		return;
143

144 145 146
	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
	if (buf == NULL)
		return;
147

148 149
	va_start(args, fmt);
	vsnprintf(buf, PAGE_SIZE, fmt, args);
150
	dev_info(dev, "%s", buf);
151
	va_end(args);
152 153

	kfree(buf);
154 155
}

156 157 158 159 160
static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w)
{
	return !list_empty(&w->dirty);
}

161
static void dapm_mark_dirty(struct snd_soc_dapm_widget *w, const char *reason)
162
{
163 164
	dapm_assert_locked(w->dapm);

165 166 167
	if (!dapm_dirty_widget(w)) {
		dev_vdbg(w->dapm->dev, "Marking %s dirty due to %s\n",
			 w->name, reason);
168
		list_add_tail(&w->dirty, &w->dapm->card->dapm_dirty);
169
	}
170 171
}

172
/*
173 174 175 176 177
 * Common implementation for dapm_widget_invalidate_input_paths() and
 * dapm_widget_invalidate_output_paths(). The function is inlined since the
 * combined size of the two specialized functions is only marginally larger then
 * the size of the generic function and at the same time the fast path of the
 * specialized functions is significantly smaller than the generic function.
178
 */
179 180
static __always_inline void dapm_widget_invalidate_paths(
	struct snd_soc_dapm_widget *w, enum snd_soc_dapm_direction dir)
181
{
182 183
	enum snd_soc_dapm_direction rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
	struct snd_soc_dapm_widget *node;
184 185 186 187 188
	struct snd_soc_dapm_path *p;
	LIST_HEAD(list);

	dapm_assert_locked(w->dapm);

189
	if (w->endpoints[dir] == -1)
190 191 192
		return;

	list_add_tail(&w->work_list, &list);
193
	w->endpoints[dir] = -1;
194 195

	list_for_each_entry(w, &list, work_list) {
196
		snd_soc_dapm_widget_for_each_path(w, dir, p) {
197 198
			if (p->is_supply || p->weak || !p->connect)
				continue;
199 200 201 202
			node = p->node[rdir];
			if (node->endpoints[dir] != -1) {
				node->endpoints[dir] = -1;
				list_add_tail(&node->work_list, &list);
203 204 205 206 207
			}
		}
	}
}

208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224
/*
 * dapm_widget_invalidate_input_paths() - Invalidate the cached number of
 *  input paths
 * @w: The widget for which to invalidate the cached number of input paths
 *
 * Resets the cached number of inputs for the specified widget and all widgets
 * that can be reached via outcoming paths from the widget.
 *
 * This function must be called if the number of output paths for a widget might
 * have changed. E.g. if the source state of a widget changes or a path is added
 * or activated with the widget as the sink.
 */
static void dapm_widget_invalidate_input_paths(struct snd_soc_dapm_widget *w)
{
	dapm_widget_invalidate_paths(w, SND_SOC_DAPM_DIR_IN);
}

225 226 227 228 229 230 231 232 233 234 235 236 237 238
/*
 * dapm_widget_invalidate_output_paths() - Invalidate the cached number of
 *  output paths
 * @w: The widget for which to invalidate the cached number of output paths
 *
 * Resets the cached number of outputs for the specified widget and all widgets
 * that can be reached via incoming paths from the widget.
 *
 * This function must be called if the number of output paths for a widget might
 * have changed. E.g. if the sink state of a widget changes or a path is added
 * or activated with the widget as the source.
 */
static void dapm_widget_invalidate_output_paths(struct snd_soc_dapm_widget *w)
{
239
	dapm_widget_invalidate_paths(w, SND_SOC_DAPM_DIR_OUT);
240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267
}

/*
 * dapm_path_invalidate() - Invalidates the cached number of inputs and outputs
 *  for the widgets connected to a path
 * @p: The path to invalidate
 *
 * Resets the cached number of inputs for the sink of the path and the cached
 * number of outputs for the source of the path.
 *
 * This function must be called when a path is added, removed or the connected
 * state changes.
 */
static void dapm_path_invalidate(struct snd_soc_dapm_path *p)
{
	/*
	 * Weak paths or supply paths do not influence the number of input or
	 * output paths of their neighbors.
	 */
	if (p->weak || p->is_supply)
		return;

	/*
	 * The number of connected endpoints is the sum of the number of
	 * connected endpoints of all neighbors. If a node with 0 connected
	 * endpoints is either connected or disconnected that sum won't change,
	 * so there is no need to re-check the path.
	 */
268
	if (p->source->endpoints[SND_SOC_DAPM_DIR_IN] != 0)
269
		dapm_widget_invalidate_input_paths(p->sink);
270
	if (p->sink->endpoints[SND_SOC_DAPM_DIR_OUT] != 0)
271 272 273
		dapm_widget_invalidate_output_paths(p->source);
}

274
void dapm_mark_endpoints_dirty(struct snd_soc_card *card)
275 276 277 278 279 280
{
	struct snd_soc_dapm_widget *w;

	mutex_lock(&card->dapm_mutex);

	list_for_each_entry(w, &card->widgets, list) {
281
		if (w->is_ep) {
282
			dapm_mark_dirty(w, "Rechecking endpoints");
283
			if (w->is_ep & SND_SOC_DAPM_EP_SINK)
284
				dapm_widget_invalidate_output_paths(w);
285
			if (w->is_ep & SND_SOC_DAPM_EP_SOURCE)
286 287
				dapm_widget_invalidate_input_paths(w);
		}
288 289 290 291
	}

	mutex_unlock(&card->dapm_mutex);
}
292
EXPORT_SYMBOL_GPL(dapm_mark_endpoints_dirty);
293

294
/* create a new dapm widget */
295
static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
296 297
	const struct snd_soc_dapm_widget *_widget)
{
298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313
	struct snd_soc_dapm_widget *w;

	w = kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
	if (!w)
		return NULL;

	/*
	 * w->name is duplicated in caller, but w->sname isn't.
	 * Duplicate it here if defined
	 */
	if (_widget->sname) {
		w->sname = kstrdup_const(_widget->sname, GFP_KERNEL);
		if (!w->sname)
			return NULL;
	}
	return w;
314 315
}

316
struct dapm_kcontrol_data {
317
	unsigned int value;
318
	struct snd_soc_dapm_widget *widget;
319
	struct list_head paths;
320
	struct snd_soc_dapm_widget_list *wlist;
321 322 323
};

static int dapm_kcontrol_data_alloc(struct snd_soc_dapm_widget *widget,
324
	struct snd_kcontrol *kcontrol, const char *ctrl_name)
325 326
{
	struct dapm_kcontrol_data *data;
327
	struct soc_mixer_control *mc;
328
	struct soc_enum *e;
329 330
	const char *name;
	int ret;
331

332
	data = kzalloc(sizeof(*data), GFP_KERNEL);
333
	if (!data)
334 335
		return -ENOMEM;

336
	INIT_LIST_HEAD(&data->paths);
337

338 339 340 341 342 343
	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;

344 345 346 347 348
		if (mc->autodisable && snd_soc_volsw_is_stereo(mc))
			dev_warn(widget->dapm->dev,
				 "ASoC: Unsupported stereo autodisable control '%s'\n",
				 ctrl_name);

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

352
			name = kasprintf(GFP_KERNEL, "%s %s", ctrl_name,
353 354 355 356 357 358
					 "Autodisable");
			if (!name) {
				ret = -ENOMEM;
				goto err_data;
			}

359 360 361 362 363 364 365 366 367 368
			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;
369
			template.name = name;
370

371 372
			data->value = template.on_val;

373 374
			data->widget =
				snd_soc_dapm_new_control_unlocked(widget->dapm,
375
				&template);
376
			kfree(name);
377 378 379 380
			if (IS_ERR(data->widget)) {
				ret = PTR_ERR(data->widget);
				goto err_data;
			}
381 382
		}
		break;
383
	case snd_soc_dapm_demux:
384 385 386 387 388 389
	case snd_soc_dapm_mux:
		e = (struct soc_enum *)kcontrol->private_value;

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

390
			name = kasprintf(GFP_KERNEL, "%s %s", ctrl_name,
391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407
					 "Autodisable");
			if (!name) {
				ret = -ENOMEM;
				goto err_data;
			}

			memset(&template, 0, sizeof(template));
			template.reg = e->reg;
			template.mask = e->mask << e->shift_l;
			template.shift = e->shift_l;
			template.off_val = snd_soc_enum_item_to_val(e, 0);
			template.on_val = template.off_val;
			template.id = snd_soc_dapm_kcontrol;
			template.name = name;

			data->value = template.on_val;

408 409
			data->widget = snd_soc_dapm_new_control_unlocked(
						widget->dapm, &template);
410
			kfree(name);
411 412 413 414
			if (IS_ERR(data->widget)) {
				ret = PTR_ERR(data->widget);
				goto err_data;
			}
415 416 417 418 419

			snd_soc_dapm_add_path(widget->dapm, data->widget,
					      widget, NULL, NULL);
		}
		break;
420 421 422 423
	default:
		break;
	}

424 425 426
	kcontrol->private_data = data;

	return 0;
427 428 429 430

err_data:
	kfree(data);
	return ret;
431 432 433 434 435
}

static void dapm_kcontrol_free(struct snd_kcontrol *kctl)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kctl);
436 437

	list_del(&data->paths);
438
	kfree(data->wlist);
439 440 441 442 443 444 445 446
	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);

447
	return data->wlist;
448 449 450 451 452 453
}

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);
454 455
	struct snd_soc_dapm_widget_list *new_wlist;
	unsigned int n;
456

457 458 459 460 461 462 463 464
	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)
465 466
		return -ENOMEM;

467 468
	new_wlist->widgets[n - 1] = widget;
	new_wlist->num_widgets = n;
469

470
	data->wlist = new_wlist;
471 472 473 474

	return 0;
}

475 476 477 478 479 480
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);
481 482 483 484 485 486 487 488 489 490
}

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;
491 492 493 494 495 496 497 498 499 500 501 502 503 504
}

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)

505
unsigned int dapm_kcontrol_get_value(const struct snd_kcontrol *kcontrol)
506 507 508 509 510
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);

	return data->value;
}
511
EXPORT_SYMBOL_GPL(dapm_kcontrol_get_value);
512 513 514 515 516 517 518 519 520

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;

521 522 523
	if (data->widget)
		data->widget->on_val = value;

524 525 526 527 528
	data->value = value;

	return true;
}

529 530 531 532 533 534 535 536 537 538 539 540
/**
 * snd_soc_dapm_kcontrol_widget() - Returns the widget associated to a
 *   kcontrol
 * @kcontrol: The kcontrol
 */
struct snd_soc_dapm_widget *snd_soc_dapm_kcontrol_widget(
				struct snd_kcontrol *kcontrol)
{
	return dapm_kcontrol_get_wlist(kcontrol)->widgets[0];
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_kcontrol_widget);

541 542 543 544 545 546 547 548 549 550 551 552 553 554 555
/**
 * snd_soc_dapm_kcontrol_dapm() - Returns the dapm context associated to a
 *  kcontrol
 * @kcontrol: The kcontrol
 *
 * Note: This function must only be used on kcontrols that are known to have
 * been registered for a CODEC. Otherwise the behaviour is undefined.
 */
struct snd_soc_dapm_context *snd_soc_dapm_kcontrol_dapm(
	struct snd_kcontrol *kcontrol)
{
	return dapm_kcontrol_get_wlist(kcontrol)->widgets[0]->dapm;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_kcontrol_dapm);

556 557 558 559
static void dapm_reset(struct snd_soc_card *card)
{
	struct snd_soc_dapm_widget *w;

560 561
	lockdep_assert_held(&card->dapm_mutex);

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

	list_for_each_entry(w, &card->widgets, list) {
565
		w->new_power = w->power;
566 567 568 569
		w->power_checked = false;
	}
}

570 571 572 573 574 575 576
static const char *soc_dapm_prefix(struct snd_soc_dapm_context *dapm)
{
	if (!dapm->component)
		return NULL;
	return dapm->component->name_prefix;
}

577
static int soc_dapm_read(struct snd_soc_dapm_context *dapm, int reg,
578
	unsigned int *value)
579
{
580
	if (!dapm->component)
581
		return -EIO;
582
	return snd_soc_component_read(dapm->component, reg, value);
583 584
}

585
static int soc_dapm_update_bits(struct snd_soc_dapm_context *dapm,
586
	int reg, unsigned int mask, unsigned int value)
587
{
588
	if (!dapm->component)
589
		return -EIO;
M
Mark Brown 已提交
590 591
	return snd_soc_component_update_bits(dapm->component, reg,
					     mask, value);
592 593
}

594 595 596 597 598 599 600 601
static int soc_dapm_test_bits(struct snd_soc_dapm_context *dapm,
	int reg, unsigned int mask, unsigned int value)
{
	if (!dapm->component)
		return -EIO;
	return snd_soc_component_test_bits(dapm->component, reg, mask, value);
}

602 603
static void soc_dapm_async_complete(struct snd_soc_dapm_context *dapm)
{
604 605
	if (dapm->component)
		snd_soc_component_async_complete(dapm->component);
606 607
}

608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636
static struct snd_soc_dapm_widget *
dapm_wcache_lookup(struct snd_soc_dapm_wcache *wcache, const char *name)
{
	struct snd_soc_dapm_widget *w = wcache->widget;
	struct list_head *wlist;
	const int depth = 2;
	int i = 0;

	if (w) {
		wlist = &w->dapm->card->widgets;

		list_for_each_entry_from(w, wlist, list) {
			if (!strcmp(name, w->name))
				return w;

			if (++i == depth)
				break;
		}
	}

	return NULL;
}

static inline void dapm_wcache_update(struct snd_soc_dapm_wcache *wcache,
				      struct snd_soc_dapm_widget *w)
{
	wcache->widget = w;
}

637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661
/**
 * snd_soc_dapm_force_bias_level() - Sets the DAPM bias level
 * @dapm: The DAPM context for which to set the level
 * @level: The level to set
 *
 * Forces the DAPM bias level to a specific state. It will call the bias level
 * callback of DAPM context with the specified level. This will even happen if
 * the context is already at the same level. Furthermore it will not go through
 * the normal bias level sequencing, meaning any intermediate states between the
 * current and the target state will not be entered.
 *
 * Note that the change in bias level is only temporary and the next time
 * snd_soc_dapm_sync() is called the state will be set to the level as
 * determined by the DAPM core. The function is mainly intended to be used to
 * used during probe or resume from suspend to power up the device so
 * initialization can be done, before the DAPM core takes over.
 */
int snd_soc_dapm_force_bias_level(struct snd_soc_dapm_context *dapm,
	enum snd_soc_bias_level level)
{
	int ret = 0;

	if (dapm->set_bias_level)
		ret = dapm->set_bias_level(dapm, level);

662 663 664
	if (ret == 0)
		dapm->bias_level = level;

665 666 667 668
	return ret;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_force_bias_level);

669 670
/**
 * snd_soc_dapm_set_bias_level - set the bias level for the system
671
 * @dapm: DAPM context
672 673 674 675 676 677
 * @level: level to configure
 *
 * Configure the bias (power) levels for the SoC audio device.
 *
 * Returns 0 for success else error.
 */
678
static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
L
Liam Girdwood 已提交
679
				       enum snd_soc_bias_level level)
680
{
681
	struct snd_soc_card *card = dapm->card;
682 683
	int ret = 0;

M
Mark Brown 已提交
684 685
	trace_snd_soc_bias_level_start(card, level);

686
	if (card && card->set_bias_level)
687
		ret = card->set_bias_level(card, dapm, level);
688 689 690
	if (ret != 0)
		goto out;

691 692
	if (!card || dapm != &card->dapm)
		ret = snd_soc_dapm_force_bias_level(dapm, level);
693

694 695 696 697
	if (ret != 0)
		goto out;

	if (card && card->set_bias_level_post)
698
		ret = card->set_bias_level_post(card, dapm, level);
699
out:
M
Mark Brown 已提交
700 701
	trace_snd_soc_bias_level_done(card, level);

702 703 704
	return ret;
}

M
Mark Brown 已提交
705
/* connect mux widget to its interconnecting audio paths */
L
Liam Girdwood 已提交
706
static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
707 708
	struct snd_soc_dapm_path *path, const char *control_name,
	struct snd_soc_dapm_widget *w)
709
{
710
	const struct snd_kcontrol_new *kcontrol = &w->kcontrol_news[0];
711
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
712
	unsigned int val, item;
713
	int i;
714

715
	if (e->reg != SND_SOC_NOPM) {
716
		soc_dapm_read(dapm, e->reg, &val);
717 718 719
		val = (val >> e->shift_l) & e->mask;
		item = snd_soc_enum_val_to_item(e, val);
	} else {
720 721 722 723 724 725
		/* 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.
		 */
726
		item = 0;
727
	}
P
Peter Ujfalusi 已提交
728

729 730 731 732 733 734 735
	i = match_string(e->texts, e->items, control_name);
	if (i < 0)
		return -ENODEV;

	path->name = e->texts[i];
	path->connect = (i == item);
	return 0;
736 737 738

}

739
/* set up initial codec paths */
740 741
static void dapm_set_mixer_path_status(struct snd_soc_dapm_path *p, int i,
				       int nth_path)
742 743
{
	struct soc_mixer_control *mc = (struct soc_mixer_control *)
744
		p->sink->kcontrol_news[i].private_value;
745 746 747 748 749 750 751 752
	unsigned int reg = mc->reg;
	unsigned int shift = mc->shift;
	unsigned int max = mc->max;
	unsigned int mask = (1 << fls(max)) - 1;
	unsigned int invert = mc->invert;
	unsigned int val;

	if (reg != SND_SOC_NOPM) {
753
		soc_dapm_read(p->sink->dapm, reg, &val);
754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772
		/*
		 * The nth_path argument allows this function to know
		 * which path of a kcontrol it is setting the initial
		 * status for. Ideally this would support any number
		 * of paths and channels. But since kcontrols only come
		 * in mono and stereo variants, we are limited to 2
		 * channels.
		 *
		 * The following code assumes for stereo controls the
		 * first path is the left channel, and all remaining
		 * paths are the right channel.
		 */
		if (snd_soc_volsw_is_stereo(mc) && nth_path > 0) {
			if (reg != mc->rreg)
				soc_dapm_read(p->sink->dapm, mc->rreg, &val);
			val = (val >> mc->rshift) & mask;
		} else {
			val = (val >> shift) & mask;
		}
773 774 775 776 777 778 779 780
		if (invert)
			val = max - val;
		p->connect = !!val;
	} else {
		p->connect = 0;
	}
}

M
Mark Brown 已提交
781
/* connect mixer widget to its interconnecting audio paths */
L
Liam Girdwood 已提交
782
static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
783 784
	struct snd_soc_dapm_path *path, const char *control_name)
{
785
	int i, nth_path = 0;
786 787

	/* search for mixer kcontrol */
788 789 790
	for (i = 0; i < path->sink->num_kcontrols; i++) {
		if (!strcmp(control_name, path->sink->kcontrol_news[i].name)) {
			path->name = path->sink->kcontrol_news[i].name;
791
			dapm_set_mixer_path_status(path, i, nth_path++);
792 793 794 795 796 797
			return 0;
		}
	}
	return -ENODEV;
}

798
static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
799
	struct snd_soc_dapm_widget *kcontrolw,
800 801 802 803 804 805 806 807 808
	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) {
809 810
		if (w == kcontrolw || w->dapm != kcontrolw->dapm)
			continue;
811 812 813 814 815 816 817 818 819 820 821 822
		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;
}

823 824 825 826
/*
 * 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
 */
827
static int dapm_create_or_share_kcontrol(struct snd_soc_dapm_widget *w,
828
	int kci)
829
{
830
	struct snd_soc_dapm_context *dapm = w->dapm;
831
	struct snd_card *card = dapm->card->snd_card;
832
	const char *prefix;
833 834 835 836
	size_t prefix_len;
	int shared;
	struct snd_kcontrol *kcontrol;
	bool wname_in_long_name, kcname_in_long_name;
D
Daniel Mack 已提交
837
	char *long_name = NULL;
838
	const char *name;
D
Daniel Mack 已提交
839
	int ret = 0;
840

841
	prefix = soc_dapm_prefix(dapm);
842 843 844 845 846
	if (prefix)
		prefix_len = strlen(prefix) + 1;
	else
		prefix_len = 0;

847 848
	shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[kci],
					 &kcontrol);
849

850 851 852 853 854 855 856 857
	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:
858
			case snd_soc_dapm_pga:
859
			case snd_soc_dapm_out_drv:
860 861 862 863 864 865 866
				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;
867
			case snd_soc_dapm_demux:
868 869 870 871 872 873
			case snd_soc_dapm_mux:
				wname_in_long_name = true;
				kcname_in_long_name = false;
				break;
			default:
				return -EINVAL;
874
			}
875 876 877 878 879 880 881 882
		}

		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.
883
			 */
884
			long_name = kasprintf(GFP_KERNEL, "%s %s",
885 886
				 w->name + prefix_len,
				 w->kcontrol_news[kci].name);
887
			if (long_name == NULL)
888
				return -ENOMEM;
889 890 891 892 893 894 895 896 897

			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;
		}
898

899
		kcontrol = snd_soc_cnew(&w->kcontrol_news[kci], NULL, name,
900
					prefix);
D
Daniel Mack 已提交
901 902 903 904 905
		if (!kcontrol) {
			ret = -ENOMEM;
			goto exit_free;
		}

906
		kcontrol->private_free = dapm_kcontrol_free;
907

908
		ret = dapm_kcontrol_data_alloc(w, kcontrol, name);
909 910
		if (ret) {
			snd_ctl_free_one(kcontrol);
D
Daniel Mack 已提交
911
			goto exit_free;
912 913
		}

914 915 916 917 918
		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);
D
Daniel Mack 已提交
919
			goto exit_free;
920 921
		}
	}
922

923
	ret = dapm_kcontrol_add_widget(kcontrol, w);
D
Daniel Mack 已提交
924 925
	if (ret == 0)
		w->kcontrols[kci] = kcontrol;
926

D
Daniel Mack 已提交
927 928
exit_free:
	kfree(long_name);
929

D
Daniel Mack 已提交
930
	return ret;
931
}
932

933 934 935 936 937
/* 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;
938
	struct dapm_kcontrol_data *data;
939 940 941 942

	/* add kcontrol */
	for (i = 0; i < w->num_kcontrols; i++) {
		/* match name */
943
		snd_soc_dapm_widget_for_each_source_path(w, path) {
944 945 946 947
			/* mixer/mux paths name must match control name */
			if (path->name != (char *)w->kcontrol_news[i].name)
				continue;

948
			if (!w->kcontrols[i]) {
949
				ret = dapm_create_or_share_kcontrol(w, i);
950 951
				if (ret < 0)
					return ret;
952
			}
953

954
			dapm_kcontrol_add_path(w->kcontrols[i], path);
955 956 957 958 959 960 961

			data = snd_kcontrol_chip(w->kcontrols[i]);
			if (data->widget)
				snd_soc_dapm_add_path(data->widget->dapm,
						      data->widget,
						      path->source,
						      NULL, NULL);
962 963
		}
	}
964 965

	return 0;
966 967 968
}

/* create new dapm mux control */
969
static int dapm_new_mux(struct snd_soc_dapm_widget *w)
970
{
971
	struct snd_soc_dapm_context *dapm = w->dapm;
972
	enum snd_soc_dapm_direction dir;
973
	struct snd_soc_dapm_path *path;
974
	const char *type;
975
	int ret;
976

977 978
	switch (w->id) {
	case snd_soc_dapm_mux:
979
		dir = SND_SOC_DAPM_DIR_OUT;
980 981 982
		type = "mux";
		break;
	case snd_soc_dapm_demux:
983
		dir = SND_SOC_DAPM_DIR_IN;
984 985 986 987 988 989
		type = "demux";
		break;
	default:
		return -EINVAL;
	}

990 991
	if (w->num_kcontrols != 1) {
		dev_err(dapm->dev,
992
			"ASoC: %s %s has incorrect number of controls\n", type,
993
			w->name);
994 995 996
		return -EINVAL;
	}

997
	if (list_empty(&w->edges[dir])) {
998
		dev_err(dapm->dev, "ASoC: %s %s has no paths\n", type, w->name);
999
		return -EINVAL;
1000
	}
L
Liam Girdwood 已提交
1001

1002
	ret = dapm_create_or_share_kcontrol(w, 0);
1003 1004
	if (ret < 0)
		return ret;
1005

1006 1007 1008
	snd_soc_dapm_widget_for_each_path(w, dir, path) {
		if (path->name)
			dapm_kcontrol_add_path(w->kcontrols[0], path);
1009
	}
1010

1011
	return 0;
1012 1013 1014
}

/* create new dapm volume control */
1015
static int dapm_new_pga(struct snd_soc_dapm_widget *w)
1016
{
1017 1018 1019 1020 1021 1022 1023
	int i, ret;

	for (i = 0; i < w->num_kcontrols; i++) {
		ret = dapm_create_or_share_kcontrol(w, i);
		if (ret < 0)
			return ret;
	}
1024

1025
	return 0;
1026 1027
}

1028 1029 1030 1031 1032 1033 1034
/* create new dapm dai link control */
static int dapm_new_dai_link(struct snd_soc_dapm_widget *w)
{
	int i, ret;
	struct snd_kcontrol *kcontrol;
	struct snd_soc_dapm_context *dapm = w->dapm;
	struct snd_card *card = dapm->card->snd_card;
1035
	struct snd_soc_pcm_runtime *rtd = w->priv;
1036 1037

	/* create control for links with > 1 config */
1038
	if (rtd->dai_link->num_params <= 1)
1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058
		return 0;

	/* add kcontrol */
	for (i = 0; i < w->num_kcontrols; i++) {
		kcontrol = snd_soc_cnew(&w->kcontrol_news[i], w,
					w->name, NULL);
		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, w->kcontrol_news[i].name, ret);
			return ret;
		}
		kcontrol->private_data = w;
		w->kcontrols[i] = kcontrol;
	}

	return 0;
}

1059 1060 1061 1062 1063 1064
/* 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)
{
1065
	int level = snd_power_get_state(widget->dapm->card->snd_card);
1066

1067
	switch (level) {
1068 1069
	case SNDRV_CTL_POWER_D3hot:
	case SNDRV_CTL_POWER_D3cold:
1070
		if (widget->ignore_suspend)
1071
			dev_dbg(widget->dapm->dev, "ASoC: %s ignoring suspend\n",
1072
				widget->name);
1073
		return widget->ignore_suspend;
1074 1075 1076 1077 1078
	default:
		return 1;
	}
}

1079 1080
static int dapm_widget_list_create(struct snd_soc_dapm_widget_list **list,
	struct list_head *widgets)
1081
{
1082 1083 1084 1085
	struct snd_soc_dapm_widget *w;
	struct list_head *it;
	unsigned int size = 0;
	unsigned int i = 0;
1086

1087 1088
	list_for_each(it, widgets)
		size++;
1089

1090
	*list = kzalloc(struct_size(*list, widgets, size), GFP_KERNEL);
1091
	if (*list == NULL)
1092 1093
		return -ENOMEM;

1094 1095
	list_for_each_entry(w, widgets, work_list)
		(*list)->widgets[i++] = w;
1096

1097 1098 1099
	(*list)->num_widgets = i;

	return 0;
1100 1101
}

1102
/*
1103 1104 1105 1106 1107
 * Common implementation for is_connected_output_ep() and
 * is_connected_input_ep(). The function is inlined since the combined size of
 * the two specialized functions is only marginally larger then the size of the
 * generic function and at the same time the fast path of the specialized
 * functions is significantly smaller than the generic function.
1108
 */
1109 1110
static __always_inline int is_connected_ep(struct snd_soc_dapm_widget *widget,
	struct list_head *list, enum snd_soc_dapm_direction dir,
1111 1112 1113 1114 1115
	int (*fn)(struct snd_soc_dapm_widget *, struct list_head *,
		  bool (*custom_stop_condition)(struct snd_soc_dapm_widget *,
						enum snd_soc_dapm_direction)),
	bool (*custom_stop_condition)(struct snd_soc_dapm_widget *,
				      enum snd_soc_dapm_direction))
1116
{
1117
	enum snd_soc_dapm_direction rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
1118 1119 1120
	struct snd_soc_dapm_path *path;
	int con = 0;

1121 1122
	if (widget->endpoints[dir] >= 0)
		return widget->endpoints[dir];
1123

1124 1125
	DAPM_UPDATE_STAT(widget, path_checks);

1126 1127 1128 1129
	/* do we need to add this widget to the list ? */
	if (list)
		list_add_tail(&widget->work_list, list);

1130 1131 1132 1133
	if (custom_stop_condition && custom_stop_condition(widget, dir)) {
		widget->endpoints[dir] = 1;
		return widget->endpoints[dir];
	}
1134

1135 1136 1137
	if ((widget->is_ep & SND_SOC_DAPM_DIR_TO_EP(dir)) && widget->connected) {
		widget->endpoints[dir] = snd_soc_dapm_suspend_check(widget);
		return widget->endpoints[dir];
1138 1139
	}

1140
	snd_soc_dapm_widget_for_each_path(widget, rdir, path) {
1141 1142
		DAPM_UPDATE_STAT(widget, neighbour_checks);

1143
		if (path->weak || path->is_supply)
1144 1145
			continue;

M
Mark Brown 已提交
1146 1147 1148
		if (path->walking)
			return 1;

1149
		trace_snd_soc_dapm_path(widget, dir, path);
1150

1151
		if (path->connect) {
M
Mark Brown 已提交
1152
			path->walking = 1;
1153
			con += fn(path->node[dir], list, custom_stop_condition);
M
Mark Brown 已提交
1154
			path->walking = 0;
1155 1156 1157
		}
	}

1158
	widget->endpoints[dir] = con;
1159

1160 1161 1162
	return con;
}

1163 1164 1165
/*
 * Recursively check for a completed path to an active or physically connected
 * output widget. Returns number of complete paths.
1166 1167 1168 1169 1170
 *
 * Optionally, can be supplied with a function acting as a stopping condition.
 * This function takes the dapm widget currently being examined and the walk
 * direction as an arguments, it should return true if the walk should be
 * stopped and false otherwise.
1171 1172
 */
static int is_connected_output_ep(struct snd_soc_dapm_widget *widget,
1173 1174 1175
	struct list_head *list,
	bool (*custom_stop_condition)(struct snd_soc_dapm_widget *i,
				      enum snd_soc_dapm_direction))
1176 1177
{
	return is_connected_ep(widget, list, SND_SOC_DAPM_DIR_OUT,
1178
			is_connected_output_ep, custom_stop_condition);
1179 1180
}

1181 1182 1183
/*
 * Recursively check for a completed path to an active or physically connected
 * input widget. Returns number of complete paths.
1184 1185 1186 1187 1188
 *
 * Optionally, can be supplied with a function acting as a stopping condition.
 * This function takes the dapm widget currently being examined and the walk
 * direction as an arguments, it should return true if the walk should be
 * stopped and false otherwise.
1189
 */
1190
static int is_connected_input_ep(struct snd_soc_dapm_widget *widget,
1191 1192 1193
	struct list_head *list,
	bool (*custom_stop_condition)(struct snd_soc_dapm_widget *i,
				      enum snd_soc_dapm_direction))
1194
{
1195
	return is_connected_ep(widget, list, SND_SOC_DAPM_DIR_IN,
1196
			is_connected_input_ep, custom_stop_condition);
1197 1198
}

1199 1200 1201 1202 1203
/**
 * 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.
1204 1205
 * @custom_stop_condition: (optional) a function meant to stop the widget graph
 *                         walk based on custom logic.
1206
 *
1207
 * Queries DAPM graph as to whether a valid audio stream path exists for
1208 1209 1210
 * the initial stream specified by name. This takes into account
 * current mixer and mux kcontrol settings. Creates list of valid widgets.
 *
1211 1212 1213 1214 1215
 * Optionally, can be supplied with a function acting as a stopping condition.
 * This function takes the dapm widget currently being examined and the walk
 * direction as an arguments, it should return true if the walk should be
 * stopped and false otherwise.
 *
1216 1217 1218
 * Returns the number of valid paths or negative error.
 */
int snd_soc_dapm_dai_get_connected_widgets(struct snd_soc_dai *dai, int stream,
1219 1220 1221
	struct snd_soc_dapm_widget_list **list,
	bool (*custom_stop_condition)(struct snd_soc_dapm_widget *,
				      enum snd_soc_dapm_direction))
1222
{
1223
	struct snd_soc_card *card = dai->component->card;
1224
	struct snd_soc_dapm_widget *w;
1225
	LIST_HEAD(widgets);
1226
	int paths;
1227
	int ret;
1228 1229

	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
1230 1231 1232 1233 1234 1235

	/*
	 * For is_connected_{output,input}_ep fully discover the graph we need
	 * to reset the cached number of inputs and outputs.
	 */
	list_for_each_entry(w, &card->widgets, list) {
1236 1237
		w->endpoints[SND_SOC_DAPM_DIR_IN] = -1;
		w->endpoints[SND_SOC_DAPM_DIR_OUT] = -1;
1238
	}
1239

1240
	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
1241 1242
		paths = is_connected_output_ep(dai->playback_widget, &widgets,
				custom_stop_condition);
1243
	else
1244 1245
		paths = is_connected_input_ep(dai->capture_widget, &widgets,
				custom_stop_condition);
1246 1247 1248 1249 1250 1251

	/* Drop starting point */
	list_del(widgets.next);

	ret = dapm_widget_list_create(list, &widgets);
	if (ret)
1252
		paths = ret;
1253 1254 1255 1256 1257 1258 1259

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

	return paths;
}

1260 1261 1262 1263 1264 1265
/*
 * Handler for regulator supply widget.
 */
int dapm_regulator_event(struct snd_soc_dapm_widget *w,
		   struct snd_kcontrol *kcontrol, int event)
{
1266 1267
	int ret;

1268 1269
	soc_dapm_async_complete(w->dapm);

1270
	if (SND_SOC_DAPM_EVENT_ON(event)) {
1271
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
1272
			ret = regulator_allow_bypass(w->regulator, false);
1273 1274
			if (ret != 0)
				dev_warn(w->dapm->dev,
1275
					 "ASoC: Failed to unbypass %s: %d\n",
1276 1277 1278
					 w->name, ret);
		}

1279
		return regulator_enable(w->regulator);
1280
	} else {
1281
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
1282
			ret = regulator_allow_bypass(w->regulator, true);
1283 1284
			if (ret != 0)
				dev_warn(w->dapm->dev,
1285
					 "ASoC: Failed to bypass %s: %d\n",
1286 1287 1288
					 w->name, ret);
		}

1289
		return regulator_disable_deferred(w->regulator, w->shift);
1290
	}
1291 1292 1293
}
EXPORT_SYMBOL_GPL(dapm_regulator_event);

1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
/*
 * Handler for pinctrl widget.
 */
int dapm_pinctrl_event(struct snd_soc_dapm_widget *w,
		       struct snd_kcontrol *kcontrol, int event)
{
	struct snd_soc_dapm_pinctrl_priv *priv = w->priv;
	struct pinctrl *p = w->pinctrl;
	struct pinctrl_state *s;

	if (!p || !priv)
		return -EIO;

	if (SND_SOC_DAPM_EVENT_ON(event))
		s = pinctrl_lookup_state(p, priv->active_state);
	else
		s = pinctrl_lookup_state(p, priv->sleep_state);

	if (IS_ERR(s))
		return PTR_ERR(s);

	return pinctrl_select_state(p, s);
}
EXPORT_SYMBOL_GPL(dapm_pinctrl_event);

1319 1320 1321 1322 1323 1324 1325 1326 1327
/*
 * 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;

1328 1329
	soc_dapm_async_complete(w->dapm);

1330
	if (SND_SOC_DAPM_EVENT_ON(event)) {
1331
		return clk_prepare_enable(w->clk);
1332
	} else {
1333
		clk_disable_unprepare(w->clk);
1334 1335
		return 0;
	}
1336

1337
	return 0;
1338 1339 1340
}
EXPORT_SYMBOL_GPL(dapm_clock_event);

1341 1342
static int dapm_widget_power_check(struct snd_soc_dapm_widget *w)
{
1343 1344 1345
	if (w->power_checked)
		return w->new_power;

1346
	if (w->force)
1347
		w->new_power = 1;
1348
	else
1349 1350 1351 1352 1353
		w->new_power = w->power_check(w);

	w->power_checked = true;

	return w->new_power;
1354 1355
}

1356
/* Generic check to see if a widget should be powered. */
1357 1358 1359 1360
static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
{
	int in, out;

1361 1362
	DAPM_UPDATE_STAT(w, power_checks);

1363 1364
	in = is_connected_input_ep(w, NULL, NULL);
	out = is_connected_output_ep(w, NULL, NULL);
1365 1366 1367
	return out != 0 && in != 0;
}

1368 1369 1370 1371 1372
/* 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;

1373 1374
	DAPM_UPDATE_STAT(w, power_checks);

1375
	/* Check if one of our outputs is connected */
1376
	snd_soc_dapm_widget_for_each_sink_path(w, path) {
1377 1378
		DAPM_UPDATE_STAT(w, neighbour_checks);

1379 1380 1381
		if (path->weak)
			continue;

1382 1383 1384 1385
		if (path->connected &&
		    !path->connected(path->source, path->sink))
			continue;

1386 1387
		if (dapm_widget_power_check(path->sink))
			return 1;
1388 1389
	}

1390
	return 0;
1391 1392
}

1393 1394
static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w)
{
1395
	return w->connected;
1396 1397
}

1398 1399
static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
			    struct snd_soc_dapm_widget *b,
1400
			    bool power_up)
1401
{
1402 1403 1404 1405 1406 1407 1408
	int *sort;

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

1409 1410
	if (sort[a->id] != sort[b->id])
		return sort[a->id] - sort[b->id];
1411 1412 1413 1414 1415 1416
	if (a->subseq != b->subseq) {
		if (power_up)
			return a->subseq - b->subseq;
		else
			return b->subseq - a->subseq;
	}
1417 1418
	if (a->reg != b->reg)
		return a->reg - b->reg;
1419 1420
	if (a->dapm != b->dapm)
		return (unsigned long)a->dapm - (unsigned long)b->dapm;
1421

1422 1423
	return 0;
}
1424

1425 1426 1427
/* 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,
1428
			    bool power_up)
1429 1430 1431 1432
{
	struct snd_soc_dapm_widget *w;

	list_for_each_entry(w, list, power_list)
1433
		if (dapm_seq_compare(new_widget, w, power_up) < 0) {
1434 1435 1436 1437 1438 1439 1440
			list_add_tail(&new_widget->power_list, &w->power_list);
			return;
		}

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

1441
static void dapm_seq_check_event(struct snd_soc_card *card,
1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463
				 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;
1464 1465 1466 1467 1468 1469 1470 1471
	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;
1472
	default:
T
Takashi Iwai 已提交
1473
		WARN(1, "Unknown event %d\n", event);
1474 1475 1476
		return;
	}

1477
	if (w->new_power != power)
1478 1479 1480
		return;

	if (w->event && (w->event_flags & event)) {
1481
		pop_dbg(w->dapm->dev, card->pop_time, "pop test : %s %s\n",
1482
			w->name, ev_name);
1483
		soc_dapm_async_complete(w->dapm);
M
Mark Brown 已提交
1484
		trace_snd_soc_dapm_widget_event_start(w, event);
1485
		ret = w->event(w, NULL, event);
M
Mark Brown 已提交
1486
		trace_snd_soc_dapm_widget_event_done(w, event);
1487
		if (ret < 0)
1488
			dev_err(w->dapm->dev, "ASoC: %s: %s event failed: %d\n",
1489 1490 1491 1492
			       ev_name, w->name, ret);
	}
}

1493
/* Apply the coalesced changes from a DAPM sequence */
1494
static void dapm_seq_run_coalesced(struct snd_soc_card *card,
1495
				   struct list_head *pending)
1496
{
1497
	struct snd_soc_dapm_context *dapm;
1498
	struct snd_soc_dapm_widget *w;
1499
	int reg;
1500 1501 1502
	unsigned int value = 0;
	unsigned int mask = 0;

1503 1504 1505
	w = list_first_entry(pending, struct snd_soc_dapm_widget, power_list);
	reg = w->reg;
	dapm = w->dapm;
1506 1507

	list_for_each_entry(w, pending, power_list) {
1508
		WARN_ON(reg != w->reg || dapm != w->dapm);
1509
		w->power = w->new_power;
1510

1511 1512 1513
		mask |= w->mask << w->shift;
		if (w->power)
			value |= w->on_val << w->shift;
1514
		else
1515
			value |= w->off_val << w->shift;
1516

1517
		pop_dbg(dapm->dev, card->pop_time,
1518 1519
			"pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
			w->name, reg, value, mask);
1520

1521
		/* Check for events */
1522 1523
		dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMU);
		dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMD);
1524 1525 1526
	}

	if (reg >= 0) {
1527 1528 1529 1530
		/* Any widget will do, they should all be updating the
		 * same register.
		 */

1531
		pop_dbg(dapm->dev, card->pop_time,
1532
			"pop test : Applying 0x%x/0x%x to %x in %dms\n",
1533 1534
			value, mask, reg, card->pop_time);
		pop_wait(card->pop_time);
1535
		soc_dapm_update_bits(dapm, reg, mask, value);
1536 1537
	}

1538
	list_for_each_entry(w, pending, power_list) {
1539 1540
		dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMU);
		dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMD);
1541
	}
1542
}
1543

1544 1545 1546 1547 1548 1549 1550 1551
/* 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.
 */
1552 1553
static void dapm_seq_run(struct snd_soc_card *card,
	struct list_head *list, int event, bool power_up)
1554 1555
{
	struct snd_soc_dapm_widget *w, *n;
1556
	struct snd_soc_dapm_context *d;
1557 1558
	LIST_HEAD(pending);
	int cur_sort = -1;
1559
	int cur_subseq = -1;
1560
	int cur_reg = SND_SOC_NOPM;
1561
	struct snd_soc_dapm_context *cur_dapm = NULL;
1562
	int ret, i;
1563 1564 1565 1566 1567 1568
	int *sort;

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

1570 1571 1572 1573
	list_for_each_entry_safe(w, n, list, power_list) {
		ret = 0;

		/* Do we need to apply any queued changes? */
1574
		if (sort[w->id] != cur_sort || w->reg != cur_reg ||
1575
		    w->dapm != cur_dapm || w->subseq != cur_subseq) {
1576
			if (!list_empty(&pending))
1577
				dapm_seq_run_coalesced(card, &pending);
1578

1579 1580 1581 1582
			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,
1583 1584
								       i,
								       cur_subseq);
1585 1586
			}

1587 1588 1589
			if (cur_dapm && w->dapm != cur_dapm)
				soc_dapm_async_complete(cur_dapm);

1590 1591
			INIT_LIST_HEAD(&pending);
			cur_sort = -1;
1592
			cur_subseq = INT_MIN;
1593
			cur_reg = SND_SOC_NOPM;
1594
			cur_dapm = NULL;
1595 1596
		}

1597 1598 1599
		switch (w->id) {
		case snd_soc_dapm_pre:
			if (!w->event)
1600 1601
				list_for_each_entry_safe_continue(w, n, list,
								  power_list);
1602

1603
			if (event == SND_SOC_DAPM_STREAM_START)
1604 1605
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_PRE_PMU);
1606
			else if (event == SND_SOC_DAPM_STREAM_STOP)
1607 1608 1609 1610 1611 1612
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_PRE_PMD);
			break;

		case snd_soc_dapm_post:
			if (!w->event)
1613 1614
				list_for_each_entry_safe_continue(w, n, list,
								  power_list);
1615

1616
			if (event == SND_SOC_DAPM_STREAM_START)
1617 1618
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_POST_PMU);
1619
			else if (event == SND_SOC_DAPM_STREAM_STOP)
1620 1621 1622 1623
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_POST_PMD);
			break;

1624
		default:
1625 1626
			/* Queue it up for application */
			cur_sort = sort[w->id];
1627
			cur_subseq = w->subseq;
1628
			cur_reg = w->reg;
1629
			cur_dapm = w->dapm;
1630 1631
			list_move(&w->power_list, &pending);
			break;
1632
		}
1633 1634

		if (ret < 0)
1635
			dev_err(w->dapm->dev,
1636
				"ASoC: Failed to apply widget power: %d\n", ret);
1637
	}
1638 1639

	if (!list_empty(&pending))
1640
		dapm_seq_run_coalesced(card, &pending);
1641 1642 1643 1644 1645

	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,
1646
						       i, cur_subseq);
1647
	}
1648 1649 1650 1651

	list_for_each_entry(d, &card->dapm_list, list) {
		soc_dapm_async_complete(d);
	}
1652 1653
}

1654
static void dapm_widget_update(struct snd_soc_card *card)
1655
{
1656
	struct snd_soc_dapm_update *update = card->update;
1657 1658 1659
	struct snd_soc_dapm_widget_list *wlist;
	struct snd_soc_dapm_widget *w = NULL;
	unsigned int wi;
1660 1661
	int ret;

1662
	if (!update || !dapm_kcontrol_is_powered(update->kcontrol))
1663 1664
		return;

1665
	wlist = dapm_kcontrol_get_wlist(update->kcontrol);
1666

1667 1668 1669 1670 1671 1672
	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)
1673
				dev_err(w->dapm->dev, "ASoC: %s DAPM pre-event failed: %d\n",
1674 1675
					   w->name, ret);
		}
1676 1677
	}

1678 1679 1680
	if (!w)
		return;

1681 1682
	ret = soc_dapm_update_bits(w->dapm, update->reg, update->mask,
		update->val);
1683
	if (ret < 0)
1684
		dev_err(w->dapm->dev, "ASoC: %s DAPM update failed: %d\n",
1685
			w->name, ret);
1686

1687 1688 1689 1690 1691 1692 1693 1694 1695
	if (update->has_second_set) {
		ret = soc_dapm_update_bits(w->dapm, update->reg2,
					   update->mask2, update->val2);
		if (ret < 0)
			dev_err(w->dapm->dev,
				"ASoC: %s DAPM update failed: %d\n",
				w->name, ret);
	}

1696 1697 1698 1699 1700 1701
	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)
1702
				dev_err(w->dapm->dev, "ASoC: %s DAPM post-event failed: %d\n",
1703 1704
					   w->name, ret);
		}
1705 1706 1707
	}
}

1708 1709 1710 1711 1712 1713 1714 1715
/* 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;

1716
	/* If we're off and we're not supposed to go into STANDBY */
1717 1718
	if (d->bias_level == SND_SOC_BIAS_OFF &&
	    d->target_bias_level != SND_SOC_BIAS_OFF) {
1719 1720 1721
		if (d->dev)
			pm_runtime_get_sync(d->dev);

1722 1723 1724
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
		if (ret != 0)
			dev_err(d->dev,
1725
				"ASoC: Failed to turn on bias: %d\n", ret);
1726 1727
	}

1728 1729 1730 1731 1732
	/* Prepare for a transition to ON or away from ON */
	if ((d->target_bias_level == SND_SOC_BIAS_ON &&
	     d->bias_level != SND_SOC_BIAS_ON) ||
	    (d->target_bias_level != SND_SOC_BIAS_ON &&
	     d->bias_level == SND_SOC_BIAS_ON)) {
1733 1734 1735
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
		if (ret != 0)
			dev_err(d->dev,
1736
				"ASoC: Failed to prepare bias: %d\n", ret);
1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748
	}
}

/* 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 */
1749 1750 1751
	if (d->bias_level == SND_SOC_BIAS_PREPARE &&
	    (d->target_bias_level == SND_SOC_BIAS_STANDBY ||
	     d->target_bias_level == SND_SOC_BIAS_OFF)) {
1752 1753
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
		if (ret != 0)
1754
			dev_err(d->dev, "ASoC: Failed to apply standby bias: %d\n",
1755 1756
				ret);
	}
1757

1758
	/* If we're in standby and can support bias off then do that */
1759 1760
	if (d->bias_level == SND_SOC_BIAS_STANDBY &&
	    d->target_bias_level == SND_SOC_BIAS_OFF) {
1761 1762
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
		if (ret != 0)
1763 1764
			dev_err(d->dev, "ASoC: Failed to turn off bias: %d\n",
				ret);
1765 1766

		if (d->dev)
1767
			pm_runtime_put(d->dev);
1768 1769 1770
	}

	/* If we just powered up then move to active bias */
1771 1772
	if (d->bias_level == SND_SOC_BIAS_PREPARE &&
	    d->target_bias_level == SND_SOC_BIAS_ON) {
1773 1774
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
		if (ret != 0)
1775
			dev_err(d->dev, "ASoC: Failed to apply active bias: %d\n",
1776 1777 1778
				ret);
	}
}
1779

1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791
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)
1792
		dapm_mark_dirty(peer, "peer state change");
1793 1794
}

1795 1796 1797 1798
static void dapm_widget_set_power(struct snd_soc_dapm_widget *w, bool power,
				  struct list_head *up_list,
				  struct list_head *down_list)
{
1799 1800
	struct snd_soc_dapm_path *path;

1801 1802 1803 1804 1805
	if (w->power == power)
		return;

	trace_snd_soc_dapm_widget_power(w, power);

1806
	/* If we changed our power state perhaps our neigbours changed
1807
	 * also.
1808
	 */
1809
	snd_soc_dapm_widget_for_each_source_path(w, path)
1810 1811
		dapm_widget_set_peer_power(path->source, power, path->connect);

1812 1813
	/* Supplies can't affect their outputs, only their inputs */
	if (!w->is_supply) {
1814
		snd_soc_dapm_widget_for_each_sink_path(w, path)
1815 1816
			dapm_widget_set_peer_power(path->sink, power,
						   path->connect);
1817 1818
	}

1819 1820 1821 1822 1823 1824
	if (power)
		dapm_seq_insert(w, up_list, true);
	else
		dapm_seq_insert(w, down_list, false);
}

1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839
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:
1840
		power = dapm_widget_power_check(w);
1841

1842
		dapm_widget_set_power(w, power, up_list, down_list);
1843 1844 1845 1846
		break;
	}
}

1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862
static bool dapm_idle_bias_off(struct snd_soc_dapm_context *dapm)
{
	if (dapm->idle_bias_off)
		return true;

	switch (snd_power_get_state(dapm->card->snd_card)) {
	case SNDRV_CTL_POWER_D3hot:
	case SNDRV_CTL_POWER_D3cold:
		return dapm->suspend_bias_off;
	default:
		break;
	}

	return false;
}

1863 1864 1865 1866 1867
/*
 * 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.
1868
 *  o Input pin to ADC.
1869 1870 1871
 *  o Input pin to Output pin (bypass, sidetone)
 *  o DAC to ADC (loopback).
 */
1872
static int dapm_power_widgets(struct snd_soc_card *card, int event)
1873 1874
{
	struct snd_soc_dapm_widget *w;
1875
	struct snd_soc_dapm_context *d;
1876 1877
	LIST_HEAD(up_list);
	LIST_HEAD(down_list);
1878
	ASYNC_DOMAIN_EXCLUSIVE(async_domain);
1879
	enum snd_soc_bias_level bias;
1880

1881 1882
	lockdep_assert_held(&card->dapm_mutex);

M
Mark Brown 已提交
1883 1884
	trace_snd_soc_dapm_start(card);

1885
	list_for_each_entry(d, &card->dapm_list, list) {
1886
		if (dapm_idle_bias_off(d))
1887 1888 1889
			d->target_bias_level = SND_SOC_BIAS_OFF;
		else
			d->target_bias_level = SND_SOC_BIAS_STANDBY;
1890
	}
1891

1892
	dapm_reset(card);
1893

1894
	/* Check which widgets we need to power and store them in
1895 1896 1897 1898
	 * 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.
1899
	 */
1900
	list_for_each_entry(w, &card->dapm_dirty, dirty) {
1901
		dapm_power_one_widget(w, &up_list, &down_list);
1902 1903
	}

1904
	list_for_each_entry(w, &card->widgets, list) {
1905 1906 1907 1908 1909 1910 1911 1912 1913
		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;
		}
1914

1915
		if (w->new_power) {
1916 1917 1918 1919 1920
			d = w->dapm;

			/* Supplies and micbiases only bring the
			 * context up to STANDBY as unless something
			 * else is active and passing audio they
1921 1922 1923
			 * generally don't require full power.  Signal
			 * generators are virtual pins and have no
			 * power impact themselves.
1924 1925
			 */
			switch (w->id) {
1926
			case snd_soc_dapm_siggen:
1927
			case snd_soc_dapm_vmid:
1928
				break;
1929
			case snd_soc_dapm_supply:
1930
			case snd_soc_dapm_regulator_supply:
1931
			case snd_soc_dapm_pinctrl:
1932
			case snd_soc_dapm_clock_supply:
1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944
			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;
			}
		}

	}

1945 1946 1947
	/* Force all contexts in the card to the same bias state if
	 * they're not ground referenced.
	 */
1948
	bias = SND_SOC_BIAS_OFF;
1949
	list_for_each_entry(d, &card->dapm_list, list)
1950 1951
		if (d->target_bias_level > bias)
			bias = d->target_bias_level;
1952
	list_for_each_entry(d, &card->dapm_list, list)
1953
		if (!dapm_idle_bias_off(d))
1954
			d->target_bias_level = bias;
1955

1956
	trace_snd_soc_dapm_walk_done(card);
1957

1958 1959 1960 1961
	/* Run card bias changes at first */
	dapm_pre_sequence_async(&card->dapm, 0);
	/* Run other bias changes in parallel */
	list_for_each_entry(d, &card->dapm_list, list) {
1962
		if (d != &card->dapm && d->bias_level != d->target_bias_level)
1963 1964 1965
			async_schedule_domain(dapm_pre_sequence_async, d,
						&async_domain);
	}
1966
	async_synchronize_full_domain(&async_domain);
1967

1968
	list_for_each_entry(w, &down_list, power_list) {
1969
		dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMD);
1970 1971
	}

1972
	list_for_each_entry(w, &up_list, power_list) {
1973
		dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMU);
1974 1975
	}

1976
	/* Power down widgets first; try to avoid amplifying pops. */
1977
	dapm_seq_run(card, &down_list, event, false);
1978

1979
	dapm_widget_update(card);
1980

1981
	/* Now power up. */
1982
	dapm_seq_run(card, &up_list, event, true);
1983

1984
	/* Run all the bias changes in parallel */
1985
	list_for_each_entry(d, &card->dapm_list, list) {
1986
		if (d != &card->dapm && d->bias_level != d->target_bias_level)
1987 1988 1989
			async_schedule_domain(dapm_post_sequence_async, d,
						&async_domain);
	}
1990
	async_synchronize_full_domain(&async_domain);
1991 1992
	/* Run card bias changes at last */
	dapm_post_sequence_async(&card->dapm, 0);
1993

1994 1995 1996 1997 1998 1999
	/* 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);
	}

2000
	pop_dbg(card->dev, card->pop_time,
2001
		"DAPM sequencing finished, waiting %dms\n", card->pop_time);
2002
	pop_wait(card->pop_time);
2003

M
Mark Brown 已提交
2004 2005
	trace_snd_soc_dapm_done(card);

2006
	return 0;
2007 2008
}

2009 2010 2011 2012 2013 2014
#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;
2015
	struct snd_soc_card *card = w->dapm->card;
2016
	enum snd_soc_dapm_direction dir, rdir;
2017 2018 2019 2020 2021 2022 2023 2024 2025
	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;

2026 2027
	mutex_lock(&card->dapm_mutex);

2028 2029 2030 2031 2032
	/* Supply widgets are not handled by is_connected_{input,output}_ep() */
	if (w->is_supply) {
		in = 0;
		out = 0;
	} else {
2033 2034
		in = is_connected_input_ep(w, NULL, NULL);
		out = is_connected_output_ep(w, NULL, NULL);
2035
	}
2036

2037
	ret = scnprintf(buf, PAGE_SIZE, "%s: %s%s  in %d out %d",
2038 2039
		       w->name, w->power ? "On" : "Off",
		       w->force ? " (forced)" : "", in, out);
2040

2041
	if (w->reg >= 0)
2042
		ret += scnprintf(buf + ret, PAGE_SIZE - ret,
2043 2044
				" - R%d(0x%x) mask 0x%x",
				w->reg, w->reg, w->mask << w->shift);
2045

2046
	ret += scnprintf(buf + ret, PAGE_SIZE - ret, "\n");
2047

2048
	if (w->sname)
2049
		ret += scnprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
2050 2051
				w->sname,
				w->active ? "active" : "inactive");
2052

2053 2054 2055
	snd_soc_dapm_for_each_direction(dir) {
		rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
		snd_soc_dapm_widget_for_each_path(w, dir, p) {
2056
			if (p->connected && !p->connected(p->source, p->sink))
2057
				continue;
2058

2059 2060
			if (!p->connect)
				continue;
2061

2062
			ret += scnprintf(buf + ret, PAGE_SIZE - ret,
2063 2064
					" %s  \"%s\" \"%s\"\n",
					(rdir == SND_SOC_DAPM_DIR_IN) ? "in" : "out",
2065
					p->name ? p->name : "static",
2066 2067
					p->node[rdir]->name);
		}
2068 2069
	}

2070 2071
	mutex_unlock(&card->dapm_mutex);

2072 2073 2074 2075 2076 2077 2078
	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);

	kfree(buf);
	return ret;
}

static const struct file_operations dapm_widget_power_fops = {
2079
	.open = simple_open,
2080
	.read = dapm_widget_power_read_file,
2081
	.llseek = default_llseek,
2082 2083
};

2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103
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 已提交
2104
		WARN(1, "Unknown bias_level %d\n", dapm->bias_level);
2105 2106 2107 2108 2109 2110 2111 2112 2113
		level = "Unknown\n";
		break;
	}

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

static const struct file_operations dapm_bias_fops = {
2114
	.open = simple_open,
2115 2116 2117 2118
	.read = dapm_bias_read_file,
	.llseek = default_llseek,
};

2119 2120
void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
	struct dentry *parent)
2121 2122 2123
{
	struct dentry *d;

2124 2125 2126
	if (!parent)
		return;

2127 2128 2129
	dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);

	if (!dapm->debugfs_dapm) {
2130
		dev_warn(dapm->dev,
2131
		       "ASoC: Failed to create DAPM debugfs directory\n");
2132
		return;
2133
	}
2134

2135 2136 2137 2138 2139 2140
	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");
2141
}
2142

2143 2144 2145 2146
static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
{
	struct snd_soc_dapm_context *dapm = w->dapm;
	struct dentry *d;
2147

2148 2149 2150 2151 2152 2153 2154 2155 2156 2157
	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);
2158
}
2159

2160 2161 2162 2163 2164
static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
{
	debugfs_remove_recursive(dapm->debugfs_dapm);
}

2165
#else
2166 2167
void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
	struct dentry *parent)
2168 2169
{
}
2170 2171 2172 2173 2174

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

2175 2176 2177 2178
static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
{
}

2179 2180
#endif

2181 2182 2183 2184
/*
 * soc_dapm_connect_path() - Connects or disconnects a path
 * @path: The path to update
 * @connect: The new connect state of the path. True if the path is connected,
2185
 *  false if it is disconnected.
2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196
 * @reason: The reason why the path changed (for debugging only)
 */
static void soc_dapm_connect_path(struct snd_soc_dapm_path *path,
	bool connect, const char *reason)
{
	if (path->connect == connect)
		return;

	path->connect = connect;
	dapm_mark_dirty(path->source, reason);
	dapm_mark_dirty(path->sink, reason);
2197
	dapm_path_invalidate(path);
2198 2199
}

2200
/* test and update the power status of a mux widget */
2201
static int soc_dapm_mux_update_power(struct snd_soc_card *card,
2202
				 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e)
2203 2204 2205
{
	struct snd_soc_dapm_path *path;
	int found = 0;
2206
	bool connect;
2207

2208 2209
	lockdep_assert_held(&card->dapm_mutex);

2210
	/* find dapm widget path assoc with kcontrol */
2211
	dapm_kcontrol_for_each_path(path, kcontrol) {
2212 2213
		found = 1;
		/* we now need to match the string in the enum to the path */
2214 2215 2216 2217 2218 2219
		if (!(strcmp(path->name, e->texts[mux])))
			connect = true;
		else
			connect = false;

		soc_dapm_connect_path(path, connect, "mux update");
2220 2221
	}

2222
	if (found)
2223
		dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
2224

2225
	return found;
2226
}
2227

2228
int snd_soc_dapm_mux_update_power(struct snd_soc_dapm_context *dapm,
2229 2230
	struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e,
	struct snd_soc_dapm_update *update)
2231
{
2232
	struct snd_soc_card *card = dapm->card;
2233 2234
	int ret;

2235
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2236
	card->update = update;
2237
	ret = soc_dapm_mux_update_power(card, kcontrol, mux, e);
2238
	card->update = NULL;
2239
	mutex_unlock(&card->dapm_mutex);
2240
	if (ret > 0)
2241
		soc_dpcm_runtime_update(card);
2242 2243
	return ret;
}
2244
EXPORT_SYMBOL_GPL(snd_soc_dapm_mux_update_power);
2245

2246
/* test and update the power status of a mixer or switch widget */
2247
static int soc_dapm_mixer_update_power(struct snd_soc_card *card,
2248 2249
				       struct snd_kcontrol *kcontrol,
				       int connect, int rconnect)
2250 2251 2252 2253
{
	struct snd_soc_dapm_path *path;
	int found = 0;

2254 2255
	lockdep_assert_held(&card->dapm_mutex);

2256
	/* find dapm widget path assoc with kcontrol */
2257
	dapm_kcontrol_for_each_path(path, kcontrol) {
2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283
		/*
		 * Ideally this function should support any number of
		 * paths and channels. But since kcontrols only come
		 * in mono and stereo variants, we are limited to 2
		 * channels.
		 *
		 * The following code assumes for stereo controls the
		 * first path (when 'found == 0') is the left channel,
		 * and all remaining paths (when 'found == 1') are the
		 * right channel.
		 *
		 * A stereo control is signified by a valid 'rconnect'
		 * value, either 0 for unconnected, or >= 0 for connected.
		 * This is chosen instead of using snd_soc_volsw_is_stereo,
		 * so that the behavior of snd_soc_dapm_mixer_update_power
		 * doesn't change even when the kcontrol passed in is
		 * stereo.
		 *
		 * It passes 'connect' as the path connect status for
		 * the left channel, and 'rconnect' for the right
		 * channel.
		 */
		if (found && rconnect >= 0)
			soc_dapm_connect_path(path, rconnect, "mixer update");
		else
			soc_dapm_connect_path(path, connect, "mixer update");
2284 2285 2286
		found = 1;
	}

2287
	if (found)
2288
		dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
2289

2290
	return found;
2291
}
2292

2293
int snd_soc_dapm_mixer_update_power(struct snd_soc_dapm_context *dapm,
2294 2295
	struct snd_kcontrol *kcontrol, int connect,
	struct snd_soc_dapm_update *update)
2296
{
2297
	struct snd_soc_card *card = dapm->card;
2298 2299
	int ret;

2300
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2301
	card->update = update;
2302
	ret = soc_dapm_mixer_update_power(card, kcontrol, connect, -1);
2303
	card->update = NULL;
2304
	mutex_unlock(&card->dapm_mutex);
2305
	if (ret > 0)
2306
		soc_dpcm_runtime_update(card);
2307 2308
	return ret;
}
2309
EXPORT_SYMBOL_GPL(snd_soc_dapm_mixer_update_power);
2310

2311 2312
static ssize_t dapm_widget_show_component(struct snd_soc_component *cmpnt,
	char *buf)
2313
{
2314
	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(cmpnt);
2315 2316 2317 2318
	struct snd_soc_dapm_widget *w;
	int count = 0;
	char *state = "not set";

2319 2320 2321 2322 2323 2324 2325
	/* card won't be set for the dummy component, as a spot fix
	 * we're checking for that case specifically here but in future
	 * we will ensure that the dummy component looks like others.
	 */
	if (!cmpnt->card)
		return 0;

2326 2327
	list_for_each_entry(w, &cmpnt->card->widgets, list) {
		if (w->dapm != dapm)
2328
			continue;
2329

2330
		/* only display widgets that burn power */
2331 2332 2333 2334 2335 2336 2337 2338 2339
		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:
2340
		case snd_soc_dapm_out_drv:
2341
		case snd_soc_dapm_mixer:
2342
		case snd_soc_dapm_mixer_named_ctl:
2343
		case snd_soc_dapm_supply:
2344
		case snd_soc_dapm_regulator_supply:
2345
		case snd_soc_dapm_pinctrl:
2346
		case snd_soc_dapm_clock_supply:
2347 2348 2349 2350 2351 2352 2353 2354 2355
			if (w->name)
				count += sprintf(buf + count, "%s: %s\n",
					w->name, w->power ? "On":"Off");
		break;
		default:
		break;
		}
	}

2356
	switch (snd_soc_dapm_get_bias_level(dapm)) {
2357 2358
	case SND_SOC_BIAS_ON:
		state = "On";
2359
		break;
2360 2361
	case SND_SOC_BIAS_PREPARE:
		state = "Prepare";
2362
		break;
2363 2364
	case SND_SOC_BIAS_STANDBY:
		state = "Standby";
2365
		break;
2366 2367
	case SND_SOC_BIAS_OFF:
		state = "Off";
2368 2369 2370 2371 2372 2373 2374
		break;
	}
	count += sprintf(buf + count, "PM State: %s\n", state);

	return count;
}

2375 2376 2377 2378 2379
/* show dapm widget status in sys fs */
static ssize_t dapm_widget_show(struct device *dev,
	struct device_attribute *attr, char *buf)
{
	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
2380
	struct snd_soc_dai *codec_dai;
2381 2382
	int i, count = 0;

2383 2384
	mutex_lock(&rtd->card->dapm_mutex);

2385 2386
	for_each_rtd_codec_dai(rtd, i, codec_dai) {
		struct snd_soc_component *cmpnt = codec_dai->component;
2387 2388

		count += dapm_widget_show_component(cmpnt, buf + count);
2389 2390
	}

2391 2392
	mutex_unlock(&rtd->card->dapm_mutex);

2393 2394 2395
	return count;
}

J
Joe Perches 已提交
2396
static DEVICE_ATTR_RO(dapm_widget);
2397

2398 2399 2400 2401
struct attribute *soc_dapm_dev_attrs[] = {
	&dev_attr_dapm_widget.attr,
	NULL
};
2402

2403 2404
static void dapm_free_path(struct snd_soc_dapm_path *path)
{
2405 2406
	list_del(&path->list_node[SND_SOC_DAPM_DIR_IN]);
	list_del(&path->list_node[SND_SOC_DAPM_DIR_OUT]);
2407
	list_del(&path->list_kcontrol);
2408 2409 2410 2411
	list_del(&path->list);
	kfree(path);
}

2412 2413 2414
void snd_soc_dapm_free_widget(struct snd_soc_dapm_widget *w)
{
	struct snd_soc_dapm_path *p, *next_p;
2415
	enum snd_soc_dapm_direction dir;
2416 2417 2418 2419 2420 2421 2422

	list_del(&w->list);
	/*
	 * 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.
	 */
2423 2424 2425 2426
	snd_soc_dapm_for_each_direction(dir) {
		snd_soc_dapm_widget_for_each_path_safe(w, dir, p, next_p)
			dapm_free_path(p);
	}
2427 2428

	kfree(w->kcontrols);
2429
	kfree_const(w->name);
2430
	kfree_const(w->sname);
2431 2432 2433
	kfree(w);
}

2434 2435 2436 2437 2438 2439
void snd_soc_dapm_reset_cache(struct snd_soc_dapm_context *dapm)
{
	dapm->path_sink_cache.widget = NULL;
	dapm->path_source_cache.widget = NULL;
}

2440
/* free all dapm widgets and resources */
L
Liam Girdwood 已提交
2441
static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
2442 2443 2444
{
	struct snd_soc_dapm_widget *w, *next_w;

2445 2446 2447
	list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
		if (w->dapm != dapm)
			continue;
2448
		snd_soc_dapm_free_widget(w);
2449
	}
2450
	snd_soc_dapm_reset_cache(dapm);
2451 2452
}

2453 2454 2455
static struct snd_soc_dapm_widget *dapm_find_widget(
			struct snd_soc_dapm_context *dapm, const char *pin,
			bool search_other_contexts)
2456 2457
{
	struct snd_soc_dapm_widget *w;
2458
	struct snd_soc_dapm_widget *fallback = NULL;
2459

2460
	list_for_each_entry(w, &dapm->card->widgets, list) {
2461
		if (!strcmp(w->name, pin)) {
2462 2463 2464 2465
			if (w->dapm == dapm)
				return w;
			else
				fallback = w;
2466 2467 2468
		}
	}

2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479
	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);

2480 2481
	dapm_assert_locked(dapm);

2482
	if (!w) {
2483
		dev_err(dapm->dev, "ASoC: DAPM unknown pin %s\n", pin);
2484
		return -EINVAL;
2485 2486
	}

2487
	if (w->connected != status) {
2488
		dapm_mark_dirty(w, "pin configuration");
2489 2490 2491
		dapm_widget_invalidate_input_paths(w);
		dapm_widget_invalidate_output_paths(w);
	}
2492

2493 2494 2495 2496 2497
	w->connected = status;
	if (status == 0)
		w->force = 0;

	return 0;
2498 2499
}

2500
/**
2501
 * snd_soc_dapm_sync_unlocked - scan and power dapm paths
L
Liam Girdwood 已提交
2502
 * @dapm: DAPM context
2503 2504 2505 2506
 *
 * Walks all dapm audio paths and powers widgets according to their
 * stream or path usage.
 *
2507 2508
 * Requires external locking.
 *
2509 2510
 * Returns 0 for success.
 */
2511
int snd_soc_dapm_sync_unlocked(struct snd_soc_dapm_context *dapm)
2512
{
2513 2514 2515 2516 2517 2518 2519
	/*
	 * Suppress early reports (eg, jacks syncing their state) to avoid
	 * silly DAPM runs during card startup.
	 */
	if (!dapm->card || !dapm->card->instantiated)
		return 0;

2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536
	return dapm_power_widgets(dapm->card, SND_SOC_DAPM_STREAM_NOP);
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_sync_unlocked);

/**
 * snd_soc_dapm_sync - scan and power dapm paths
 * @dapm: DAPM context
 *
 * Walks all dapm audio paths and powers widgets according to their
 * stream or path usage.
 *
 * Returns 0 for success.
 */
int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
{
	int ret;

2537
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2538
	ret = snd_soc_dapm_sync_unlocked(dapm);
2539 2540
	mutex_unlock(&dapm->card->dapm_mutex);
	return ret;
2541
}
2542
EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
2543

2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 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 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615
static int dapm_update_dai_chan(struct snd_soc_dapm_path *p,
				struct snd_soc_dapm_widget *w,
				int channels)
{
	switch (w->id) {
	case snd_soc_dapm_aif_out:
	case snd_soc_dapm_aif_in:
		break;
	default:
		return 0;
	}

	dev_dbg(w->dapm->dev, "%s DAI route %s -> %s\n",
		w->channel < channels ? "Connecting" : "Disconnecting",
		p->source->name, p->sink->name);

	if (w->channel < channels)
		soc_dapm_connect_path(p, true, "dai update");
	else
		soc_dapm_connect_path(p, false, "dai update");

	return 0;
}

static int dapm_update_dai_unlocked(struct snd_pcm_substream *substream,
				    struct snd_pcm_hw_params *params,
				    struct snd_soc_dai *dai)
{
	int dir = substream->stream;
	int channels = params_channels(params);
	struct snd_soc_dapm_path *p;
	struct snd_soc_dapm_widget *w;
	int ret;

	if (dir == SNDRV_PCM_STREAM_PLAYBACK)
		w = dai->playback_widget;
	else
		w = dai->capture_widget;

	dev_dbg(dai->dev, "Update DAI routes for %s %s\n", dai->name,
		dir == SNDRV_PCM_STREAM_PLAYBACK ? "playback" : "capture");

	snd_soc_dapm_widget_for_each_sink_path(w, p) {
		ret = dapm_update_dai_chan(p, p->sink, channels);
		if (ret < 0)
			return ret;
	}

	snd_soc_dapm_widget_for_each_source_path(w, p) {
		ret = dapm_update_dai_chan(p, p->source, channels);
		if (ret < 0)
			return ret;
	}

	return 0;
}

int snd_soc_dapm_update_dai(struct snd_pcm_substream *substream,
			    struct snd_pcm_hw_params *params,
			    struct snd_soc_dai *dai)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	int ret;

	mutex_lock_nested(&rtd->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
	ret = dapm_update_dai_unlocked(substream, params, dai);
	mutex_unlock(&rtd->card->dapm_mutex);

	return ret;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_update_dai);

2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626
/*
 * dapm_update_widget_flags() - Re-compute widget sink and source flags
 * @w: The widget for which to update the flags
 *
 * Some widgets have a dynamic category which depends on which neighbors they
 * are connected to. This function update the category for these widgets.
 *
 * This function must be called whenever a path is added or removed to a widget.
 */
static void dapm_update_widget_flags(struct snd_soc_dapm_widget *w)
{
2627
	enum snd_soc_dapm_direction dir;
2628
	struct snd_soc_dapm_path *p;
2629
	unsigned int ep;
2630 2631 2632

	switch (w->id) {
	case snd_soc_dapm_input:
2633
		/* On a fully routed card an input is never a source */
2634
		if (w->dapm->card->fully_routed)
2635 2636
			return;
		ep = SND_SOC_DAPM_EP_SOURCE;
2637
		snd_soc_dapm_widget_for_each_source_path(w, p) {
2638 2639 2640 2641
			if (p->source->id == snd_soc_dapm_micbias ||
				p->source->id == snd_soc_dapm_mic ||
				p->source->id == snd_soc_dapm_line ||
				p->source->id == snd_soc_dapm_output) {
2642
					ep = 0;
2643 2644 2645 2646 2647
					break;
			}
		}
		break;
	case snd_soc_dapm_output:
2648 2649
		/* On a fully routed card a output is never a sink */
		if (w->dapm->card->fully_routed)
2650 2651
			return;
		ep = SND_SOC_DAPM_EP_SINK;
2652
		snd_soc_dapm_widget_for_each_sink_path(w, p) {
2653 2654 2655 2656
			if (p->sink->id == snd_soc_dapm_spk ||
				p->sink->id == snd_soc_dapm_hp ||
				p->sink->id == snd_soc_dapm_line ||
				p->sink->id == snd_soc_dapm_input) {
2657
					ep = 0;
2658 2659 2660 2661 2662
					break;
			}
		}
		break;
	case snd_soc_dapm_line:
2663 2664 2665 2666 2667
		ep = 0;
		snd_soc_dapm_for_each_direction(dir) {
			if (!list_empty(&w->edges[dir]))
				ep |= SND_SOC_DAPM_DIR_TO_EP(dir);
		}
2668 2669
		break;
	default:
2670
		return;
2671
	}
2672 2673

	w->is_ep = ep;
2674 2675
}

2676 2677 2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 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
static int snd_soc_dapm_check_dynamic_path(struct snd_soc_dapm_context *dapm,
	struct snd_soc_dapm_widget *source, struct snd_soc_dapm_widget *sink,
	const char *control)
{
	bool dynamic_source = false;
	bool dynamic_sink = false;

	if (!control)
		return 0;

	switch (source->id) {
	case snd_soc_dapm_demux:
		dynamic_source = true;
		break;
	default:
		break;
	}

	switch (sink->id) {
	case snd_soc_dapm_mux:
	case snd_soc_dapm_switch:
	case snd_soc_dapm_mixer:
	case snd_soc_dapm_mixer_named_ctl:
		dynamic_sink = true;
		break;
	default:
		break;
	}

	if (dynamic_source && dynamic_sink) {
		dev_err(dapm->dev,
			"Direct connection between demux and mixer/mux not supported for path %s -> [%s] -> %s\n",
			source->name, control, sink->name);
		return -EINVAL;
	} else if (!dynamic_source && !dynamic_sink) {
		dev_err(dapm->dev,
			"Control not supported for path %s -> [%s] -> %s\n",
			source->name, control, sink->name);
		return -EINVAL;
	}

	return 0;
}

2720 2721 2722 2723 2724
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))
2725
{
2726 2727
	struct snd_soc_dapm_widget *widgets[2];
	enum snd_soc_dapm_direction dir;
2728
	struct snd_soc_dapm_path *path;
2729
	int ret;
2730

2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751
	if (wsink->is_supply && !wsource->is_supply) {
		dev_err(dapm->dev,
			"Connecting non-supply widget to supply widget is not supported (%s -> %s)\n",
			wsource->name, wsink->name);
		return -EINVAL;
	}

	if (connected && !wsource->is_supply) {
		dev_err(dapm->dev,
			"connected() callback only supported for supply widgets (%s -> %s)\n",
			wsource->name, wsink->name);
		return -EINVAL;
	}

	if (wsource->is_supply && control) {
		dev_err(dapm->dev,
			"Conditional paths are not supported for supply widgets (%s -> [%s] -> %s)\n",
			wsource->name, control, wsink->name);
		return -EINVAL;
	}

2752 2753 2754 2755
	ret = snd_soc_dapm_check_dynamic_path(dapm, wsource, wsink, control);
	if (ret)
		return ret;

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

2760 2761 2762 2763 2764
	path->node[SND_SOC_DAPM_DIR_IN] = wsource;
	path->node[SND_SOC_DAPM_DIR_OUT] = wsink;
	widgets[SND_SOC_DAPM_DIR_IN] = wsource;
	widgets[SND_SOC_DAPM_DIR_OUT] = wsink;

2765
	path->connected = connected;
2766
	INIT_LIST_HEAD(&path->list);
2767
	INIT_LIST_HEAD(&path->list_kcontrol);
2768

2769 2770 2771
	if (wsource->is_supply || wsink->is_supply)
		path->is_supply = 1;

2772 2773 2774
	/* connect static paths */
	if (control == NULL) {
		path->connect = 1;
2775
	} else {
2776 2777 2778 2779 2780 2781 2782 2783 2784 2785
		switch (wsource->id) {
		case snd_soc_dapm_demux:
			ret = dapm_connect_mux(dapm, path, control, wsource);
			if (ret)
				goto err;
			break;
		default:
			break;
		}

2786 2787
		switch (wsink->id) {
		case snd_soc_dapm_mux:
2788
			ret = dapm_connect_mux(dapm, path, control, wsink);
2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799
			if (ret != 0)
				goto err;
			break;
		case snd_soc_dapm_switch:
		case snd_soc_dapm_mixer:
		case snd_soc_dapm_mixer_named_ctl:
			ret = dapm_connect_mixer(dapm, path, control);
			if (ret != 0)
				goto err;
			break;
		default:
2800
			break;
2801
		}
2802
	}
2803

2804
	list_add(&path->list, &dapm->card->paths);
2805 2806
	snd_soc_dapm_for_each_direction(dir)
		list_add(&path->list_node[dir], &widgets[dir]->edges[dir]);
2807

2808 2809 2810 2811
	snd_soc_dapm_for_each_direction(dir) {
		dapm_update_widget_flags(widgets[dir]);
		dapm_mark_dirty(widgets[dir], "Route added");
	}
2812

2813 2814 2815
	if (dapm->card->instantiated && path->connect)
		dapm_path_invalidate(path);

2816
	return 0;
2817 2818 2819 2820
err:
	kfree(path);
	return ret;
}
2821

2822
static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
2823
				  const struct snd_soc_dapm_route *route)
2824 2825 2826 2827 2828 2829 2830
{
	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];
2831
	const char *prefix;
2832 2833
	unsigned int sink_ref = 0;
	unsigned int source_ref = 0;
2834 2835
	int ret;

2836 2837
	prefix = soc_dapm_prefix(dapm);
	if (prefix) {
2838
		snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
2839
			 prefix, route->sink);
2840 2841
		sink = prefixed_sink;
		snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
2842
			 prefix, route->source);
2843 2844 2845 2846 2847 2848
		source = prefixed_source;
	} else {
		sink = route->sink;
		source = route->source;
	}

2849 2850 2851 2852 2853 2854
	wsource = dapm_wcache_lookup(&dapm->path_source_cache, source);
	wsink = dapm_wcache_lookup(&dapm->path_sink_cache, sink);

	if (wsink && wsource)
		goto skip_search;

2855 2856 2857 2858 2859 2860 2861
	/*
	 * 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;
2862
			if (w->dapm == dapm) {
2863
				wsink = w;
2864 2865 2866
				if (wsource)
					break;
			}
2867 2868 2869 2870 2871
			sink_ref++;
			if (sink_ref > 1)
				dev_warn(dapm->dev,
					"ASoC: sink widget %s overwritten\n",
					w->name);
2872 2873 2874 2875
			continue;
		}
		if (!wsource && !(strcmp(w->name, source))) {
			wtsource = w;
2876
			if (w->dapm == dapm) {
2877
				wsource = w;
2878 2879 2880
				if (wsink)
					break;
			}
2881 2882 2883 2884 2885
			source_ref++;
			if (source_ref > 1)
				dev_warn(dapm->dev,
					"ASoC: source widget %s overwritten\n",
					w->name);
2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904
		}
	}
	/* 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;
	}

2905 2906 2907 2908
skip_search:
	dapm_wcache_update(&dapm->path_sink_cache, wsink);
	dapm_wcache_update(&dapm->path_source_cache, wsource);

2909 2910 2911 2912 2913 2914
	ret = snd_soc_dapm_add_path(dapm, wsource, wsink, route->control,
		route->connected);
	if (ret)
		goto err;

	return 0;
2915
err:
2916
	dev_warn(dapm->dev, "ASoC: no dapm match for %s --> %s --> %s\n",
2917
		 source, route->control, sink);
2918 2919
	return ret;
}
2920

2921 2922 2923
static int snd_soc_dapm_del_route(struct snd_soc_dapm_context *dapm,
				  const struct snd_soc_dapm_route *route)
{
2924
	struct snd_soc_dapm_widget *wsource, *wsink;
2925 2926 2927 2928 2929
	struct snd_soc_dapm_path *path, *p;
	const char *sink;
	const char *source;
	char prefixed_sink[80];
	char prefixed_source[80];
2930
	const char *prefix;
2931 2932 2933

	if (route->control) {
		dev_err(dapm->dev,
2934
			"ASoC: Removal of routes with controls not supported\n");
2935 2936 2937
		return -EINVAL;
	}

2938 2939
	prefix = soc_dapm_prefix(dapm);
	if (prefix) {
2940
		snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
2941
			 prefix, route->sink);
2942 2943
		sink = prefixed_sink;
		snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
2944
			 prefix, route->source);
2945 2946 2947 2948 2949 2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961
		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) {
2962 2963 2964 2965 2966
		wsource = path->source;
		wsink = path->sink;

		dapm_mark_dirty(wsource, "Route removed");
		dapm_mark_dirty(wsink, "Route removed");
2967 2968
		if (path->connect)
			dapm_path_invalidate(path);
2969

2970
		dapm_free_path(path);
2971 2972 2973 2974

		/* Update any path related flags */
		dapm_update_widget_flags(wsource);
		dapm_update_widget_flags(wsink);
2975
	} else {
2976
		dev_warn(dapm->dev, "ASoC: Route %s->%s does not exist\n",
2977 2978 2979 2980 2981 2982
			 source, sink);
	}

	return 0;
}

2983 2984
/**
 * snd_soc_dapm_add_routes - Add routes between DAPM widgets
L
Liam Girdwood 已提交
2985
 * @dapm: DAPM context
2986 2987 2988 2989 2990 2991 2992 2993 2994 2995
 * @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 已提交
2996
int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
2997 2998
			    const struct snd_soc_dapm_route *route, int num)
{
2999
	int i, r, ret = 0;
3000

3001
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3002
	for (i = 0; i < num; i++) {
3003
		r = snd_soc_dapm_add_route(dapm, route);
3004
		if (r < 0) {
3005 3006 3007 3008
			dev_err(dapm->dev, "ASoC: Failed to add route %s -> %s -> %s\n",
				route->source,
				route->control ? route->control : "direct",
				route->sink);
3009
			ret = r;
3010 3011 3012
		}
		route++;
	}
3013
	mutex_unlock(&dapm->card->dapm_mutex);
3014

3015
	return ret;
3016 3017 3018
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);

3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029
/**
 * 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)
{
3030
	int i;
3031

3032
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3033 3034 3035 3036 3037 3038
	for (i = 0; i < num; i++) {
		snd_soc_dapm_del_route(dapm, route);
		route++;
	}
	mutex_unlock(&dapm->card->dapm_mutex);

3039
	return 0;
3040 3041 3042
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_del_routes);

3043 3044 3045 3046 3047 3048 3049 3050 3051 3052 3053 3054 3055
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) {
3056
		dev_err(dapm->dev, "ASoC: Unable to find source %s for weak route\n",
3057 3058 3059 3060 3061
			route->source);
		return -ENODEV;
	}

	if (!sink) {
3062
		dev_err(dapm->dev, "ASoC: Unable to find sink %s for weak route\n",
3063 3064 3065 3066 3067
			route->sink);
		return -ENODEV;
	}

	if (route->control || route->connected)
3068
		dev_warn(dapm->dev, "ASoC: Ignoring control for weak route %s->%s\n",
3069 3070
			 route->source, route->sink);

3071
	snd_soc_dapm_widget_for_each_sink_path(source, path) {
3072 3073 3074 3075 3076 3077 3078
		if (path->sink == sink) {
			path->weak = 1;
			count++;
		}
	}

	if (count == 0)
3079
		dev_err(dapm->dev, "ASoC: No path found for weak route %s->%s\n",
3080 3081
			route->source, route->sink);
	if (count > 1)
3082
		dev_warn(dapm->dev, "ASoC: %d paths found for weak route %s->%s\n",
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 3109
			 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;

3110
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
3111 3112 3113 3114 3115 3116
	for (i = 0; i < num; i++) {
		err = snd_soc_dapm_weak_route(dapm, route);
		if (err)
			ret = err;
		route++;
	}
3117
	mutex_unlock(&dapm->card->dapm_mutex);
3118 3119 3120 3121 3122

	return ret;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_weak_routes);

3123 3124
/**
 * snd_soc_dapm_new_widgets - add new dapm widgets
3125
 * @card: card to be checked for new dapm widgets
3126 3127 3128 3129 3130
 *
 * Checks the codec for any new dapm widgets and creates them if found.
 *
 * Returns 0 for success.
 */
3131
int snd_soc_dapm_new_widgets(struct snd_soc_card *card)
3132 3133
{
	struct snd_soc_dapm_widget *w;
3134
	unsigned int val;
3135

3136
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
3137

3138
	list_for_each_entry(w, &card->widgets, list)
3139 3140 3141 3142
	{
		if (w->new)
			continue;

3143
		if (w->num_kcontrols) {
K
Kees Cook 已提交
3144
			w->kcontrols = kcalloc(w->num_kcontrols,
3145 3146
						sizeof(struct snd_kcontrol *),
						GFP_KERNEL);
3147
			if (!w->kcontrols) {
3148
				mutex_unlock(&card->dapm_mutex);
3149
				return -ENOMEM;
3150
			}
3151 3152
		}

3153 3154 3155
		switch(w->id) {
		case snd_soc_dapm_switch:
		case snd_soc_dapm_mixer:
3156
		case snd_soc_dapm_mixer_named_ctl:
3157
			dapm_new_mixer(w);
3158 3159
			break;
		case snd_soc_dapm_mux:
3160
		case snd_soc_dapm_demux:
3161
			dapm_new_mux(w);
3162 3163
			break;
		case snd_soc_dapm_pga:
3164
		case snd_soc_dapm_out_drv:
3165
			dapm_new_pga(w);
3166
			break;
3167 3168 3169
		case snd_soc_dapm_dai_link:
			dapm_new_dai_link(w);
			break;
3170
		default:
3171 3172
			break;
		}
3173 3174 3175

		/* Read the initial power state from the device */
		if (w->reg >= 0) {
3176
			soc_dapm_read(w->dapm, w->reg, &val);
3177
			val = val >> w->shift;
3178 3179
			val &= w->mask;
			if (val == w->on_val)
3180 3181 3182
				w->power = 1;
		}

3183
		w->new = 1;
3184

3185
		dapm_mark_dirty(w, "new widget");
3186
		dapm_debugfs_add_widget(w);
3187 3188
	}

3189 3190
	dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
	mutex_unlock(&card->dapm_mutex);
3191 3192 3193 3194 3195 3196 3197
	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 已提交
3198
 * @ucontrol: control element information
3199 3200 3201 3202 3203 3204 3205 3206
 *
 * 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)
{
3207 3208
	struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
	struct snd_soc_card *card = dapm->card;
3209 3210
	struct soc_mixer_control *mc =
		(struct soc_mixer_control *)kcontrol->private_value;
3211
	int reg = mc->reg;
3212
	unsigned int shift = mc->shift;
3213
	int max = mc->max;
3214
	unsigned int width = fls(max);
3215
	unsigned int mask = (1 << fls(max)) - 1;
3216
	unsigned int invert = mc->invert;
3217
	unsigned int reg_val, val, rval = 0;
3218
	int ret = 0;
3219

3220
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3221
	if (dapm_kcontrol_is_powered(kcontrol) && reg != SND_SOC_NOPM) {
3222 3223 3224 3225 3226 3227 3228 3229
		ret = soc_dapm_read(dapm, reg, &reg_val);
		val = (reg_val >> shift) & mask;

		if (ret == 0 && reg != mc->rreg)
			ret = soc_dapm_read(dapm, mc->rreg, &reg_val);

		if (snd_soc_volsw_is_stereo(mc))
			rval = (reg_val >> mc->rshift) & mask;
3230
	} else {
3231 3232 3233 3234 3235
		reg_val = dapm_kcontrol_get_value(kcontrol);
		val = reg_val & mask;

		if (snd_soc_volsw_is_stereo(mc))
			rval = (reg_val >> width) & mask;
3236
	}
3237 3238
	mutex_unlock(&card->dapm_mutex);

3239 3240 3241
	if (ret)
		return ret;

3242
	if (invert)
3243 3244 3245
		ucontrol->value.integer.value[0] = max - val;
	else
		ucontrol->value.integer.value[0] = val;
3246

3247 3248 3249 3250 3251 3252 3253
	if (snd_soc_volsw_is_stereo(mc)) {
		if (invert)
			ucontrol->value.integer.value[1] = max - rval;
		else
			ucontrol->value.integer.value[1] = rval;
	}

3254
	return ret;
3255 3256 3257 3258 3259 3260
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);

/**
 * snd_soc_dapm_put_volsw - dapm mixer set callback
 * @kcontrol: mixer control
M
Mark Brown 已提交
3261
 * @ucontrol: control element information
3262 3263 3264 3265 3266 3267 3268 3269
 *
 * 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)
{
3270 3271
	struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
	struct snd_soc_card *card = dapm->card;
3272 3273
	struct soc_mixer_control *mc =
		(struct soc_mixer_control *)kcontrol->private_value;
3274
	int reg = mc->reg;
3275
	unsigned int shift = mc->shift;
3276
	int max = mc->max;
3277 3278
	unsigned int width = fls(max);
	unsigned int mask = (1 << width) - 1;
3279
	unsigned int invert = mc->invert;
3280 3281
	unsigned int val, rval = 0;
	int connect, rconnect = -1, change, reg_change = 0;
3282
	struct snd_soc_dapm_update update = {};
3283
	int ret = 0;
3284 3285

	val = (ucontrol->value.integer.value[0] & mask);
3286
	connect = !!val;
3287 3288

	if (invert)
P
Philipp Zabel 已提交
3289
		val = max - val;
3290

3291 3292 3293 3294 3295 3296 3297
	if (snd_soc_volsw_is_stereo(mc)) {
		rval = (ucontrol->value.integer.value[1] & mask);
		rconnect = !!rval;
		if (invert)
			rval = max - rval;
	}

3298
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3299

3300 3301 3302 3303 3304 3305
	/* This assumes field width < (bits in unsigned int / 2) */
	if (width > sizeof(unsigned int) * 8 / 2)
		dev_warn(dapm->dev,
			 "ASoC: control %s field width limit exceeded\n",
			 kcontrol->id.name);
	change = dapm_kcontrol_set_value(kcontrol, val | (rval << width));
3306

3307 3308
	if (reg != SND_SOC_NOPM) {
		val = val << shift;
3309 3310 3311
		rval = rval << mc->rshift;

		reg_change = soc_dapm_test_bits(dapm, reg, mask << shift, val);
3312

3313 3314 3315 3316
		if (snd_soc_volsw_is_stereo(mc))
			reg_change |= soc_dapm_test_bits(dapm, mc->rreg,
							 mask << mc->rshift,
							 rval);
3317 3318 3319 3320
	}

	if (change || reg_change) {
		if (reg_change) {
3321 3322 3323 3324 3325 3326
			if (snd_soc_volsw_is_stereo(mc)) {
				update.has_second_set = true;
				update.reg2 = mc->rreg;
				update.mask2 = mask << mc->rshift;
				update.val2 = rval;
			}
3327 3328
			update.kcontrol = kcontrol;
			update.reg = reg;
3329
			update.mask = mask << shift;
3330 3331
			update.val = val;
			card->update = &update;
3332
		}
3333
		change |= reg_change;
3334

3335 3336
		ret = soc_dapm_mixer_update_power(card, kcontrol, connect,
						  rconnect);
3337

3338
		card->update = NULL;
3339 3340
	}

3341
	mutex_unlock(&card->dapm_mutex);
3342 3343 3344 3345

	if (ret > 0)
		soc_dpcm_runtime_update(card);

3346
	return change;
3347 3348 3349 3350 3351 3352
}
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 已提交
3353
 * @ucontrol: control element information
3354 3355 3356 3357 3358 3359 3360 3361
 *
 * 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)
{
3362
	struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
3363
	struct snd_soc_card *card = dapm->card;
3364
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3365
	unsigned int reg_val, val;
3366

3367 3368
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
	if (e->reg != SND_SOC_NOPM && dapm_kcontrol_is_powered(kcontrol)) {
3369
		int ret = soc_dapm_read(dapm, e->reg, &reg_val);
3370 3371
		if (ret) {
			mutex_unlock(&card->dapm_mutex);
3372
			return ret;
3373
		}
3374
	} else {
3375
		reg_val = dapm_kcontrol_get_value(kcontrol);
3376
	}
3377
	mutex_unlock(&card->dapm_mutex);
P
Peter Ujfalusi 已提交
3378 3379

	val = (reg_val >> e->shift_l) & e->mask;
3380
	ucontrol->value.enumerated.item[0] = snd_soc_enum_val_to_item(e, val);
P
Peter Ujfalusi 已提交
3381 3382
	if (e->shift_l != e->shift_r) {
		val = (reg_val >> e->shift_r) & e->mask;
3383 3384
		val = snd_soc_enum_val_to_item(e, val);
		ucontrol->value.enumerated.item[1] = val;
P
Peter Ujfalusi 已提交
3385 3386
	}

3387
	return 0;
P
Peter Ujfalusi 已提交
3388
}
3389
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
P
Peter Ujfalusi 已提交
3390 3391

/**
3392
 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
P
Peter Ujfalusi 已提交
3393 3394 3395
 * @kcontrol: mixer control
 * @ucontrol: control element information
 *
3396
 * Callback to set the value of a dapm enumerated double mixer control.
P
Peter Ujfalusi 已提交
3397 3398 3399
 *
 * Returns 0 for success.
 */
3400
int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
P
Peter Ujfalusi 已提交
3401 3402
	struct snd_ctl_elem_value *ucontrol)
{
3403 3404
	struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
	struct snd_soc_card *card = dapm->card;
3405
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3406
	unsigned int *item = ucontrol->value.enumerated.item;
3407
	unsigned int val, change, reg_change = 0;
3408
	unsigned int mask;
3409
	struct snd_soc_dapm_update update = {};
3410
	int ret = 0;
P
Peter Ujfalusi 已提交
3411

3412
	if (item[0] >= e->items)
P
Peter Ujfalusi 已提交
3413
		return -EINVAL;
3414 3415

	val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
P
Peter Ujfalusi 已提交
3416 3417
	mask = e->mask << e->shift_l;
	if (e->shift_l != e->shift_r) {
3418
		if (item[1] > e->items)
P
Peter Ujfalusi 已提交
3419
			return -EINVAL;
3420
		val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r;
P
Peter Ujfalusi 已提交
3421 3422 3423
		mask |= e->mask << e->shift_r;
	}

3424
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3425

3426 3427
	change = dapm_kcontrol_set_value(kcontrol, val);

3428
	if (e->reg != SND_SOC_NOPM)
3429
		reg_change = soc_dapm_test_bits(dapm, e->reg, mask, val);
3430

3431 3432
	if (change || reg_change) {
		if (reg_change) {
3433 3434 3435 3436 3437 3438
			update.kcontrol = kcontrol;
			update.reg = e->reg;
			update.mask = mask;
			update.val = val;
			card->update = &update;
		}
3439
		change |= reg_change;
3440

3441
		ret = soc_dapm_mux_update_power(card, kcontrol, item[0], e);
3442

3443
		card->update = NULL;
3444
	}
P
Peter Ujfalusi 已提交
3445

3446
	mutex_unlock(&card->dapm_mutex);
3447 3448 3449 3450

	if (ret > 0)
		soc_dpcm_runtime_update(card);

3451
	return change;
P
Peter Ujfalusi 已提交
3452
}
3453
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
P
Peter Ujfalusi 已提交
3454

3455 3456 3457 3458 3459 3460 3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476 3477 3478 3479 3480 3481 3482 3483
/**
 * 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)
{
3484
	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
3485 3486
	const char *pin = (const char *)kcontrol->private_value;

3487
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3488 3489

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

3492
	mutex_unlock(&card->dapm_mutex);
3493 3494 3495 3496 3497 3498 3499 3500 3501 3502 3503 3504 3505 3506

	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)
{
3507
	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
3508 3509 3510
	const char *pin = (const char *)kcontrol->private_value;

	if (ucontrol->value.integer.value[0])
3511
		snd_soc_dapm_enable_pin(&card->dapm, pin);
3512
	else
3513
		snd_soc_dapm_disable_pin(&card->dapm, pin);
3514

3515
	snd_soc_dapm_sync(&card->dapm);
3516 3517 3518 3519
	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);

3520 3521
struct snd_soc_dapm_widget *
snd_soc_dapm_new_control_unlocked(struct snd_soc_dapm_context *dapm,
3522
			 const struct snd_soc_dapm_widget *widget)
3523
{
3524
	enum snd_soc_dapm_direction dir;
3525
	struct snd_soc_dapm_widget *w;
3526
	const char *prefix;
3527
	int ret;
3528 3529

	if ((w = dapm_cnew_widget(widget)) == NULL)
3530
		return ERR_PTR(-ENOMEM);
3531

3532 3533
	switch (w->id) {
	case snd_soc_dapm_regulator_supply:
3534 3535 3536
		w->regulator = devm_regulator_get(dapm->dev, w->name);
		if (IS_ERR(w->regulator)) {
			ret = PTR_ERR(w->regulator);
3537
			goto request_failed;
3538
		}
3539

3540
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
3541 3542
			ret = regulator_allow_bypass(w->regulator, true);
			if (ret != 0)
3543
				dev_warn(dapm->dev,
3544
					 "ASoC: Failed to bypass %s: %d\n",
3545 3546
					 w->name, ret);
		}
3547
		break;
3548 3549
	case snd_soc_dapm_pinctrl:
		w->pinctrl = devm_pinctrl_get(dapm->dev);
3550
		if (IS_ERR(w->pinctrl)) {
3551
			ret = PTR_ERR(w->pinctrl);
3552
			goto request_failed;
3553 3554
		}
		break;
3555
	case snd_soc_dapm_clock_supply:
M
Mark Brown 已提交
3556
		w->clk = devm_clk_get(dapm->dev, w->name);
3557 3558
		if (IS_ERR(w->clk)) {
			ret = PTR_ERR(w->clk);
3559
			goto request_failed;
3560 3561
		}
		break;
3562 3563 3564
	default:
		break;
	}
3565

3566
	prefix = soc_dapm_prefix(dapm);
3567
	if (prefix)
3568
		w->name = kasprintf(GFP_KERNEL, "%s %s", prefix, widget->name);
3569
	else
3570
		w->name = kstrdup_const(widget->name, GFP_KERNEL);
3571
	if (w->name == NULL) {
3572
		kfree_const(w->sname);
3573
		kfree(w);
3574
		return ERR_PTR(-ENOMEM);
3575 3576
	}

3577
	switch (w->id) {
3578
	case snd_soc_dapm_mic:
3579
		w->is_ep = SND_SOC_DAPM_EP_SOURCE;
3580 3581
		w->power_check = dapm_generic_check_power;
		break;
3582 3583
	case snd_soc_dapm_input:
		if (!dapm->card->fully_routed)
3584
			w->is_ep = SND_SOC_DAPM_EP_SOURCE;
3585 3586
		w->power_check = dapm_generic_check_power;
		break;
3587 3588
	case snd_soc_dapm_spk:
	case snd_soc_dapm_hp:
3589
		w->is_ep = SND_SOC_DAPM_EP_SINK;
3590 3591
		w->power_check = dapm_generic_check_power;
		break;
3592 3593
	case snd_soc_dapm_output:
		if (!dapm->card->fully_routed)
3594
			w->is_ep = SND_SOC_DAPM_EP_SINK;
3595 3596
		w->power_check = dapm_generic_check_power;
		break;
3597 3598
	case snd_soc_dapm_vmid:
	case snd_soc_dapm_siggen:
3599
		w->is_ep = SND_SOC_DAPM_EP_SOURCE;
3600 3601
		w->power_check = dapm_always_on_check_power;
		break;
V
Vinod Koul 已提交
3602 3603 3604 3605 3606
	case snd_soc_dapm_sink:
		w->is_ep = SND_SOC_DAPM_EP_SINK;
		w->power_check = dapm_always_on_check_power;
		break;

3607
	case snd_soc_dapm_mux:
3608
	case snd_soc_dapm_demux:
3609 3610 3611
	case snd_soc_dapm_switch:
	case snd_soc_dapm_mixer:
	case snd_soc_dapm_mixer_named_ctl:
3612 3613 3614 3615
	case snd_soc_dapm_adc:
	case snd_soc_dapm_aif_out:
	case snd_soc_dapm_dac:
	case snd_soc_dapm_aif_in:
3616 3617 3618 3619
	case snd_soc_dapm_pga:
	case snd_soc_dapm_out_drv:
	case snd_soc_dapm_micbias:
	case snd_soc_dapm_line:
3620
	case snd_soc_dapm_dai_link:
3621 3622
	case snd_soc_dapm_dai_out:
	case snd_soc_dapm_dai_in:
3623 3624 3625
		w->power_check = dapm_generic_check_power;
		break;
	case snd_soc_dapm_supply:
3626
	case snd_soc_dapm_regulator_supply:
3627
	case snd_soc_dapm_pinctrl:
3628
	case snd_soc_dapm_clock_supply:
3629
	case snd_soc_dapm_kcontrol:
3630
		w->is_supply = 1;
3631 3632 3633 3634 3635 3636 3637
		w->power_check = dapm_supply_check_power;
		break;
	default:
		w->power_check = dapm_always_on_check_power;
		break;
	}

L
Liam Girdwood 已提交
3638
	w->dapm = dapm;
3639
	INIT_LIST_HEAD(&w->list);
3640
	INIT_LIST_HEAD(&w->dirty);
3641
	list_add_tail(&w->list, &dapm->card->widgets);
3642

3643 3644 3645 3646
	snd_soc_dapm_for_each_direction(dir) {
		INIT_LIST_HEAD(&w->edges[dir]);
		w->endpoints[dir] = -1;
	}
3647

3648
	/* machine layer sets up unconnected pins and insertions */
3649
	w->connected = 1;
3650
	return w;
3651 3652 3653 3654 3655 3656 3657

request_failed:
	if (ret != -EPROBE_DEFER)
		dev_err(dapm->dev, "ASoC: Failed to request %s: %d\n",
			w->name, ret);

	return ERR_PTR(ret);
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
/**
 * snd_soc_dapm_new_control - create new dapm control
 * @dapm: DAPM context
 * @widget: widget template
 *
 * Creates new DAPM control based upon a template.
 *
 * Returns a widget pointer on success or an error pointer on failure
 */
struct snd_soc_dapm_widget *
snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
			 const struct snd_soc_dapm_widget *widget)
{
	struct snd_soc_dapm_widget *w;

	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
	w = snd_soc_dapm_new_control_unlocked(dapm, widget);
	mutex_unlock(&dapm->card->dapm_mutex);

	return w;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);

3683 3684
/**
 * snd_soc_dapm_new_controls - create new dapm controls
L
Liam Girdwood 已提交
3685
 * @dapm: DAPM context
3686 3687 3688 3689 3690 3691 3692
 * @widget: widget array
 * @num: number of widgets
 *
 * Creates new DAPM controls based upon the templates.
 *
 * Returns 0 for success else error.
 */
L
Liam Girdwood 已提交
3693
int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
3694 3695 3696
	const struct snd_soc_dapm_widget *widget,
	int num)
{
3697 3698
	struct snd_soc_dapm_widget *w;
	int i;
3699
	int ret = 0;
3700

3701
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
3702
	for (i = 0; i < num; i++) {
3703
		w = snd_soc_dapm_new_control_unlocked(dapm, widget);
3704 3705
		if (IS_ERR(w)) {
			ret = PTR_ERR(w);
3706
			break;
3707
		}
3708 3709
		widget++;
	}
3710
	mutex_unlock(&dapm->card->dapm_mutex);
3711
	return ret;
3712 3713 3714
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);

3715 3716 3717
static int snd_soc_dai_link_event(struct snd_soc_dapm_widget *w,
				  struct snd_kcontrol *kcontrol, int event)
{
3718
	struct snd_soc_dapm_path *path;
3719
	struct snd_soc_dai *source, *sink;
3720
	struct snd_soc_pcm_runtime *rtd = w->priv;
3721
	const struct snd_soc_pcm_stream *config;
3722
	struct snd_pcm_substream substream;
3723
	struct snd_pcm_hw_params *params = NULL;
3724
	struct snd_pcm_runtime *runtime = NULL;
3725
	unsigned int fmt;
3726
	int ret = 0;
3727

3728 3729
	config = rtd->dai_link->params + rtd->params_select;

3730
	if (WARN_ON(!config) ||
3731 3732
	    WARN_ON(list_empty(&w->edges[SND_SOC_DAPM_DIR_OUT]) ||
		    list_empty(&w->edges[SND_SOC_DAPM_DIR_IN])))
3733
		return -EINVAL;
3734 3735 3736 3737 3738

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

	/* Currently very limited parameter selection */
3745 3746 3747 3748 3749 3750
	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);
3751

3752
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->min =
3753
		config->rate_min;
3754
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->max =
3755 3756
		config->rate_max;

3757
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->min
3758
		= config->channels_min;
3759
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->max
3760 3761 3762 3763
		= config->channels_max;

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

3764 3765 3766 3767 3768 3769 3770
	/* Allocate a dummy snd_pcm_runtime for startup() and other ops() */
	runtime = kzalloc(sizeof(*runtime), GFP_KERNEL);
	if (!runtime) {
		ret = -ENOMEM;
		goto out;
	}
	substream.runtime = runtime;
3771
	substream.private_data = rtd;
3772

3773 3774
	switch (event) {
	case SND_SOC_DAPM_PRE_PMU:
3775
		substream.stream = SNDRV_PCM_STREAM_CAPTURE;
3776 3777 3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788
		snd_soc_dapm_widget_for_each_source_path(w, path) {
			source = path->source->priv;

			if (source->driver->ops->startup) {
				ret = source->driver->ops->startup(&substream,
								   source);
				if (ret < 0) {
					dev_err(source->dev,
						"ASoC: startup() failed: %d\n",
						ret);
					goto out;
				}
				source->active++;
3789
			}
3790 3791 3792
			ret = soc_dai_hw_params(&substream, params, source);
			if (ret < 0)
				goto out;
3793 3794

			dapm_update_dai_unlocked(&substream, params, source);
3795
		}
3796

3797
		substream.stream = SNDRV_PCM_STREAM_PLAYBACK;
3798 3799 3800 3801 3802 3803 3804 3805 3806 3807 3808 3809 3810
		snd_soc_dapm_widget_for_each_sink_path(w, path) {
			sink = path->sink->priv;

			if (sink->driver->ops->startup) {
				ret = sink->driver->ops->startup(&substream,
								 sink);
				if (ret < 0) {
					dev_err(sink->dev,
						"ASoC: startup() failed: %d\n",
						ret);
					goto out;
				}
				sink->active++;
3811
			}
3812 3813 3814
			ret = soc_dai_hw_params(&substream, params, sink);
			if (ret < 0)
				goto out;
3815 3816

			dapm_update_dai_unlocked(&substream, params, sink);
3817
		}
3818 3819 3820
		break;

	case SND_SOC_DAPM_POST_PMU:
3821 3822 3823 3824 3825 3826 3827 3828 3829 3830
		snd_soc_dapm_widget_for_each_sink_path(w, path) {
			sink = path->sink->priv;

			ret = snd_soc_dai_digital_mute(sink, 0,
						       SNDRV_PCM_STREAM_PLAYBACK);
			if (ret != 0 && ret != -ENOTSUPP)
				dev_warn(sink->dev,
					 "ASoC: Failed to unmute: %d\n", ret);
			ret = 0;
		}
3831 3832 3833
		break;

	case SND_SOC_DAPM_PRE_PMD:
3834 3835 3836 3837 3838 3839 3840 3841 3842 3843 3844
		snd_soc_dapm_widget_for_each_sink_path(w, path) {
			sink = path->sink->priv;

			ret = snd_soc_dai_digital_mute(sink, 1,
						       SNDRV_PCM_STREAM_PLAYBACK);
			if (ret != 0 && ret != -ENOTSUPP)
				dev_warn(sink->dev,
					 "ASoC: Failed to mute: %d\n", ret);
			ret = 0;
		}

3845
		substream.stream = SNDRV_PCM_STREAM_CAPTURE;
3846 3847
		snd_soc_dapm_widget_for_each_source_path(w, path) {
			source = path->source->priv;
3848

3849 3850 3851 3852
			if (source->driver->ops->hw_free)
				source->driver->ops->hw_free(&substream,
							     source);

3853
			source->active--;
3854
			if (source->driver->ops->shutdown)
3855 3856
				source->driver->ops->shutdown(&substream,
							      source);
3857 3858
		}

3859
		substream.stream = SNDRV_PCM_STREAM_PLAYBACK;
3860 3861 3862
		snd_soc_dapm_widget_for_each_sink_path(w, path) {
			sink = path->sink->priv;

3863 3864 3865
			if (sink->driver->ops->hw_free)
				sink->driver->ops->hw_free(&substream, sink);

3866
			sink->active--;
3867
			if (sink->driver->ops->shutdown)
3868
				sink->driver->ops->shutdown(&substream, sink);
3869
		}
3870 3871 3872
		break;

	default:
T
Takashi Iwai 已提交
3873
		WARN(1, "Unknown event %d\n", event);
S
Sudip Mukherjee 已提交
3874
		ret = -EINVAL;
3875 3876
	}

3877
out:
3878
	kfree(runtime);
3879 3880
	kfree(params);
	return ret;
3881 3882
}

3883 3884 3885 3886
static int snd_soc_dapm_dai_link_get(struct snd_kcontrol *kcontrol,
			  struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol);
3887
	struct snd_soc_pcm_runtime *rtd = w->priv;
3888

3889
	ucontrol->value.enumerated.item[0] = rtd->params_select;
3890 3891 3892 3893 3894 3895 3896 3897

	return 0;
}

static int snd_soc_dapm_dai_link_put(struct snd_kcontrol *kcontrol,
			  struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol);
3898
	struct snd_soc_pcm_runtime *rtd = w->priv;
3899 3900 3901 3902 3903

	/* Can't change the config when widget is already powered */
	if (w->power)
		return -EBUSY;

3904
	if (ucontrol->value.enumerated.item[0] == rtd->params_select)
3905 3906
		return 0;

3907
	if (ucontrol->value.enumerated.item[0] >= rtd->dai_link->num_params)
3908 3909
		return -EINVAL;

3910
	rtd->params_select = ucontrol->value.enumerated.item[0];
3911 3912 3913 3914

	return 0;
}

3915
static void
3916 3917 3918 3919 3920 3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934
snd_soc_dapm_free_kcontrol(struct snd_soc_card *card,
			unsigned long *private_value,
			int num_params,
			const char **w_param_text)
{
	int count;

	devm_kfree(card->dev, (void *)*private_value);
	for (count = 0 ; count < num_params; count++)
		devm_kfree(card->dev, (void *)w_param_text[count]);
	devm_kfree(card->dev, w_param_text);
}

static struct snd_kcontrol_new *
snd_soc_dapm_alloc_kcontrol(struct snd_soc_card *card,
			char *link_name,
			const struct snd_soc_pcm_stream *params,
			int num_params, const char **w_param_text,
			unsigned long *private_value)
3935
{
3936 3937 3938 3939 3940 3941 3942 3943
	struct soc_enum w_param_enum[] = {
		SOC_ENUM_SINGLE(0, 0, 0, NULL),
	};
	struct snd_kcontrol_new kcontrol_dai_link[] = {
		SOC_ENUM_EXT(NULL, w_param_enum[0],
			     snd_soc_dapm_dai_link_get,
			     snd_soc_dapm_dai_link_put),
	};
3944
	struct snd_kcontrol_new *kcontrol_news;
3945
	const struct snd_soc_pcm_stream *config = params;
3946
	int count;
3947

3948 3949 3950 3951 3952 3953
	for (count = 0 ; count < num_params; count++) {
		if (!config->stream_name) {
			dev_warn(card->dapm.dev,
				"ASoC: anonymous config %d for dai link %s\n",
				count, link_name);
			w_param_text[count] =
C
Charles Keepax 已提交
3954 3955 3956
				devm_kasprintf(card->dev, GFP_KERNEL,
					       "Anonymous Configuration %d",
					       count);
3957 3958 3959 3960 3961 3962
		} else {
			w_param_text[count] = devm_kmemdup(card->dev,
						config->stream_name,
						strlen(config->stream_name) + 1,
						GFP_KERNEL);
		}
3963 3964
		if (!w_param_text[count])
			goto outfree_w_param;
3965 3966
		config++;
	}
3967

3968 3969
	w_param_enum[0].items = num_params;
	w_param_enum[0].texts = w_param_text;
3970

3971
	*private_value =
3972 3973 3974
		(unsigned long) devm_kmemdup(card->dev,
			(void *)(kcontrol_dai_link[0].private_value),
			sizeof(struct soc_enum), GFP_KERNEL);
3975
	if (!*private_value) {
3976 3977
		dev_err(card->dev, "ASoC: Failed to create control for %s widget\n",
			link_name);
3978
		goto outfree_w_param;
3979
	}
3980
	kcontrol_dai_link[0].private_value = *private_value;
3981
	/* duplicate kcontrol_dai_link on heap so that memory persists */
3982
	kcontrol_news = devm_kmemdup(card->dev, &kcontrol_dai_link[0],
3983 3984
					sizeof(struct snd_kcontrol_new),
					GFP_KERNEL);
3985
	if (!kcontrol_news) {
3986 3987
		dev_err(card->dev, "ASoC: Failed to create control for %s widget\n",
			link_name);
3988
		goto outfree_w_param;
3989
	}
3990
	return kcontrol_news;
3991

3992 3993 3994 3995 3996
outfree_w_param:
	snd_soc_dapm_free_kcontrol(card, private_value, num_params, w_param_text);
	return NULL;
}

3997 3998 3999 4000
static struct snd_soc_dapm_widget *
snd_soc_dapm_new_dai(struct snd_soc_card *card, struct snd_soc_pcm_runtime *rtd,
		     struct snd_soc_dapm_widget *source,
		     struct snd_soc_dapm_widget *sink)
4001 4002 4003 4004 4005 4006 4007 4008 4009 4010 4011
{
	struct snd_soc_dapm_widget template;
	struct snd_soc_dapm_widget *w;
	const char **w_param_text;
	unsigned long private_value;
	char *link_name;
	int ret;

	link_name = devm_kasprintf(card->dev, GFP_KERNEL, "%s-%s",
				   source->name, sink->name);
	if (!link_name)
4012
		return ERR_PTR(-ENOMEM);
4013 4014 4015 4016 4017 4018 4019 4020 4021 4022 4023

	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;
	template.kcontrol_news = NULL;

	/* allocate memory for control, only in case of multiple configs */
4024 4025 4026 4027
	if (rtd->dai_link->num_params > 1) {
		w_param_text = devm_kcalloc(card->dev,
					    rtd->dai_link->num_params,
					    sizeof(char *), GFP_KERNEL);
4028 4029 4030 4031
		if (!w_param_text) {
			ret = -ENOMEM;
			goto param_fail;
		}
4032

4033 4034 4035
		template.num_kcontrols = 1;
		template.kcontrol_news =
					snd_soc_dapm_alloc_kcontrol(card,
4036 4037 4038
						link_name,
						rtd->dai_link->params,
						rtd->dai_link->num_params,
4039 4040 4041 4042 4043
						w_param_text, &private_value);
		if (!template.kcontrol_news) {
			ret = -ENOMEM;
			goto param_fail;
		}
4044 4045
	} else {
		w_param_text = NULL;
4046
	}
4047
	dev_dbg(card->dev, "ASoC: adding %s widget\n", link_name);
4048

4049
	w = snd_soc_dapm_new_control_unlocked(&card->dapm, &template);
4050 4051
	if (IS_ERR(w)) {
		ret = PTR_ERR(w);
4052
		goto outfree_kcontrol_news;
4053
	}
4054

4055
	w->priv = rtd;
4056

4057
	return w;
4058 4059 4060

outfree_kcontrol_news:
	devm_kfree(card->dev, (void *)template.kcontrol_news);
4061 4062
	snd_soc_dapm_free_kcontrol(card, &private_value,
				   rtd->dai_link->num_params, w_param_text);
4063
param_fail:
4064
	devm_kfree(card->dev, link_name);
4065
	return ERR_PTR(ret);
4066 4067
}

4068 4069
int snd_soc_dapm_new_dai_widgets(struct snd_soc_dapm_context *dapm,
				 struct snd_soc_dai *dai)
4070
{
4071
	struct snd_soc_dapm_widget template;
4072 4073
	struct snd_soc_dapm_widget *w;

4074 4075 4076 4077 4078 4079
	WARN_ON(dapm->dev != dai->dev);

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

	if (dai->driver->playback.stream_name) {
4080
		template.id = snd_soc_dapm_dai_in;
4081 4082 4083
		template.name = dai->driver->playback.stream_name;
		template.sname = dai->driver->playback.stream_name;

4084
		dev_dbg(dai->dev, "ASoC: adding %s widget\n",
4085 4086
			template.name);

4087
		w = snd_soc_dapm_new_control_unlocked(dapm, &template);
4088 4089
		if (IS_ERR(w))
			return PTR_ERR(w);
4090 4091 4092 4093 4094 4095

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

	if (dai->driver->capture.stream_name) {
4096
		template.id = snd_soc_dapm_dai_out;
4097 4098 4099
		template.name = dai->driver->capture.stream_name;
		template.sname = dai->driver->capture.stream_name;

4100
		dev_dbg(dai->dev, "ASoC: adding %s widget\n",
4101 4102
			template.name);

4103
		w = snd_soc_dapm_new_control_unlocked(dapm, &template);
4104 4105
		if (IS_ERR(w))
			return PTR_ERR(w);
4106 4107 4108 4109 4110 4111 4112 4113 4114 4115 4116

		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;
4117
	struct snd_soc_dapm_widget *src, *sink;
4118 4119 4120 4121
	struct snd_soc_dai *dai;

	/* For each DAI widget... */
	list_for_each_entry(dai_w, &card->widgets, list) {
4122 4123 4124 4125 4126
		switch (dai_w->id) {
		case snd_soc_dapm_dai_in:
		case snd_soc_dapm_dai_out:
			break;
		default:
4127
			continue;
4128
		}
4129

4130 4131 4132 4133 4134 4135 4136
		/* let users know there is no DAI to link */
		if (!dai_w->priv) {
			dev_dbg(card->dev, "dai widget %s has no DAI\n",
				dai_w->name);
			continue;
		}

4137 4138 4139 4140 4141 4142 4143
		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;

4144 4145 4146
			switch (w->id) {
			case snd_soc_dapm_dai_in:
			case snd_soc_dapm_dai_out:
4147
				continue;
4148 4149 4150
			default:
				break;
			}
4151

4152
			if (!w->sname || !strstr(w->sname, dai_w->sname))
4153 4154
				continue;

4155 4156 4157 4158 4159 4160
			if (dai_w->id == snd_soc_dapm_dai_in) {
				src = dai_w;
				sink = w;
			} else {
				src = w;
				sink = dai_w;
4161
			}
4162 4163
			dev_dbg(dai->dev, "%s -> %s\n", src->name, sink->name);
			snd_soc_dapm_add_path(w->dapm, src, sink, NULL, NULL);
4164 4165 4166
		}
	}

4167 4168
	return 0;
}
4169

4170 4171
static void dapm_connect_dai_link_widgets(struct snd_soc_card *card,
					  struct snd_soc_pcm_runtime *rtd)
4172
{
4173
	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
4174
	struct snd_soc_dai *codec_dai;
4175 4176
	struct snd_soc_dapm_widget *playback = NULL, *capture = NULL;
	struct snd_soc_dapm_widget *codec, *playback_cpu, *capture_cpu;
4177 4178
	int i;

4179 4180 4181 4182 4183 4184 4185 4186 4187 4188
	if (rtd->dai_link->params) {
		playback_cpu = cpu_dai->capture_widget;
		capture_cpu = cpu_dai->playback_widget;
	} else {
		playback = cpu_dai->playback_widget;
		capture = cpu_dai->capture_widget;
		playback_cpu = playback;
		capture_cpu = capture;
	}

4189
	for_each_rtd_codec_dai(rtd, i, codec_dai) {
4190 4191

		/* connect BE DAI playback if widgets are valid */
4192 4193 4194 4195 4196 4197 4198
		codec = codec_dai->playback_widget;

		if (playback_cpu && codec) {
			if (!playback) {
				playback = snd_soc_dapm_new_dai(card, rtd,
								playback_cpu,
								codec);
4199 4200 4201 4202 4203 4204 4205
				if (IS_ERR(playback)) {
					dev_err(rtd->dev,
						"ASoC: Failed to create DAI %s: %ld\n",
						codec_dai->name,
						PTR_ERR(playback));
					continue;
				}
4206 4207 4208 4209 4210

				snd_soc_dapm_add_path(&card->dapm, playback_cpu,
						      playback, NULL, NULL);
			}

4211
			dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n",
4212 4213
				cpu_dai->component->name, playback_cpu->name,
				codec_dai->component->name, codec->name);
4214

4215 4216
			snd_soc_dapm_add_path(&card->dapm, playback, codec,
					      NULL, NULL);
4217
		}
4218
	}
4219

4220
	for_each_rtd_codec_dai(rtd, i, codec_dai) {
4221
		/* connect BE DAI capture if widgets are valid */
4222 4223 4224 4225 4226 4227 4228
		codec = codec_dai->capture_widget;

		if (codec && capture_cpu) {
			if (!capture) {
				capture = snd_soc_dapm_new_dai(card, rtd,
							       codec,
							       capture_cpu);
4229 4230 4231 4232 4233 4234 4235
				if (IS_ERR(capture)) {
					dev_err(rtd->dev,
						"ASoC: Failed to create DAI %s: %ld\n",
						codec_dai->name,
						PTR_ERR(capture));
					continue;
				}
4236 4237 4238 4239 4240

				snd_soc_dapm_add_path(&card->dapm, capture,
						      capture_cpu, NULL, NULL);
			}

4241
			dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n",
4242 4243
				codec_dai->component->name, codec->name,
				cpu_dai->component->name, capture_cpu->name);
4244

4245 4246
			snd_soc_dapm_add_path(&card->dapm, codec, capture,
					      NULL, NULL);
4247 4248 4249 4250
		}
	}
}

4251
static void soc_dapm_dai_stream_event(struct snd_soc_dai *dai, int stream,
4252
	int event)
4253
{
4254
	struct snd_soc_dapm_widget *w;
4255
	unsigned int ep;
4256

4257 4258 4259 4260
	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
		w = dai->playback_widget;
	else
		w = dai->capture_widget;
4261

4262 4263
	if (w) {
		dapm_mark_dirty(w, "stream event");
4264

4265 4266 4267 4268 4269 4270 4271 4272
		if (w->id == snd_soc_dapm_dai_in) {
			ep = SND_SOC_DAPM_EP_SOURCE;
			dapm_widget_invalidate_input_paths(w);
		} else {
			ep = SND_SOC_DAPM_EP_SINK;
			dapm_widget_invalidate_output_paths(w);
		}

4273 4274
		switch (event) {
		case SND_SOC_DAPM_STREAM_START:
4275
			w->active = 1;
4276
			w->is_ep = ep;
4277 4278
			break;
		case SND_SOC_DAPM_STREAM_STOP:
4279
			w->active = 0;
4280
			w->is_ep = 0;
4281 4282 4283 4284 4285 4286 4287 4288
			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;
		}
	}
4289
}
4290

4291 4292
void snd_soc_dapm_connect_dai_link_widgets(struct snd_soc_card *card)
{
4293
	struct snd_soc_pcm_runtime *rtd;
4294 4295

	/* for each BE DAI link... */
4296
	for_each_card_rtds(card, rtd)  {
4297 4298 4299 4300
		/*
		 * dynamic FE links have no fixed DAI mapping.
		 * CODEC<->CODEC links have no direct connection.
		 */
4301
		if (rtd->dai_link->dynamic)
4302 4303 4304 4305 4306 4307
			continue;

		dapm_connect_dai_link_widgets(card, rtd);
	}
}

4308 4309 4310
static void soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
	int event)
{
4311
	struct snd_soc_dai *codec_dai;
4312 4313
	int i;

4314
	soc_dapm_dai_stream_event(rtd->cpu_dai, stream, event);
4315 4316
	for_each_rtd_codec_dai(rtd, i, codec_dai)
		soc_dapm_dai_stream_event(codec_dai, stream, event);
4317

4318
	dapm_power_widgets(rtd->card, event);
L
Liam Girdwood 已提交
4319 4320 4321 4322 4323 4324 4325 4326 4327 4328 4329 4330 4331
}

/**
 * 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.
 */
4332 4333
void snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
			      int event)
L
Liam Girdwood 已提交
4334
{
4335
	struct snd_soc_card *card = rtd->card;
L
Liam Girdwood 已提交
4336

4337
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
4338
	soc_dapm_stream_event(rtd, stream, event);
4339
	mutex_unlock(&card->dapm_mutex);
4340 4341
}

4342 4343 4344 4345 4346 4347 4348 4349 4350 4351 4352 4353 4354 4355 4356 4357 4358 4359 4360 4361
/**
 * snd_soc_dapm_enable_pin_unlocked - enable pin.
 * @dapm: DAPM context
 * @pin: pin name
 *
 * Enables input/output pin and its parents or children widgets iff there is
 * a valid audio route and active audio stream.
 *
 * Requires external locking.
 *
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
int snd_soc_dapm_enable_pin_unlocked(struct snd_soc_dapm_context *dapm,
				   const char *pin)
{
	return snd_soc_dapm_set_pin(dapm, pin, 1);
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin_unlocked);

4362
/**
4363
 * snd_soc_dapm_enable_pin - enable pin.
L
Liam Girdwood 已提交
4364
 * @dapm: DAPM context
4365
 * @pin: pin name
4366
 *
M
Mark Brown 已提交
4367
 * Enables input/output pin and its parents or children widgets iff there is
4368
 * a valid audio route and active audio stream.
4369
 *
4370 4371
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
4372
 */
L
Liam Girdwood 已提交
4373
int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
4374
{
4375 4376 4377 4378 4379 4380 4381 4382 4383
	int ret;

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

	ret = snd_soc_dapm_set_pin(dapm, pin, 1);

	mutex_unlock(&dapm->card->dapm_mutex);

	return ret;
4384 4385
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
4386

4387
/**
4388
 * snd_soc_dapm_force_enable_pin_unlocked - force a pin to be enabled
L
Liam Girdwood 已提交
4389
 * @dapm: DAPM context
4390 4391 4392 4393 4394 4395
 * @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.
 *
4396 4397
 * Requires external locking.
 *
4398 4399 4400
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
4401 4402
int snd_soc_dapm_force_enable_pin_unlocked(struct snd_soc_dapm_context *dapm,
					 const char *pin)
4403
{
4404
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
4405

4406
	if (!w) {
4407
		dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
4408
		return -EINVAL;
4409 4410
	}

4411
	dev_dbg(w->dapm->dev, "ASoC: force enable pin %s\n", pin);
4412 4413 4414 4415 4416 4417 4418 4419 4420
	if (!w->connected) {
		/*
		 * w->force does not affect the number of input or output paths,
		 * so we only have to recheck if w->connected is changed
		 */
		dapm_widget_invalidate_input_paths(w);
		dapm_widget_invalidate_output_paths(w);
		w->connected = 1;
	}
4421
	w->force = 1;
4422
	dapm_mark_dirty(w, "force enable");
4423

4424
	return 0;
4425
}
4426 4427 4428 4429 4430 4431 4432 4433 4434 4435 4436 4437 4438 4439 4440 4441 4442 4443 4444 4445 4446 4447 4448 4449 4450 4451 4452
EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin_unlocked);

/**
 * snd_soc_dapm_force_enable_pin - force a pin to be enabled
 * @dapm: DAPM context
 * @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.
 */
int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
				  const char *pin)
{
	int ret;

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

	ret = snd_soc_dapm_force_enable_pin_unlocked(dapm, pin);

	mutex_unlock(&dapm->card->dapm_mutex);

	return ret;
}
4453 4454
EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);

4455 4456 4457 4458 4459 4460 4461 4462 4463 4464 4465 4466 4467 4468 4469 4470 4471 4472 4473
/**
 * snd_soc_dapm_disable_pin_unlocked - disable pin.
 * @dapm: DAPM context
 * @pin: pin name
 *
 * Disables input/output pin and its parents or children widgets.
 *
 * Requires external locking.
 *
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
int snd_soc_dapm_disable_pin_unlocked(struct snd_soc_dapm_context *dapm,
				    const char *pin)
{
	return snd_soc_dapm_set_pin(dapm, pin, 0);
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin_unlocked);

4474 4475
/**
 * snd_soc_dapm_disable_pin - disable pin.
L
Liam Girdwood 已提交
4476
 * @dapm: DAPM context
4477 4478
 * @pin: pin name
 *
M
Mark Brown 已提交
4479
 * Disables input/output pin and its parents or children widgets.
4480
 *
4481 4482 4483
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
L
Liam Girdwood 已提交
4484 4485
int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
			     const char *pin)
4486
{
4487 4488 4489 4490 4491 4492 4493 4494 4495
	int ret;

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

	ret = snd_soc_dapm_set_pin(dapm, pin, 0);

	mutex_unlock(&dapm->card->dapm_mutex);

	return ret;
4496
}
4497
EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
4498

4499 4500 4501 4502 4503 4504 4505 4506 4507 4508 4509 4510 4511 4512 4513 4514 4515 4516 4517 4518 4519 4520 4521
/**
 * snd_soc_dapm_nc_pin_unlocked - permanently disable pin.
 * @dapm: DAPM context
 * @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.
 *
 * Requires external locking.
 *
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
int snd_soc_dapm_nc_pin_unlocked(struct snd_soc_dapm_context *dapm,
			       const char *pin)
{
	return snd_soc_dapm_set_pin(dapm, pin, 0);
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin_unlocked);

4522 4523
/**
 * snd_soc_dapm_nc_pin - permanently disable pin.
L
Liam Girdwood 已提交
4524
 * @dapm: DAPM context
4525 4526 4527 4528 4529 4530 4531 4532 4533 4534 4535
 * @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 已提交
4536
int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
4537
{
4538 4539 4540 4541 4542 4543 4544 4545 4546
	int ret;

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

	ret = snd_soc_dapm_set_pin(dapm, pin, 0);

	mutex_unlock(&dapm->card->dapm_mutex);

	return ret;
4547 4548 4549
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);

4550
/**
4551
 * snd_soc_dapm_get_pin_status - get audio pin status
L
Liam Girdwood 已提交
4552
 * @dapm: DAPM context
4553
 * @pin: audio signal pin endpoint (or start point)
4554
 *
4555
 * Get audio pin status - connected or disconnected.
4556
 *
4557
 * Returns 1 for connected otherwise 0.
4558
 */
L
Liam Girdwood 已提交
4559 4560
int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
				const char *pin)
4561
{
4562
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
4563

4564 4565
	if (w)
		return w->connected;
4566

4567 4568
	return 0;
}
4569
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
4570

4571 4572
/**
 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
L
Liam Girdwood 已提交
4573
 * @dapm: DAPM context
4574 4575 4576 4577 4578 4579 4580 4581
 * @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 已提交
4582 4583
int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
				const char *pin)
4584
{
4585
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
4586

4587
	if (!w) {
4588
		dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
4589
		return -EINVAL;
4590 4591
	}

4592 4593 4594
	w->ignore_suspend = 1;

	return 0;
4595 4596 4597
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);

4598 4599
/**
 * snd_soc_dapm_free - free dapm resources
4600
 * @dapm: DAPM context
4601 4602 4603
 *
 * Free all dapm widgets and resources.
 */
L
Liam Girdwood 已提交
4604
void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
4605
{
4606
	dapm_debugfs_cleanup(dapm);
L
Liam Girdwood 已提交
4607
	dapm_free_widgets(dapm);
4608
	list_del(&dapm->list);
4609 4610 4611
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_free);

4612
static void soc_dapm_shutdown_dapm(struct snd_soc_dapm_context *dapm)
M
Mark Brown 已提交
4613
{
4614
	struct snd_soc_card *card = dapm->card;
M
Mark Brown 已提交
4615 4616 4617 4618
	struct snd_soc_dapm_widget *w;
	LIST_HEAD(down_list);
	int powerdown = 0;

4619 4620
	mutex_lock(&card->dapm_mutex);

4621 4622 4623
	list_for_each_entry(w, &dapm->card->widgets, list) {
		if (w->dapm != dapm)
			continue;
M
Mark Brown 已提交
4624
		if (w->power) {
4625
			dapm_seq_insert(w, &down_list, false);
4626
			w->power = 0;
M
Mark Brown 已提交
4627 4628 4629 4630 4631 4632 4633 4634
			powerdown = 1;
		}
	}

	/* If there were no widgets to power down we're already in
	 * standby.
	 */
	if (powerdown) {
4635 4636 4637
		if (dapm->bias_level == SND_SOC_BIAS_ON)
			snd_soc_dapm_set_bias_level(dapm,
						    SND_SOC_BIAS_PREPARE);
4638
		dapm_seq_run(card, &down_list, 0, false);
4639 4640 4641
		if (dapm->bias_level == SND_SOC_BIAS_PREPARE)
			snd_soc_dapm_set_bias_level(dapm,
						    SND_SOC_BIAS_STANDBY);
M
Mark Brown 已提交
4642
	}
4643 4644

	mutex_unlock(&card->dapm_mutex);
4645 4646 4647 4648 4649 4650 4651
}

/*
 * snd_soc_dapm_shutdown - callback for system shutdown
 */
void snd_soc_dapm_shutdown(struct snd_soc_card *card)
{
4652
	struct snd_soc_dapm_context *dapm;
4653

4654
	list_for_each_entry(dapm, &card->dapm_list, list) {
4655 4656 4657 4658 4659 4660
		if (dapm != &card->dapm) {
			soc_dapm_shutdown_dapm(dapm);
			if (dapm->bias_level == SND_SOC_BIAS_STANDBY)
				snd_soc_dapm_set_bias_level(dapm,
							    SND_SOC_BIAS_OFF);
		}
L
Liam Girdwood 已提交
4661
	}
4662 4663 4664 4665 4666

	soc_dapm_shutdown_dapm(&card->dapm);
	if (card->dapm.bias_level == SND_SOC_BIAS_STANDBY)
		snd_soc_dapm_set_bias_level(&card->dapm,
					    SND_SOC_BIAS_OFF);
M
Mark Brown 已提交
4667 4668
}

4669
/* Module information */
4670
MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
4671 4672
MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
MODULE_LICENSE("GPL");