soc-dapm.c 118.2 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 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104
	[snd_soc_dapm_pre] = 1,
	[snd_soc_dapm_regulator_supply] = 2,
	[snd_soc_dapm_pinctrl] = 2,
	[snd_soc_dapm_clock_supply] = 2,
	[snd_soc_dapm_supply] = 3,
	[snd_soc_dapm_micbias] = 4,
	[snd_soc_dapm_vmid] = 4,
	[snd_soc_dapm_dai_link] = 3,
	[snd_soc_dapm_dai_in] = 5,
	[snd_soc_dapm_dai_out] = 5,
	[snd_soc_dapm_aif_in] = 5,
	[snd_soc_dapm_aif_out] = 5,
	[snd_soc_dapm_mic] = 6,
	[snd_soc_dapm_siggen] = 6,
	[snd_soc_dapm_input] = 6,
	[snd_soc_dapm_output] = 6,
	[snd_soc_dapm_mux] = 7,
	[snd_soc_dapm_demux] = 7,
	[snd_soc_dapm_dac] = 8,
	[snd_soc_dapm_switch] = 9,
	[snd_soc_dapm_mixer] = 9,
	[snd_soc_dapm_mixer_named_ctl] = 9,
	[snd_soc_dapm_pga] = 10,
	[snd_soc_dapm_buffer] = 10,
	[snd_soc_dapm_scheduler] = 10,
	[snd_soc_dapm_effect] = 10,
	[snd_soc_dapm_src] = 10,
	[snd_soc_dapm_asrc] = 10,
	[snd_soc_dapm_encoder] = 10,
	[snd_soc_dapm_decoder] = 10,
	[snd_soc_dapm_adc] = 11,
	[snd_soc_dapm_out_drv] = 12,
	[snd_soc_dapm_hp] = 12,
	[snd_soc_dapm_spk] = 12,
	[snd_soc_dapm_line] = 12,
	[snd_soc_dapm_sink] = 12,
	[snd_soc_dapm_kcontrol] = 13,
	[snd_soc_dapm_post] = 14,
105
};
106

107
static int dapm_down_seq[] = {
108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145
	[snd_soc_dapm_pre] = 1,
	[snd_soc_dapm_kcontrol] = 2,
	[snd_soc_dapm_adc] = 3,
	[snd_soc_dapm_hp] = 4,
	[snd_soc_dapm_spk] = 4,
	[snd_soc_dapm_line] = 4,
	[snd_soc_dapm_out_drv] = 4,
	[snd_soc_dapm_sink] = 4,
	[snd_soc_dapm_pga] = 5,
	[snd_soc_dapm_buffer] = 5,
	[snd_soc_dapm_scheduler] = 5,
	[snd_soc_dapm_effect] = 5,
	[snd_soc_dapm_src] = 5,
	[snd_soc_dapm_asrc] = 5,
	[snd_soc_dapm_encoder] = 5,
	[snd_soc_dapm_decoder] = 5,
	[snd_soc_dapm_switch] = 6,
	[snd_soc_dapm_mixer_named_ctl] = 6,
	[snd_soc_dapm_mixer] = 6,
	[snd_soc_dapm_dac] = 7,
	[snd_soc_dapm_mic] = 8,
	[snd_soc_dapm_siggen] = 8,
	[snd_soc_dapm_input] = 8,
	[snd_soc_dapm_output] = 8,
	[snd_soc_dapm_micbias] = 9,
	[snd_soc_dapm_vmid] = 9,
	[snd_soc_dapm_mux] = 10,
	[snd_soc_dapm_demux] = 10,
	[snd_soc_dapm_aif_in] = 11,
	[snd_soc_dapm_aif_out] = 11,
	[snd_soc_dapm_dai_in] = 11,
	[snd_soc_dapm_dai_out] = 11,
	[snd_soc_dapm_dai_link] = 12,
	[snd_soc_dapm_supply] = 13,
	[snd_soc_dapm_clock_supply] = 14,
	[snd_soc_dapm_pinctrl] = 14,
	[snd_soc_dapm_regulator_supply] = 14,
	[snd_soc_dapm_post] = 15,
146 147
};

148 149 150 151 152 153
static void dapm_assert_locked(struct snd_soc_dapm_context *dapm)
{
	if (dapm->card && dapm->card->instantiated)
		lockdep_assert_held(&dapm->card->dapm_mutex);
}

154
static void pop_wait(u32 pop_time)
155 156 157 158 159
{
	if (pop_time)
		schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
}

160
__printf(3, 4)
161
static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
162 163
{
	va_list args;
164
	char *buf;
165

166 167
	if (!pop_time)
		return;
168

169 170 171
	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
	if (buf == NULL)
		return;
172

173 174
	va_start(args, fmt);
	vsnprintf(buf, PAGE_SIZE, fmt, args);
175
	dev_info(dev, "%s", buf);
176
	va_end(args);
177 178

	kfree(buf);
179 180
}

181 182 183 184 185
static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w)
{
	return !list_empty(&w->dirty);
}

186
static void dapm_mark_dirty(struct snd_soc_dapm_widget *w, const char *reason)
187
{
188 189
	dapm_assert_locked(w->dapm);

190 191 192
	if (!dapm_dirty_widget(w)) {
		dev_vdbg(w->dapm->dev, "Marking %s dirty due to %s\n",
			 w->name, reason);
193
		list_add_tail(&w->dirty, &w->dapm->card->dapm_dirty);
194
	}
195 196
}

197
/*
198 199 200 201 202
 * 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.
203
 */
204 205
static __always_inline void dapm_widget_invalidate_paths(
	struct snd_soc_dapm_widget *w, enum snd_soc_dapm_direction dir)
206
{
207 208
	enum snd_soc_dapm_direction rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
	struct snd_soc_dapm_widget *node;
209 210 211 212 213
	struct snd_soc_dapm_path *p;
	LIST_HEAD(list);

	dapm_assert_locked(w->dapm);

214
	if (w->endpoints[dir] == -1)
215 216 217
		return;

	list_add_tail(&w->work_list, &list);
218
	w->endpoints[dir] = -1;
219 220

	list_for_each_entry(w, &list, work_list) {
221
		snd_soc_dapm_widget_for_each_path(w, dir, p) {
222 223
			if (p->is_supply || p->weak || !p->connect)
				continue;
224 225 226 227
			node = p->node[rdir];
			if (node->endpoints[dir] != -1) {
				node->endpoints[dir] = -1;
				list_add_tail(&node->work_list, &list);
228 229 230 231 232
			}
		}
	}
}

233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
/*
 * 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);
}

250 251 252 253 254 255 256 257 258 259 260 261 262 263
/*
 * 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)
{
264
	dapm_widget_invalidate_paths(w, SND_SOC_DAPM_DIR_OUT);
265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292
}

/*
 * 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.
	 */
293
	if (p->source->endpoints[SND_SOC_DAPM_DIR_IN] != 0)
294
		dapm_widget_invalidate_input_paths(p->sink);
295
	if (p->sink->endpoints[SND_SOC_DAPM_DIR_OUT] != 0)
296 297 298
		dapm_widget_invalidate_output_paths(p->source);
}

299
void dapm_mark_endpoints_dirty(struct snd_soc_card *card)
300 301 302 303 304 305
{
	struct snd_soc_dapm_widget *w;

	mutex_lock(&card->dapm_mutex);

	list_for_each_entry(w, &card->widgets, list) {
306
		if (w->is_ep) {
307
			dapm_mark_dirty(w, "Rechecking endpoints");
308
			if (w->is_ep & SND_SOC_DAPM_EP_SINK)
309
				dapm_widget_invalidate_output_paths(w);
310
			if (w->is_ep & SND_SOC_DAPM_EP_SOURCE)
311 312
				dapm_widget_invalidate_input_paths(w);
		}
313 314 315 316
	}

	mutex_unlock(&card->dapm_mutex);
}
317
EXPORT_SYMBOL_GPL(dapm_mark_endpoints_dirty);
318

319
/* create a new dapm widget */
320
static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
321 322
	const struct snd_soc_dapm_widget *_widget)
{
323 324 325 326 327 328 329 330 331 332 333 334
	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);
335 336
		if (!w->sname) {
			kfree(w);
337
			return NULL;
338
		}
339 340
	}
	return w;
341 342
}

343
struct dapm_kcontrol_data {
344
	unsigned int value;
345
	struct snd_soc_dapm_widget *widget;
346
	struct list_head paths;
347
	struct snd_soc_dapm_widget_list *wlist;
348 349 350
};

static int dapm_kcontrol_data_alloc(struct snd_soc_dapm_widget *widget,
351
	struct snd_kcontrol *kcontrol, const char *ctrl_name)
352 353
{
	struct dapm_kcontrol_data *data;
354
	struct soc_mixer_control *mc;
355
	struct soc_enum *e;
356 357
	const char *name;
	int ret;
358

359
	data = kzalloc(sizeof(*data), GFP_KERNEL);
360
	if (!data)
361 362
		return -ENOMEM;

363
	INIT_LIST_HEAD(&data->paths);
364

365 366 367 368 369 370
	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;

371 372 373 374 375
		if (mc->autodisable && snd_soc_volsw_is_stereo(mc))
			dev_warn(widget->dapm->dev,
				 "ASoC: Unsupported stereo autodisable control '%s'\n",
				 ctrl_name);

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

379
			name = kasprintf(GFP_KERNEL, "%s %s", ctrl_name,
380 381 382 383 384 385
					 "Autodisable");
			if (!name) {
				ret = -ENOMEM;
				goto err_data;
			}

386 387 388 389 390 391 392 393 394 395
			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;
396
			template.name = name;
397

398 399
			data->value = template.on_val;

400 401
			data->widget =
				snd_soc_dapm_new_control_unlocked(widget->dapm,
402
				&template);
403
			kfree(name);
404 405 406 407
			if (IS_ERR(data->widget)) {
				ret = PTR_ERR(data->widget);
				goto err_data;
			}
408 409
		}
		break;
410
	case snd_soc_dapm_demux:
411 412 413 414 415 416
	case snd_soc_dapm_mux:
		e = (struct soc_enum *)kcontrol->private_value;

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

417
			name = kasprintf(GFP_KERNEL, "%s %s", ctrl_name,
418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434
					 "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;

435 436
			data->widget = snd_soc_dapm_new_control_unlocked(
						widget->dapm, &template);
437
			kfree(name);
438 439 440 441
			if (IS_ERR(data->widget)) {
				ret = PTR_ERR(data->widget);
				goto err_data;
			}
442 443 444 445 446

			snd_soc_dapm_add_path(widget->dapm, data->widget,
					      widget, NULL, NULL);
		}
		break;
447 448 449 450
	default:
		break;
	}

451 452 453
	kcontrol->private_data = data;

	return 0;
454 455 456 457

err_data:
	kfree(data);
	return ret;
458 459 460 461 462
}

static void dapm_kcontrol_free(struct snd_kcontrol *kctl)
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kctl);
463 464

	list_del(&data->paths);
465
	kfree(data->wlist);
466 467 468 469 470 471 472 473
	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);

474
	return data->wlist;
475 476 477 478 479 480
}

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);
481 482
	struct snd_soc_dapm_widget_list *new_wlist;
	unsigned int n;
483

484 485 486 487 488 489 490 491
	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)
492 493
		return -ENOMEM;

494 495
	new_wlist->widgets[n - 1] = widget;
	new_wlist->num_widgets = n;
496

497
	data->wlist = new_wlist;
498 499 500 501

	return 0;
}

502 503 504 505 506 507
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);
508 509 510 511 512 513 514 515 516 517
}

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;
518 519 520 521 522 523 524 525 526 527 528 529 530 531
}

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)

532
unsigned int dapm_kcontrol_get_value(const struct snd_kcontrol *kcontrol)
533 534 535 536 537
{
	struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);

	return data->value;
}
538
EXPORT_SYMBOL_GPL(dapm_kcontrol_get_value);
539 540 541 542 543 544 545 546 547

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;

548 549 550
	if (data->widget)
		data->widget->on_val = value;

551 552 553 554 555
	data->value = value;

	return true;
}

556 557 558 559 560 561 562 563 564 565 566 567
/**
 * 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);

568 569 570 571 572 573 574 575 576 577 578 579 580 581 582
/**
 * 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);

583 584 585 586
static void dapm_reset(struct snd_soc_card *card)
{
	struct snd_soc_dapm_widget *w;

587 588
	lockdep_assert_held(&card->dapm_mutex);

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

	list_for_each_entry(w, &card->widgets, list) {
592
		w->new_power = w->power;
593 594 595 596
		w->power_checked = false;
	}
}

597 598 599 600 601 602 603
static const char *soc_dapm_prefix(struct snd_soc_dapm_context *dapm)
{
	if (!dapm->component)
		return NULL;
	return dapm->component->name_prefix;
}

604
static int soc_dapm_read(struct snd_soc_dapm_context *dapm, int reg,
605
	unsigned int *value)
606
{
607
	if (!dapm->component)
608
		return -EIO;
609
	return snd_soc_component_read(dapm->component, reg, value);
610 611
}

612
static int soc_dapm_update_bits(struct snd_soc_dapm_context *dapm,
613
	int reg, unsigned int mask, unsigned int value)
614
{
615
	if (!dapm->component)
616
		return -EIO;
M
Mark Brown 已提交
617 618
	return snd_soc_component_update_bits(dapm->component, reg,
					     mask, value);
619 620
}

621 622 623 624 625 626 627 628
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);
}

629 630
static void soc_dapm_async_complete(struct snd_soc_dapm_context *dapm)
{
631 632
	if (dapm->component)
		snd_soc_component_async_complete(dapm->component);
633 634
}

635 636 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 662 663
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;
}

664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688
/**
 * 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);

689 690 691
	if (ret == 0)
		dapm->bias_level = level;

692 693 694 695
	return ret;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_force_bias_level);

696 697
/**
 * snd_soc_dapm_set_bias_level - set the bias level for the system
698
 * @dapm: DAPM context
699 700 701 702 703 704
 * @level: level to configure
 *
 * Configure the bias (power) levels for the SoC audio device.
 *
 * Returns 0 for success else error.
 */
705
static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
L
Liam Girdwood 已提交
706
				       enum snd_soc_bias_level level)
707
{
708
	struct snd_soc_card *card = dapm->card;
709 710
	int ret = 0;

M
Mark Brown 已提交
711 712
	trace_snd_soc_bias_level_start(card, level);

713
	if (card && card->set_bias_level)
714
		ret = card->set_bias_level(card, dapm, level);
715 716 717
	if (ret != 0)
		goto out;

718 719
	if (!card || dapm != &card->dapm)
		ret = snd_soc_dapm_force_bias_level(dapm, level);
720

721 722 723 724
	if (ret != 0)
		goto out;

	if (card && card->set_bias_level_post)
725
		ret = card->set_bias_level_post(card, dapm, level);
726
out:
M
Mark Brown 已提交
727 728
	trace_snd_soc_bias_level_done(card, level);

729 730 731
	return ret;
}

M
Mark Brown 已提交
732
/* connect mux widget to its interconnecting audio paths */
L
Liam Girdwood 已提交
733
static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
734 735
	struct snd_soc_dapm_path *path, const char *control_name,
	struct snd_soc_dapm_widget *w)
736
{
737
	const struct snd_kcontrol_new *kcontrol = &w->kcontrol_news[0];
738
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
739
	unsigned int val, item;
740
	int i;
741

742
	if (e->reg != SND_SOC_NOPM) {
743
		soc_dapm_read(dapm, e->reg, &val);
744 745 746
		val = (val >> e->shift_l) & e->mask;
		item = snd_soc_enum_val_to_item(e, val);
	} else {
747 748 749 750 751 752
		/* 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.
		 */
753
		item = 0;
754
	}
P
Peter Ujfalusi 已提交
755

756 757 758 759 760 761 762
	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;
763 764 765

}

766
/* set up initial codec paths */
767 768
static void dapm_set_mixer_path_status(struct snd_soc_dapm_path *p, int i,
				       int nth_path)
769 770
{
	struct soc_mixer_control *mc = (struct soc_mixer_control *)
771
		p->sink->kcontrol_news[i].private_value;
772 773 774 775 776 777 778 779
	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) {
780
		soc_dapm_read(p->sink->dapm, reg, &val);
781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799
		/*
		 * 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;
		}
800 801 802 803 804 805 806 807
		if (invert)
			val = max - val;
		p->connect = !!val;
	} else {
		p->connect = 0;
	}
}

M
Mark Brown 已提交
808
/* connect mixer widget to its interconnecting audio paths */
L
Liam Girdwood 已提交
809
static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
810 811
	struct snd_soc_dapm_path *path, const char *control_name)
{
812
	int i, nth_path = 0;
813 814

	/* search for mixer kcontrol */
815 816 817
	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;
818
			dapm_set_mixer_path_status(path, i, nth_path++);
819 820 821 822 823 824
			return 0;
		}
	}
	return -ENODEV;
}

825
static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
826
	struct snd_soc_dapm_widget *kcontrolw,
827 828 829 830 831 832 833 834 835
	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) {
836 837
		if (w == kcontrolw || w->dapm != kcontrolw->dapm)
			continue;
838 839 840 841 842 843 844 845 846 847 848 849
		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;
}

850 851 852 853
/*
 * 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
 */
854
static int dapm_create_or_share_kcontrol(struct snd_soc_dapm_widget *w,
855
	int kci)
856
{
857
	struct snd_soc_dapm_context *dapm = w->dapm;
858
	struct snd_card *card = dapm->card->snd_card;
859
	const char *prefix;
860 861 862 863
	size_t prefix_len;
	int shared;
	struct snd_kcontrol *kcontrol;
	bool wname_in_long_name, kcname_in_long_name;
D
Daniel Mack 已提交
864
	char *long_name = NULL;
865
	const char *name;
D
Daniel Mack 已提交
866
	int ret = 0;
867

868
	prefix = soc_dapm_prefix(dapm);
869 870 871 872 873
	if (prefix)
		prefix_len = strlen(prefix) + 1;
	else
		prefix_len = 0;

874 875
	shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[kci],
					 &kcontrol);
876

877 878 879 880 881 882 883 884
	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:
885
			case snd_soc_dapm_pga:
886
			case snd_soc_dapm_out_drv:
887 888 889 890 891 892 893
				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;
894
			case snd_soc_dapm_demux:
895 896 897 898 899 900
			case snd_soc_dapm_mux:
				wname_in_long_name = true;
				kcname_in_long_name = false;
				break;
			default:
				return -EINVAL;
901
			}
902 903 904 905 906 907 908 909
		}

		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.
910
			 */
911
			long_name = kasprintf(GFP_KERNEL, "%s %s",
912 913
				 w->name + prefix_len,
				 w->kcontrol_news[kci].name);
914
			if (long_name == NULL)
915
				return -ENOMEM;
916 917 918 919 920 921 922 923 924

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

926
		kcontrol = snd_soc_cnew(&w->kcontrol_news[kci], NULL, name,
927
					prefix);
D
Daniel Mack 已提交
928 929 930 931 932
		if (!kcontrol) {
			ret = -ENOMEM;
			goto exit_free;
		}

933
		kcontrol->private_free = dapm_kcontrol_free;
934

935
		ret = dapm_kcontrol_data_alloc(w, kcontrol, name);
936 937
		if (ret) {
			snd_ctl_free_one(kcontrol);
D
Daniel Mack 已提交
938
			goto exit_free;
939 940
		}

941 942 943 944 945
		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 已提交
946
			goto exit_free;
947 948
		}
	}
949

950
	ret = dapm_kcontrol_add_widget(kcontrol, w);
D
Daniel Mack 已提交
951 952
	if (ret == 0)
		w->kcontrols[kci] = kcontrol;
953

D
Daniel Mack 已提交
954 955
exit_free:
	kfree(long_name);
956

D
Daniel Mack 已提交
957
	return ret;
958
}
959

960 961 962 963 964
/* 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;
965
	struct dapm_kcontrol_data *data;
966 967 968 969

	/* add kcontrol */
	for (i = 0; i < w->num_kcontrols; i++) {
		/* match name */
970
		snd_soc_dapm_widget_for_each_source_path(w, path) {
971 972 973 974
			/* mixer/mux paths name must match control name */
			if (path->name != (char *)w->kcontrol_news[i].name)
				continue;

975
			if (!w->kcontrols[i]) {
976
				ret = dapm_create_or_share_kcontrol(w, i);
977 978
				if (ret < 0)
					return ret;
979
			}
980

981
			dapm_kcontrol_add_path(w->kcontrols[i], path);
982 983 984 985 986 987 988

			data = snd_kcontrol_chip(w->kcontrols[i]);
			if (data->widget)
				snd_soc_dapm_add_path(data->widget->dapm,
						      data->widget,
						      path->source,
						      NULL, NULL);
989 990
		}
	}
991 992

	return 0;
993 994 995
}

/* create new dapm mux control */
996
static int dapm_new_mux(struct snd_soc_dapm_widget *w)
997
{
998
	struct snd_soc_dapm_context *dapm = w->dapm;
999
	enum snd_soc_dapm_direction dir;
1000
	struct snd_soc_dapm_path *path;
1001
	const char *type;
1002
	int ret;
1003

1004 1005
	switch (w->id) {
	case snd_soc_dapm_mux:
1006
		dir = SND_SOC_DAPM_DIR_OUT;
1007 1008 1009
		type = "mux";
		break;
	case snd_soc_dapm_demux:
1010
		dir = SND_SOC_DAPM_DIR_IN;
1011 1012 1013 1014 1015 1016
		type = "demux";
		break;
	default:
		return -EINVAL;
	}

1017 1018
	if (w->num_kcontrols != 1) {
		dev_err(dapm->dev,
1019
			"ASoC: %s %s has incorrect number of controls\n", type,
1020
			w->name);
1021 1022 1023
		return -EINVAL;
	}

1024
	if (list_empty(&w->edges[dir])) {
1025
		dev_err(dapm->dev, "ASoC: %s %s has no paths\n", type, w->name);
1026
		return -EINVAL;
1027
	}
L
Liam Girdwood 已提交
1028

1029
	ret = dapm_create_or_share_kcontrol(w, 0);
1030 1031
	if (ret < 0)
		return ret;
1032

1033 1034 1035
	snd_soc_dapm_widget_for_each_path(w, dir, path) {
		if (path->name)
			dapm_kcontrol_add_path(w->kcontrols[0], path);
1036
	}
1037

1038
	return 0;
1039 1040 1041
}

/* create new dapm volume control */
1042
static int dapm_new_pga(struct snd_soc_dapm_widget *w)
1043
{
1044 1045 1046 1047 1048 1049 1050
	int i, ret;

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

1052
	return 0;
1053 1054
}

1055 1056 1057 1058 1059 1060 1061
/* 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;
1062
	struct snd_soc_pcm_runtime *rtd = w->priv;
1063 1064

	/* create control for links with > 1 config */
1065
	if (rtd->dai_link->num_params <= 1)
1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085
		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;
}

1086 1087 1088 1089 1090 1091
/* 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)
{
1092
	int level = snd_power_get_state(widget->dapm->card->snd_card);
1093

1094
	switch (level) {
1095 1096
	case SNDRV_CTL_POWER_D3hot:
	case SNDRV_CTL_POWER_D3cold:
1097
		if (widget->ignore_suspend)
1098
			dev_dbg(widget->dapm->dev, "ASoC: %s ignoring suspend\n",
1099
				widget->name);
1100
		return widget->ignore_suspend;
1101 1102 1103 1104 1105
	default:
		return 1;
	}
}

1106 1107
static int dapm_widget_list_create(struct snd_soc_dapm_widget_list **list,
	struct list_head *widgets)
1108
{
1109 1110 1111 1112
	struct snd_soc_dapm_widget *w;
	struct list_head *it;
	unsigned int size = 0;
	unsigned int i = 0;
1113

1114 1115
	list_for_each(it, widgets)
		size++;
1116

1117
	*list = kzalloc(struct_size(*list, widgets, size), GFP_KERNEL);
1118
	if (*list == NULL)
1119 1120
		return -ENOMEM;

1121 1122
	list_for_each_entry(w, widgets, work_list)
		(*list)->widgets[i++] = w;
1123

1124 1125 1126
	(*list)->num_widgets = i;

	return 0;
1127 1128
}

1129
/*
1130 1131 1132 1133 1134
 * 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.
1135
 */
1136 1137
static __always_inline int is_connected_ep(struct snd_soc_dapm_widget *widget,
	struct list_head *list, enum snd_soc_dapm_direction dir,
1138 1139 1140 1141 1142
	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))
1143
{
1144
	enum snd_soc_dapm_direction rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
1145 1146 1147
	struct snd_soc_dapm_path *path;
	int con = 0;

1148 1149
	if (widget->endpoints[dir] >= 0)
		return widget->endpoints[dir];
1150

1151 1152
	DAPM_UPDATE_STAT(widget, path_checks);

1153 1154 1155 1156
	/* do we need to add this widget to the list ? */
	if (list)
		list_add_tail(&widget->work_list, list);

1157 1158 1159 1160
	if (custom_stop_condition && custom_stop_condition(widget, dir)) {
		widget->endpoints[dir] = 1;
		return widget->endpoints[dir];
	}
1161

1162 1163 1164
	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];
1165 1166
	}

1167
	snd_soc_dapm_widget_for_each_path(widget, rdir, path) {
1168 1169
		DAPM_UPDATE_STAT(widget, neighbour_checks);

1170
		if (path->weak || path->is_supply)
1171 1172
			continue;

M
Mark Brown 已提交
1173 1174 1175
		if (path->walking)
			return 1;

1176
		trace_snd_soc_dapm_path(widget, dir, path);
1177

1178
		if (path->connect) {
M
Mark Brown 已提交
1179
			path->walking = 1;
1180
			con += fn(path->node[dir], list, custom_stop_condition);
M
Mark Brown 已提交
1181
			path->walking = 0;
1182 1183 1184
		}
	}

1185
	widget->endpoints[dir] = con;
1186

1187 1188 1189
	return con;
}

1190 1191 1192
/*
 * Recursively check for a completed path to an active or physically connected
 * output widget. Returns number of complete paths.
1193 1194 1195 1196 1197
 *
 * 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.
1198 1199
 */
static int is_connected_output_ep(struct snd_soc_dapm_widget *widget,
1200 1201 1202
	struct list_head *list,
	bool (*custom_stop_condition)(struct snd_soc_dapm_widget *i,
				      enum snd_soc_dapm_direction))
1203 1204
{
	return is_connected_ep(widget, list, SND_SOC_DAPM_DIR_OUT,
1205
			is_connected_output_ep, custom_stop_condition);
1206 1207
}

1208 1209 1210
/*
 * Recursively check for a completed path to an active or physically connected
 * input widget. Returns number of complete paths.
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
static int is_connected_input_ep(struct snd_soc_dapm_widget *widget,
1218 1219 1220
	struct list_head *list,
	bool (*custom_stop_condition)(struct snd_soc_dapm_widget *i,
				      enum snd_soc_dapm_direction))
1221
{
1222
	return is_connected_ep(widget, list, SND_SOC_DAPM_DIR_IN,
1223
			is_connected_input_ep, custom_stop_condition);
1224 1225
}

1226 1227 1228 1229 1230
/**
 * 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.
1231 1232
 * @custom_stop_condition: (optional) a function meant to stop the widget graph
 *                         walk based on custom logic.
1233
 *
1234
 * Queries DAPM graph as to whether a valid audio stream path exists for
1235 1236 1237
 * the initial stream specified by name. This takes into account
 * current mixer and mux kcontrol settings. Creates list of valid widgets.
 *
1238 1239 1240 1241 1242
 * 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.
 *
1243 1244 1245
 * Returns the number of valid paths or negative error.
 */
int snd_soc_dapm_dai_get_connected_widgets(struct snd_soc_dai *dai, int stream,
1246 1247 1248
	struct snd_soc_dapm_widget_list **list,
	bool (*custom_stop_condition)(struct snd_soc_dapm_widget *,
				      enum snd_soc_dapm_direction))
1249
{
1250
	struct snd_soc_card *card = dai->component->card;
1251
	struct snd_soc_dapm_widget *w;
1252
	LIST_HEAD(widgets);
1253
	int paths;
1254
	int ret;
1255 1256

	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
1257 1258 1259 1260 1261 1262

	/*
	 * 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) {
1263 1264
		w->endpoints[SND_SOC_DAPM_DIR_IN] = -1;
		w->endpoints[SND_SOC_DAPM_DIR_OUT] = -1;
1265
	}
1266

1267
	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
1268 1269
		paths = is_connected_output_ep(dai->playback_widget, &widgets,
				custom_stop_condition);
1270
	else
1271 1272
		paths = is_connected_input_ep(dai->capture_widget, &widgets,
				custom_stop_condition);
1273 1274 1275 1276 1277 1278

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

	ret = dapm_widget_list_create(list, &widgets);
	if (ret)
1279
		paths = ret;
1280 1281 1282 1283 1284 1285 1286

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

	return paths;
}

1287 1288 1289 1290 1291 1292
/*
 * Handler for regulator supply widget.
 */
int dapm_regulator_event(struct snd_soc_dapm_widget *w,
		   struct snd_kcontrol *kcontrol, int event)
{
1293 1294
	int ret;

1295 1296
	soc_dapm_async_complete(w->dapm);

1297
	if (SND_SOC_DAPM_EVENT_ON(event)) {
1298
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
1299
			ret = regulator_allow_bypass(w->regulator, false);
1300 1301
			if (ret != 0)
				dev_warn(w->dapm->dev,
1302
					 "ASoC: Failed to unbypass %s: %d\n",
1303 1304 1305
					 w->name, ret);
		}

1306
		return regulator_enable(w->regulator);
1307
	} else {
1308
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
1309
			ret = regulator_allow_bypass(w->regulator, true);
1310 1311
			if (ret != 0)
				dev_warn(w->dapm->dev,
1312
					 "ASoC: Failed to bypass %s: %d\n",
1313 1314 1315
					 w->name, ret);
		}

1316
		return regulator_disable_deferred(w->regulator, w->shift);
1317
	}
1318 1319 1320
}
EXPORT_SYMBOL_GPL(dapm_regulator_event);

1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345
/*
 * 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);

1346 1347 1348 1349 1350 1351 1352 1353 1354
/*
 * 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;

1355 1356
	soc_dapm_async_complete(w->dapm);

1357
	if (SND_SOC_DAPM_EVENT_ON(event)) {
1358
		return clk_prepare_enable(w->clk);
1359
	} else {
1360
		clk_disable_unprepare(w->clk);
1361 1362
		return 0;
	}
1363

1364
	return 0;
1365 1366 1367
}
EXPORT_SYMBOL_GPL(dapm_clock_event);

1368 1369
static int dapm_widget_power_check(struct snd_soc_dapm_widget *w)
{
1370 1371 1372
	if (w->power_checked)
		return w->new_power;

1373
	if (w->force)
1374
		w->new_power = 1;
1375
	else
1376 1377 1378 1379 1380
		w->new_power = w->power_check(w);

	w->power_checked = true;

	return w->new_power;
1381 1382
}

1383
/* Generic check to see if a widget should be powered. */
1384 1385 1386 1387
static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
{
	int in, out;

1388 1389
	DAPM_UPDATE_STAT(w, power_checks);

1390 1391
	in = is_connected_input_ep(w, NULL, NULL);
	out = is_connected_output_ep(w, NULL, NULL);
1392 1393 1394
	return out != 0 && in != 0;
}

1395 1396 1397 1398 1399
/* 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;

1400 1401
	DAPM_UPDATE_STAT(w, power_checks);

1402
	/* Check if one of our outputs is connected */
1403
	snd_soc_dapm_widget_for_each_sink_path(w, path) {
1404 1405
		DAPM_UPDATE_STAT(w, neighbour_checks);

1406 1407 1408
		if (path->weak)
			continue;

1409 1410 1411 1412
		if (path->connected &&
		    !path->connected(path->source, path->sink))
			continue;

1413 1414
		if (dapm_widget_power_check(path->sink))
			return 1;
1415 1416
	}

1417
	return 0;
1418 1419
}

1420 1421
static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w)
{
1422
	return w->connected;
1423 1424
}

1425 1426
static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
			    struct snd_soc_dapm_widget *b,
1427
			    bool power_up)
1428
{
1429 1430
	int *sort;

1431 1432 1433
	BUILD_BUG_ON(ARRAY_SIZE(dapm_up_seq) != SND_SOC_DAPM_TYPE_COUNT);
	BUILD_BUG_ON(ARRAY_SIZE(dapm_down_seq) != SND_SOC_DAPM_TYPE_COUNT);

1434 1435 1436 1437 1438
	if (power_up)
		sort = dapm_up_seq;
	else
		sort = dapm_down_seq;

1439 1440 1441
	WARN_ONCE(sort[a->id] == 0, "offset a->id %d not initialized\n", a->id);
	WARN_ONCE(sort[b->id] == 0, "offset b->id %d not initialized\n", b->id);

1442 1443
	if (sort[a->id] != sort[b->id])
		return sort[a->id] - sort[b->id];
1444 1445 1446 1447 1448 1449
	if (a->subseq != b->subseq) {
		if (power_up)
			return a->subseq - b->subseq;
		else
			return b->subseq - a->subseq;
	}
1450 1451
	if (a->reg != b->reg)
		return a->reg - b->reg;
1452 1453
	if (a->dapm != b->dapm)
		return (unsigned long)a->dapm - (unsigned long)b->dapm;
1454

1455 1456
	return 0;
}
1457

1458 1459 1460
/* 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,
1461
			    bool power_up)
1462 1463 1464 1465
{
	struct snd_soc_dapm_widget *w;

	list_for_each_entry(w, list, power_list)
1466
		if (dapm_seq_compare(new_widget, w, power_up) < 0) {
1467 1468 1469 1470 1471 1472 1473
			list_add_tail(&new_widget->power_list, &w->power_list);
			return;
		}

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

1474
static void dapm_seq_check_event(struct snd_soc_card *card,
1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496
				 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;
1497 1498 1499 1500 1501 1502 1503 1504
	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;
1505
	default:
T
Takashi Iwai 已提交
1506
		WARN(1, "Unknown event %d\n", event);
1507 1508 1509
		return;
	}

1510
	if (w->new_power != power)
1511 1512 1513
		return;

	if (w->event && (w->event_flags & event)) {
1514
		pop_dbg(w->dapm->dev, card->pop_time, "pop test : %s %s\n",
1515
			w->name, ev_name);
1516
		soc_dapm_async_complete(w->dapm);
M
Mark Brown 已提交
1517
		trace_snd_soc_dapm_widget_event_start(w, event);
1518
		ret = w->event(w, NULL, event);
M
Mark Brown 已提交
1519
		trace_snd_soc_dapm_widget_event_done(w, event);
1520
		if (ret < 0)
1521
			dev_err(w->dapm->dev, "ASoC: %s: %s event failed: %d\n",
1522 1523 1524 1525
			       ev_name, w->name, ret);
	}
}

1526
/* Apply the coalesced changes from a DAPM sequence */
1527
static void dapm_seq_run_coalesced(struct snd_soc_card *card,
1528
				   struct list_head *pending)
1529
{
1530
	struct snd_soc_dapm_context *dapm;
1531
	struct snd_soc_dapm_widget *w;
1532
	int reg;
1533 1534 1535
	unsigned int value = 0;
	unsigned int mask = 0;

1536 1537 1538
	w = list_first_entry(pending, struct snd_soc_dapm_widget, power_list);
	reg = w->reg;
	dapm = w->dapm;
1539 1540

	list_for_each_entry(w, pending, power_list) {
1541
		WARN_ON(reg != w->reg || dapm != w->dapm);
1542
		w->power = w->new_power;
1543

1544 1545 1546
		mask |= w->mask << w->shift;
		if (w->power)
			value |= w->on_val << w->shift;
1547
		else
1548
			value |= w->off_val << w->shift;
1549

1550
		pop_dbg(dapm->dev, card->pop_time,
1551 1552
			"pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
			w->name, reg, value, mask);
1553

1554
		/* Check for events */
1555 1556
		dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMU);
		dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMD);
1557 1558 1559
	}

	if (reg >= 0) {
1560 1561 1562 1563
		/* Any widget will do, they should all be updating the
		 * same register.
		 */

1564
		pop_dbg(dapm->dev, card->pop_time,
1565
			"pop test : Applying 0x%x/0x%x to %x in %dms\n",
1566 1567
			value, mask, reg, card->pop_time);
		pop_wait(card->pop_time);
1568
		soc_dapm_update_bits(dapm, reg, mask, value);
1569 1570
	}

1571
	list_for_each_entry(w, pending, power_list) {
1572 1573
		dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMU);
		dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMD);
1574
	}
1575
}
1576

1577 1578 1579 1580 1581 1582 1583 1584
/* 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.
 */
1585 1586
static void dapm_seq_run(struct snd_soc_card *card,
	struct list_head *list, int event, bool power_up)
1587 1588
{
	struct snd_soc_dapm_widget *w, *n;
1589
	struct snd_soc_dapm_context *d;
1590 1591
	LIST_HEAD(pending);
	int cur_sort = -1;
1592
	int cur_subseq = -1;
1593
	int cur_reg = SND_SOC_NOPM;
1594
	struct snd_soc_dapm_context *cur_dapm = NULL;
1595
	int ret, i;
1596 1597 1598 1599 1600 1601
	int *sort;

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

1603 1604 1605 1606
	list_for_each_entry_safe(w, n, list, power_list) {
		ret = 0;

		/* Do we need to apply any queued changes? */
1607
		if (sort[w->id] != cur_sort || w->reg != cur_reg ||
1608
		    w->dapm != cur_dapm || w->subseq != cur_subseq) {
1609
			if (!list_empty(&pending))
1610
				dapm_seq_run_coalesced(card, &pending);
1611

1612 1613 1614 1615
			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,
1616 1617
								       i,
								       cur_subseq);
1618 1619
			}

1620 1621 1622
			if (cur_dapm && w->dapm != cur_dapm)
				soc_dapm_async_complete(cur_dapm);

1623 1624
			INIT_LIST_HEAD(&pending);
			cur_sort = -1;
1625
			cur_subseq = INT_MIN;
1626
			cur_reg = SND_SOC_NOPM;
1627
			cur_dapm = NULL;
1628 1629
		}

1630 1631 1632
		switch (w->id) {
		case snd_soc_dapm_pre:
			if (!w->event)
1633 1634
				list_for_each_entry_safe_continue(w, n, list,
								  power_list);
1635

1636
			if (event == SND_SOC_DAPM_STREAM_START)
1637 1638
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_PRE_PMU);
1639
			else if (event == SND_SOC_DAPM_STREAM_STOP)
1640 1641 1642 1643 1644 1645
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_PRE_PMD);
			break;

		case snd_soc_dapm_post:
			if (!w->event)
1646 1647
				list_for_each_entry_safe_continue(w, n, list,
								  power_list);
1648

1649
			if (event == SND_SOC_DAPM_STREAM_START)
1650 1651
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_POST_PMU);
1652
			else if (event == SND_SOC_DAPM_STREAM_STOP)
1653 1654 1655 1656
				ret = w->event(w,
					       NULL, SND_SOC_DAPM_POST_PMD);
			break;

1657
		default:
1658 1659
			/* Queue it up for application */
			cur_sort = sort[w->id];
1660
			cur_subseq = w->subseq;
1661
			cur_reg = w->reg;
1662
			cur_dapm = w->dapm;
1663 1664
			list_move(&w->power_list, &pending);
			break;
1665
		}
1666 1667

		if (ret < 0)
1668
			dev_err(w->dapm->dev,
1669
				"ASoC: Failed to apply widget power: %d\n", ret);
1670
	}
1671 1672

	if (!list_empty(&pending))
1673
		dapm_seq_run_coalesced(card, &pending);
1674 1675 1676 1677 1678

	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,
1679
						       i, cur_subseq);
1680
	}
1681 1682 1683 1684

	list_for_each_entry(d, &card->dapm_list, list) {
		soc_dapm_async_complete(d);
	}
1685 1686
}

1687
static void dapm_widget_update(struct snd_soc_card *card)
1688
{
1689
	struct snd_soc_dapm_update *update = card->update;
1690 1691 1692
	struct snd_soc_dapm_widget_list *wlist;
	struct snd_soc_dapm_widget *w = NULL;
	unsigned int wi;
1693 1694
	int ret;

1695
	if (!update || !dapm_kcontrol_is_powered(update->kcontrol))
1696 1697
		return;

1698
	wlist = dapm_kcontrol_get_wlist(update->kcontrol);
1699

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

1711 1712 1713
	if (!w)
		return;

1714 1715
	ret = soc_dapm_update_bits(w->dapm, update->reg, update->mask,
		update->val);
1716
	if (ret < 0)
1717
		dev_err(w->dapm->dev, "ASoC: %s DAPM update failed: %d\n",
1718
			w->name, ret);
1719

1720 1721 1722 1723 1724 1725 1726 1727 1728
	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);
	}

1729 1730 1731 1732 1733 1734
	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)
1735
				dev_err(w->dapm->dev, "ASoC: %s DAPM post-event failed: %d\n",
1736 1737
					   w->name, ret);
		}
1738 1739 1740
	}
}

1741 1742 1743 1744 1745 1746 1747 1748
/* 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;

1749
	/* If we're off and we're not supposed to go into STANDBY */
1750 1751
	if (d->bias_level == SND_SOC_BIAS_OFF &&
	    d->target_bias_level != SND_SOC_BIAS_OFF) {
1752 1753 1754
		if (d->dev)
			pm_runtime_get_sync(d->dev);

1755 1756 1757
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
		if (ret != 0)
			dev_err(d->dev,
1758
				"ASoC: Failed to turn on bias: %d\n", ret);
1759 1760
	}

1761 1762 1763 1764 1765
	/* 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)) {
1766 1767 1768
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
		if (ret != 0)
			dev_err(d->dev,
1769
				"ASoC: Failed to prepare bias: %d\n", ret);
1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781
	}
}

/* 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 */
1782 1783 1784
	if (d->bias_level == SND_SOC_BIAS_PREPARE &&
	    (d->target_bias_level == SND_SOC_BIAS_STANDBY ||
	     d->target_bias_level == SND_SOC_BIAS_OFF)) {
1785 1786
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
		if (ret != 0)
1787
			dev_err(d->dev, "ASoC: Failed to apply standby bias: %d\n",
1788 1789
				ret);
	}
1790

1791
	/* If we're in standby and can support bias off then do that */
1792 1793
	if (d->bias_level == SND_SOC_BIAS_STANDBY &&
	    d->target_bias_level == SND_SOC_BIAS_OFF) {
1794 1795
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
		if (ret != 0)
1796 1797
			dev_err(d->dev, "ASoC: Failed to turn off bias: %d\n",
				ret);
1798 1799

		if (d->dev)
1800
			pm_runtime_put(d->dev);
1801 1802 1803
	}

	/* If we just powered up then move to active bias */
1804 1805
	if (d->bias_level == SND_SOC_BIAS_PREPARE &&
	    d->target_bias_level == SND_SOC_BIAS_ON) {
1806 1807
		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
		if (ret != 0)
1808
			dev_err(d->dev, "ASoC: Failed to apply active bias: %d\n",
1809 1810 1811
				ret);
	}
}
1812

1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824
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)
1825
		dapm_mark_dirty(peer, "peer state change");
1826 1827
}

1828 1829 1830 1831
static void dapm_widget_set_power(struct snd_soc_dapm_widget *w, bool power,
				  struct list_head *up_list,
				  struct list_head *down_list)
{
1832 1833
	struct snd_soc_dapm_path *path;

1834 1835 1836 1837 1838
	if (w->power == power)
		return;

	trace_snd_soc_dapm_widget_power(w, power);

1839
	/* If we changed our power state perhaps our neigbours changed
1840
	 * also.
1841
	 */
1842
	snd_soc_dapm_widget_for_each_source_path(w, path)
1843 1844
		dapm_widget_set_peer_power(path->source, power, path->connect);

1845 1846
	/* Supplies can't affect their outputs, only their inputs */
	if (!w->is_supply) {
1847
		snd_soc_dapm_widget_for_each_sink_path(w, path)
1848 1849
			dapm_widget_set_peer_power(path->sink, power,
						   path->connect);
1850 1851
	}

1852 1853 1854 1855 1856 1857
	if (power)
		dapm_seq_insert(w, up_list, true);
	else
		dapm_seq_insert(w, down_list, false);
}

1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872
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:
1873
		power = dapm_widget_power_check(w);
1874

1875
		dapm_widget_set_power(w, power, up_list, down_list);
1876 1877 1878 1879
		break;
	}
}

1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895
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;
}

1896 1897 1898 1899 1900
/*
 * 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.
1901
 *  o Input pin to ADC.
1902 1903 1904
 *  o Input pin to Output pin (bypass, sidetone)
 *  o DAC to ADC (loopback).
 */
1905
static int dapm_power_widgets(struct snd_soc_card *card, int event)
1906 1907
{
	struct snd_soc_dapm_widget *w;
1908
	struct snd_soc_dapm_context *d;
1909 1910
	LIST_HEAD(up_list);
	LIST_HEAD(down_list);
1911
	ASYNC_DOMAIN_EXCLUSIVE(async_domain);
1912
	enum snd_soc_bias_level bias;
1913

1914 1915
	lockdep_assert_held(&card->dapm_mutex);

M
Mark Brown 已提交
1916 1917
	trace_snd_soc_dapm_start(card);

1918
	list_for_each_entry(d, &card->dapm_list, list) {
1919
		if (dapm_idle_bias_off(d))
1920 1921 1922
			d->target_bias_level = SND_SOC_BIAS_OFF;
		else
			d->target_bias_level = SND_SOC_BIAS_STANDBY;
1923
	}
1924

1925
	dapm_reset(card);
1926

1927
	/* Check which widgets we need to power and store them in
1928 1929 1930 1931
	 * 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.
1932
	 */
1933
	list_for_each_entry(w, &card->dapm_dirty, dirty) {
1934
		dapm_power_one_widget(w, &up_list, &down_list);
1935 1936
	}

1937
	list_for_each_entry(w, &card->widgets, list) {
1938 1939 1940 1941 1942 1943 1944 1945 1946
		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;
		}
1947

1948
		if (w->new_power) {
1949 1950 1951 1952 1953
			d = w->dapm;

			/* Supplies and micbiases only bring the
			 * context up to STANDBY as unless something
			 * else is active and passing audio they
1954 1955 1956
			 * generally don't require full power.  Signal
			 * generators are virtual pins and have no
			 * power impact themselves.
1957 1958
			 */
			switch (w->id) {
1959
			case snd_soc_dapm_siggen:
1960
			case snd_soc_dapm_vmid:
1961
				break;
1962
			case snd_soc_dapm_supply:
1963
			case snd_soc_dapm_regulator_supply:
1964
			case snd_soc_dapm_pinctrl:
1965
			case snd_soc_dapm_clock_supply:
1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977
			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;
			}
		}

	}

1978 1979 1980
	/* Force all contexts in the card to the same bias state if
	 * they're not ground referenced.
	 */
1981
	bias = SND_SOC_BIAS_OFF;
1982
	list_for_each_entry(d, &card->dapm_list, list)
1983 1984
		if (d->target_bias_level > bias)
			bias = d->target_bias_level;
1985
	list_for_each_entry(d, &card->dapm_list, list)
1986
		if (!dapm_idle_bias_off(d))
1987
			d->target_bias_level = bias;
1988

1989
	trace_snd_soc_dapm_walk_done(card);
1990

1991 1992 1993 1994
	/* 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) {
1995
		if (d != &card->dapm && d->bias_level != d->target_bias_level)
1996 1997 1998
			async_schedule_domain(dapm_pre_sequence_async, d,
						&async_domain);
	}
1999
	async_synchronize_full_domain(&async_domain);
2000

2001
	list_for_each_entry(w, &down_list, power_list) {
2002
		dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMD);
2003 2004
	}

2005
	list_for_each_entry(w, &up_list, power_list) {
2006
		dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMU);
2007 2008
	}

2009
	/* Power down widgets first; try to avoid amplifying pops. */
2010
	dapm_seq_run(card, &down_list, event, false);
2011

2012
	dapm_widget_update(card);
2013

2014
	/* Now power up. */
2015
	dapm_seq_run(card, &up_list, event, true);
2016

2017
	/* Run all the bias changes in parallel */
2018
	list_for_each_entry(d, &card->dapm_list, list) {
2019
		if (d != &card->dapm && d->bias_level != d->target_bias_level)
2020 2021 2022
			async_schedule_domain(dapm_post_sequence_async, d,
						&async_domain);
	}
2023
	async_synchronize_full_domain(&async_domain);
2024 2025
	/* Run card bias changes at last */
	dapm_post_sequence_async(&card->dapm, 0);
2026

2027 2028 2029 2030 2031 2032
	/* 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);
	}

2033
	pop_dbg(card->dev, card->pop_time,
2034
		"DAPM sequencing finished, waiting %dms\n", card->pop_time);
2035
	pop_wait(card->pop_time);
2036

M
Mark Brown 已提交
2037 2038
	trace_snd_soc_dapm_done(card);

2039
	return 0;
2040 2041
}

2042 2043 2044 2045 2046 2047
#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;
2048
	struct snd_soc_card *card = w->dapm->card;
2049
	enum snd_soc_dapm_direction dir, rdir;
2050 2051 2052 2053 2054 2055 2056 2057 2058
	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;

2059 2060
	mutex_lock(&card->dapm_mutex);

2061 2062 2063 2064 2065
	/* Supply widgets are not handled by is_connected_{input,output}_ep() */
	if (w->is_supply) {
		in = 0;
		out = 0;
	} else {
2066 2067
		in = is_connected_input_ep(w, NULL, NULL);
		out = is_connected_output_ep(w, NULL, NULL);
2068
	}
2069

2070
	ret = scnprintf(buf, PAGE_SIZE, "%s: %s%s  in %d out %d",
2071 2072
		       w->name, w->power ? "On" : "Off",
		       w->force ? " (forced)" : "", in, out);
2073

2074
	if (w->reg >= 0)
2075
		ret += scnprintf(buf + ret, PAGE_SIZE - ret,
2076 2077
				" - R%d(0x%x) mask 0x%x",
				w->reg, w->reg, w->mask << w->shift);
2078

2079
	ret += scnprintf(buf + ret, PAGE_SIZE - ret, "\n");
2080

2081
	if (w->sname)
2082
		ret += scnprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
2083 2084
				w->sname,
				w->active ? "active" : "inactive");
2085

2086 2087 2088
	snd_soc_dapm_for_each_direction(dir) {
		rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
		snd_soc_dapm_widget_for_each_path(w, dir, p) {
2089
			if (p->connected && !p->connected(p->source, p->sink))
2090
				continue;
2091

2092 2093
			if (!p->connect)
				continue;
2094

2095
			ret += scnprintf(buf + ret, PAGE_SIZE - ret,
2096 2097
					" %s  \"%s\" \"%s\"\n",
					(rdir == SND_SOC_DAPM_DIR_IN) ? "in" : "out",
2098
					p->name ? p->name : "static",
2099 2100
					p->node[rdir]->name);
		}
2101 2102
	}

2103 2104
	mutex_unlock(&card->dapm_mutex);

2105 2106 2107 2108 2109 2110 2111
	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);

	kfree(buf);
	return ret;
}

static const struct file_operations dapm_widget_power_fops = {
2112
	.open = simple_open,
2113
	.read = dapm_widget_power_read_file,
2114
	.llseek = default_llseek,
2115 2116
};

2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136
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 已提交
2137
		WARN(1, "Unknown bias_level %d\n", dapm->bias_level);
2138 2139 2140 2141 2142 2143 2144 2145 2146
		level = "Unknown\n";
		break;
	}

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

static const struct file_operations dapm_bias_fops = {
2147
	.open = simple_open,
2148 2149 2150 2151
	.read = dapm_bias_read_file,
	.llseek = default_llseek,
};

2152 2153
void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
	struct dentry *parent)
2154 2155 2156
{
	struct dentry *d;

2157 2158 2159
	if (!parent)
		return;

2160 2161 2162
	dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);

	if (!dapm->debugfs_dapm) {
2163
		dev_warn(dapm->dev,
2164
		       "ASoC: Failed to create DAPM debugfs directory\n");
2165
		return;
2166
	}
2167

2168 2169 2170 2171 2172 2173
	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");
2174
}
2175

2176 2177 2178 2179
static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
{
	struct snd_soc_dapm_context *dapm = w->dapm;
	struct dentry *d;
2180

2181 2182 2183 2184 2185 2186 2187 2188 2189 2190
	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);
2191
}
2192

2193 2194 2195 2196 2197
static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
{
	debugfs_remove_recursive(dapm->debugfs_dapm);
}

2198
#else
2199 2200
void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
	struct dentry *parent)
2201 2202
{
}
2203 2204 2205 2206 2207

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

2208 2209 2210 2211
static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
{
}

2212 2213
#endif

2214 2215 2216 2217
/*
 * 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,
2218
 *  false if it is disconnected.
2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229
 * @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);
2230
	dapm_path_invalidate(path);
2231 2232
}

2233
/* test and update the power status of a mux widget */
2234
static int soc_dapm_mux_update_power(struct snd_soc_card *card,
2235
				 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e)
2236 2237 2238
{
	struct snd_soc_dapm_path *path;
	int found = 0;
2239
	bool connect;
2240

2241 2242
	lockdep_assert_held(&card->dapm_mutex);

2243
	/* find dapm widget path assoc with kcontrol */
2244
	dapm_kcontrol_for_each_path(path, kcontrol) {
2245 2246
		found = 1;
		/* we now need to match the string in the enum to the path */
2247 2248 2249 2250 2251 2252
		if (!(strcmp(path->name, e->texts[mux])))
			connect = true;
		else
			connect = false;

		soc_dapm_connect_path(path, connect, "mux update");
2253 2254
	}

2255
	if (found)
2256
		dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
2257

2258
	return found;
2259
}
2260

2261
int snd_soc_dapm_mux_update_power(struct snd_soc_dapm_context *dapm,
2262 2263
	struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e,
	struct snd_soc_dapm_update *update)
2264
{
2265
	struct snd_soc_card *card = dapm->card;
2266 2267
	int ret;

2268
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2269
	card->update = update;
2270
	ret = soc_dapm_mux_update_power(card, kcontrol, mux, e);
2271
	card->update = NULL;
2272
	mutex_unlock(&card->dapm_mutex);
2273
	if (ret > 0)
2274
		soc_dpcm_runtime_update(card);
2275 2276
	return ret;
}
2277
EXPORT_SYMBOL_GPL(snd_soc_dapm_mux_update_power);
2278

2279
/* test and update the power status of a mixer or switch widget */
2280
static int soc_dapm_mixer_update_power(struct snd_soc_card *card,
2281 2282
				       struct snd_kcontrol *kcontrol,
				       int connect, int rconnect)
2283 2284 2285 2286
{
	struct snd_soc_dapm_path *path;
	int found = 0;

2287 2288
	lockdep_assert_held(&card->dapm_mutex);

2289
	/* find dapm widget path assoc with kcontrol */
2290
	dapm_kcontrol_for_each_path(path, kcontrol) {
2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316
		/*
		 * 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");
2317 2318 2319
		found = 1;
	}

2320
	if (found)
2321
		dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
2322

2323
	return found;
2324
}
2325

2326
int snd_soc_dapm_mixer_update_power(struct snd_soc_dapm_context *dapm,
2327 2328
	struct snd_kcontrol *kcontrol, int connect,
	struct snd_soc_dapm_update *update)
2329
{
2330
	struct snd_soc_card *card = dapm->card;
2331 2332
	int ret;

2333
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2334
	card->update = update;
2335
	ret = soc_dapm_mixer_update_power(card, kcontrol, connect, -1);
2336
	card->update = NULL;
2337
	mutex_unlock(&card->dapm_mutex);
2338
	if (ret > 0)
2339
		soc_dpcm_runtime_update(card);
2340 2341
	return ret;
}
2342
EXPORT_SYMBOL_GPL(snd_soc_dapm_mixer_update_power);
2343

2344 2345
static ssize_t dapm_widget_show_component(struct snd_soc_component *cmpnt,
	char *buf)
2346
{
2347
	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(cmpnt);
2348 2349 2350 2351
	struct snd_soc_dapm_widget *w;
	int count = 0;
	char *state = "not set";

2352 2353 2354 2355 2356 2357 2358
	/* 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;

2359 2360
	list_for_each_entry(w, &cmpnt->card->widgets, list) {
		if (w->dapm != dapm)
2361
			continue;
2362

2363
		/* only display widgets that burn power */
2364 2365 2366 2367 2368 2369 2370 2371 2372
		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:
2373
		case snd_soc_dapm_out_drv:
2374
		case snd_soc_dapm_mixer:
2375
		case snd_soc_dapm_mixer_named_ctl:
2376
		case snd_soc_dapm_supply:
2377
		case snd_soc_dapm_regulator_supply:
2378
		case snd_soc_dapm_pinctrl:
2379
		case snd_soc_dapm_clock_supply:
2380 2381 2382 2383 2384 2385 2386 2387 2388
			if (w->name)
				count += sprintf(buf + count, "%s: %s\n",
					w->name, w->power ? "On":"Off");
		break;
		default:
		break;
		}
	}

2389
	switch (snd_soc_dapm_get_bias_level(dapm)) {
2390 2391
	case SND_SOC_BIAS_ON:
		state = "On";
2392
		break;
2393 2394
	case SND_SOC_BIAS_PREPARE:
		state = "Prepare";
2395
		break;
2396 2397
	case SND_SOC_BIAS_STANDBY:
		state = "Standby";
2398
		break;
2399 2400
	case SND_SOC_BIAS_OFF:
		state = "Off";
2401 2402 2403 2404 2405 2406 2407
		break;
	}
	count += sprintf(buf + count, "PM State: %s\n", state);

	return count;
}

2408 2409 2410 2411 2412
/* 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);
2413
	struct snd_soc_dai *codec_dai;
2414 2415
	int i, count = 0;

2416 2417
	mutex_lock(&rtd->card->dapm_mutex);

2418 2419
	for_each_rtd_codec_dai(rtd, i, codec_dai) {
		struct snd_soc_component *cmpnt = codec_dai->component;
2420 2421

		count += dapm_widget_show_component(cmpnt, buf + count);
2422 2423
	}

2424 2425
	mutex_unlock(&rtd->card->dapm_mutex);

2426 2427 2428
	return count;
}

J
Joe Perches 已提交
2429
static DEVICE_ATTR_RO(dapm_widget);
2430

2431 2432 2433 2434
struct attribute *soc_dapm_dev_attrs[] = {
	&dev_attr_dapm_widget.attr,
	NULL
};
2435

2436 2437
static void dapm_free_path(struct snd_soc_dapm_path *path)
{
2438 2439
	list_del(&path->list_node[SND_SOC_DAPM_DIR_IN]);
	list_del(&path->list_node[SND_SOC_DAPM_DIR_OUT]);
2440
	list_del(&path->list_kcontrol);
2441 2442 2443 2444
	list_del(&path->list);
	kfree(path);
}

2445 2446 2447
void snd_soc_dapm_free_widget(struct snd_soc_dapm_widget *w)
{
	struct snd_soc_dapm_path *p, *next_p;
2448
	enum snd_soc_dapm_direction dir;
2449 2450 2451 2452 2453 2454 2455

	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.
	 */
2456 2457 2458 2459
	snd_soc_dapm_for_each_direction(dir) {
		snd_soc_dapm_widget_for_each_path_safe(w, dir, p, next_p)
			dapm_free_path(p);
	}
2460 2461

	kfree(w->kcontrols);
2462
	kfree_const(w->name);
2463
	kfree_const(w->sname);
2464 2465 2466
	kfree(w);
}

2467 2468 2469 2470 2471 2472
void snd_soc_dapm_reset_cache(struct snd_soc_dapm_context *dapm)
{
	dapm->path_sink_cache.widget = NULL;
	dapm->path_source_cache.widget = NULL;
}

2473
/* free all dapm widgets and resources */
L
Liam Girdwood 已提交
2474
static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
2475 2476 2477
{
	struct snd_soc_dapm_widget *w, *next_w;

2478 2479 2480
	list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
		if (w->dapm != dapm)
			continue;
2481
		snd_soc_dapm_free_widget(w);
2482
	}
2483
	snd_soc_dapm_reset_cache(dapm);
2484 2485
}

2486 2487 2488
static struct snd_soc_dapm_widget *dapm_find_widget(
			struct snd_soc_dapm_context *dapm, const char *pin,
			bool search_other_contexts)
2489 2490
{
	struct snd_soc_dapm_widget *w;
2491
	struct snd_soc_dapm_widget *fallback = NULL;
2492

2493
	list_for_each_entry(w, &dapm->card->widgets, list) {
2494
		if (!strcmp(w->name, pin)) {
2495 2496 2497 2498
			if (w->dapm == dapm)
				return w;
			else
				fallback = w;
2499 2500 2501
		}
	}

2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512
	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);

2513 2514
	dapm_assert_locked(dapm);

2515
	if (!w) {
2516
		dev_err(dapm->dev, "ASoC: DAPM unknown pin %s\n", pin);
2517
		return -EINVAL;
2518 2519
	}

2520
	if (w->connected != status) {
2521
		dapm_mark_dirty(w, "pin configuration");
2522 2523 2524
		dapm_widget_invalidate_input_paths(w);
		dapm_widget_invalidate_output_paths(w);
	}
2525

2526 2527 2528 2529 2530
	w->connected = status;
	if (status == 0)
		w->force = 0;

	return 0;
2531 2532
}

2533
/**
2534
 * snd_soc_dapm_sync_unlocked - scan and power dapm paths
L
Liam Girdwood 已提交
2535
 * @dapm: DAPM context
2536 2537 2538 2539
 *
 * Walks all dapm audio paths and powers widgets according to their
 * stream or path usage.
 *
2540 2541
 * Requires external locking.
 *
2542 2543
 * Returns 0 for success.
 */
2544
int snd_soc_dapm_sync_unlocked(struct snd_soc_dapm_context *dapm)
2545
{
2546 2547 2548 2549 2550 2551 2552
	/*
	 * Suppress early reports (eg, jacks syncing their state) to avoid
	 * silly DAPM runs during card startup.
	 */
	if (!dapm->card || !dapm->card->instantiated)
		return 0;

2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569
	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;

2570
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2571
	ret = snd_soc_dapm_sync_unlocked(dapm);
2572 2573
	mutex_unlock(&dapm->card->dapm_mutex);
	return ret;
2574
}
2575
EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
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;

2616 2617 2618
	if (!w)
		return 0;

2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651
	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);

2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662
/*
 * 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)
{
2663
	enum snd_soc_dapm_direction dir;
2664
	struct snd_soc_dapm_path *p;
2665
	unsigned int ep;
2666 2667 2668

	switch (w->id) {
	case snd_soc_dapm_input:
2669
		/* On a fully routed card an input is never a source */
2670
		if (w->dapm->card->fully_routed)
2671 2672
			return;
		ep = SND_SOC_DAPM_EP_SOURCE;
2673
		snd_soc_dapm_widget_for_each_source_path(w, p) {
2674 2675 2676 2677
			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) {
2678
					ep = 0;
2679 2680 2681 2682 2683
					break;
			}
		}
		break;
	case snd_soc_dapm_output:
2684 2685
		/* On a fully routed card a output is never a sink */
		if (w->dapm->card->fully_routed)
2686 2687
			return;
		ep = SND_SOC_DAPM_EP_SINK;
2688
		snd_soc_dapm_widget_for_each_sink_path(w, p) {
2689 2690 2691 2692
			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) {
2693
					ep = 0;
2694 2695 2696 2697 2698
					break;
			}
		}
		break;
	case snd_soc_dapm_line:
2699 2700 2701 2702 2703
		ep = 0;
		snd_soc_dapm_for_each_direction(dir) {
			if (!list_empty(&w->edges[dir]))
				ep |= SND_SOC_DAPM_DIR_TO_EP(dir);
		}
2704 2705
		break;
	default:
2706
		return;
2707
	}
2708 2709

	w->is_ep = ep;
2710 2711
}

2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755
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;
}

2756 2757 2758 2759 2760
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))
2761
{
2762 2763
	struct snd_soc_dapm_widget *widgets[2];
	enum snd_soc_dapm_direction dir;
2764
	struct snd_soc_dapm_path *path;
2765
	int ret;
2766

2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787
	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;
	}

2788 2789 2790 2791
	ret = snd_soc_dapm_check_dynamic_path(dapm, wsource, wsink, control);
	if (ret)
		return ret;

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

2796 2797 2798 2799 2800
	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;

2801
	path->connected = connected;
2802
	INIT_LIST_HEAD(&path->list);
2803
	INIT_LIST_HEAD(&path->list_kcontrol);
2804

2805 2806 2807
	if (wsource->is_supply || wsink->is_supply)
		path->is_supply = 1;

2808 2809 2810
	/* connect static paths */
	if (control == NULL) {
		path->connect = 1;
2811
	} else {
2812 2813 2814 2815 2816 2817 2818 2819 2820 2821
		switch (wsource->id) {
		case snd_soc_dapm_demux:
			ret = dapm_connect_mux(dapm, path, control, wsource);
			if (ret)
				goto err;
			break;
		default:
			break;
		}

2822 2823
		switch (wsink->id) {
		case snd_soc_dapm_mux:
2824
			ret = dapm_connect_mux(dapm, path, control, wsink);
2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835
			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:
2836
			break;
2837
		}
2838
	}
2839

2840
	list_add(&path->list, &dapm->card->paths);
2841 2842
	snd_soc_dapm_for_each_direction(dir)
		list_add(&path->list_node[dir], &widgets[dir]->edges[dir]);
2843

2844 2845 2846 2847
	snd_soc_dapm_for_each_direction(dir) {
		dapm_update_widget_flags(widgets[dir]);
		dapm_mark_dirty(widgets[dir], "Route added");
	}
2848

2849 2850 2851
	if (dapm->card->instantiated && path->connect)
		dapm_path_invalidate(path);

2852
	return 0;
2853 2854 2855 2856
err:
	kfree(path);
	return ret;
}
2857

2858
static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
2859
				  const struct snd_soc_dapm_route *route)
2860 2861 2862 2863 2864 2865 2866
{
	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];
2867
	const char *prefix;
2868 2869
	unsigned int sink_ref = 0;
	unsigned int source_ref = 0;
2870 2871
	int ret;

2872 2873
	prefix = soc_dapm_prefix(dapm);
	if (prefix) {
2874
		snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
2875
			 prefix, route->sink);
2876 2877
		sink = prefixed_sink;
		snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
2878
			 prefix, route->source);
2879 2880 2881 2882 2883 2884
		source = prefixed_source;
	} else {
		sink = route->sink;
		source = route->source;
	}

2885 2886 2887 2888 2889 2890
	wsource = dapm_wcache_lookup(&dapm->path_source_cache, source);
	wsink = dapm_wcache_lookup(&dapm->path_sink_cache, sink);

	if (wsink && wsource)
		goto skip_search;

2891 2892 2893 2894 2895 2896 2897
	/*
	 * 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;
2898
			if (w->dapm == dapm) {
2899
				wsink = w;
2900 2901 2902
				if (wsource)
					break;
			}
2903 2904 2905 2906 2907
			sink_ref++;
			if (sink_ref > 1)
				dev_warn(dapm->dev,
					"ASoC: sink widget %s overwritten\n",
					w->name);
2908 2909 2910 2911
			continue;
		}
		if (!wsource && !(strcmp(w->name, source))) {
			wtsource = w;
2912
			if (w->dapm == dapm) {
2913
				wsource = w;
2914 2915 2916
				if (wsink)
					break;
			}
2917 2918 2919 2920 2921
			source_ref++;
			if (source_ref > 1)
				dev_warn(dapm->dev,
					"ASoC: source widget %s overwritten\n",
					w->name);
2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940
		}
	}
	/* 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;
	}

2941 2942 2943 2944
skip_search:
	dapm_wcache_update(&dapm->path_sink_cache, wsink);
	dapm_wcache_update(&dapm->path_source_cache, wsource);

2945 2946 2947 2948 2949 2950
	ret = snd_soc_dapm_add_path(dapm, wsource, wsink, route->control,
		route->connected);
	if (ret)
		goto err;

	return 0;
2951
err:
2952
	dev_warn(dapm->dev, "ASoC: no dapm match for %s --> %s --> %s\n",
2953
		 source, route->control, sink);
2954 2955
	return ret;
}
2956

2957 2958 2959
static int snd_soc_dapm_del_route(struct snd_soc_dapm_context *dapm,
				  const struct snd_soc_dapm_route *route)
{
2960
	struct snd_soc_dapm_widget *wsource, *wsink;
2961 2962 2963 2964 2965
	struct snd_soc_dapm_path *path, *p;
	const char *sink;
	const char *source;
	char prefixed_sink[80];
	char prefixed_source[80];
2966
	const char *prefix;
2967 2968 2969

	if (route->control) {
		dev_err(dapm->dev,
2970
			"ASoC: Removal of routes with controls not supported\n");
2971 2972 2973
		return -EINVAL;
	}

2974 2975
	prefix = soc_dapm_prefix(dapm);
	if (prefix) {
2976
		snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
2977
			 prefix, route->sink);
2978 2979
		sink = prefixed_sink;
		snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
2980
			 prefix, route->source);
2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997
		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) {
2998 2999 3000 3001 3002
		wsource = path->source;
		wsink = path->sink;

		dapm_mark_dirty(wsource, "Route removed");
		dapm_mark_dirty(wsink, "Route removed");
3003 3004
		if (path->connect)
			dapm_path_invalidate(path);
3005

3006
		dapm_free_path(path);
3007 3008 3009 3010

		/* Update any path related flags */
		dapm_update_widget_flags(wsource);
		dapm_update_widget_flags(wsink);
3011
	} else {
3012
		dev_warn(dapm->dev, "ASoC: Route %s->%s does not exist\n",
3013 3014 3015 3016 3017 3018
			 source, sink);
	}

	return 0;
}

3019 3020
/**
 * snd_soc_dapm_add_routes - Add routes between DAPM widgets
L
Liam Girdwood 已提交
3021
 * @dapm: DAPM context
3022 3023 3024 3025 3026 3027 3028 3029 3030 3031
 * @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 已提交
3032
int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
3033 3034
			    const struct snd_soc_dapm_route *route, int num)
{
3035
	int i, r, ret = 0;
3036

3037
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3038
	for (i = 0; i < num; i++) {
3039
		r = snd_soc_dapm_add_route(dapm, route);
3040
		if (r < 0) {
3041 3042 3043 3044
			dev_err(dapm->dev, "ASoC: Failed to add route %s -> %s -> %s\n",
				route->source,
				route->control ? route->control : "direct",
				route->sink);
3045
			ret = r;
3046 3047 3048
		}
		route++;
	}
3049
	mutex_unlock(&dapm->card->dapm_mutex);
3050

3051
	return ret;
3052 3053 3054
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);

3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065
/**
 * 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)
{
3066
	int i;
3067

3068
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3069 3070 3071 3072 3073 3074
	for (i = 0; i < num; i++) {
		snd_soc_dapm_del_route(dapm, route);
		route++;
	}
	mutex_unlock(&dapm->card->dapm_mutex);

3075
	return 0;
3076 3077 3078
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_del_routes);

3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091
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) {
3092
		dev_err(dapm->dev, "ASoC: Unable to find source %s for weak route\n",
3093 3094 3095 3096 3097
			route->source);
		return -ENODEV;
	}

	if (!sink) {
3098
		dev_err(dapm->dev, "ASoC: Unable to find sink %s for weak route\n",
3099 3100 3101 3102 3103
			route->sink);
		return -ENODEV;
	}

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

3107
	snd_soc_dapm_widget_for_each_sink_path(source, path) {
3108 3109 3110 3111 3112 3113 3114
		if (path->sink == sink) {
			path->weak = 1;
			count++;
		}
	}

	if (count == 0)
3115
		dev_err(dapm->dev, "ASoC: No path found for weak route %s->%s\n",
3116 3117
			route->source, route->sink);
	if (count > 1)
3118
		dev_warn(dapm->dev, "ASoC: %d paths found for weak route %s->%s\n",
3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141 3142 3143 3144 3145
			 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;

3146
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
3147 3148 3149 3150 3151 3152
	for (i = 0; i < num; i++) {
		err = snd_soc_dapm_weak_route(dapm, route);
		if (err)
			ret = err;
		route++;
	}
3153
	mutex_unlock(&dapm->card->dapm_mutex);
3154 3155 3156 3157 3158

	return ret;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_weak_routes);

3159 3160
/**
 * snd_soc_dapm_new_widgets - add new dapm widgets
3161
 * @card: card to be checked for new dapm widgets
3162 3163 3164 3165 3166
 *
 * Checks the codec for any new dapm widgets and creates them if found.
 *
 * Returns 0 for success.
 */
3167
int snd_soc_dapm_new_widgets(struct snd_soc_card *card)
3168 3169
{
	struct snd_soc_dapm_widget *w;
3170
	unsigned int val;
3171

3172
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
3173

3174
	list_for_each_entry(w, &card->widgets, list)
3175 3176 3177 3178
	{
		if (w->new)
			continue;

3179
		if (w->num_kcontrols) {
K
Kees Cook 已提交
3180
			w->kcontrols = kcalloc(w->num_kcontrols,
3181 3182
						sizeof(struct snd_kcontrol *),
						GFP_KERNEL);
3183
			if (!w->kcontrols) {
3184
				mutex_unlock(&card->dapm_mutex);
3185
				return -ENOMEM;
3186
			}
3187 3188
		}

3189 3190 3191
		switch(w->id) {
		case snd_soc_dapm_switch:
		case snd_soc_dapm_mixer:
3192
		case snd_soc_dapm_mixer_named_ctl:
3193
			dapm_new_mixer(w);
3194 3195
			break;
		case snd_soc_dapm_mux:
3196
		case snd_soc_dapm_demux:
3197
			dapm_new_mux(w);
3198 3199
			break;
		case snd_soc_dapm_pga:
3200
		case snd_soc_dapm_out_drv:
3201
			dapm_new_pga(w);
3202
			break;
3203 3204 3205
		case snd_soc_dapm_dai_link:
			dapm_new_dai_link(w);
			break;
3206
		default:
3207 3208
			break;
		}
3209 3210 3211

		/* Read the initial power state from the device */
		if (w->reg >= 0) {
3212
			soc_dapm_read(w->dapm, w->reg, &val);
3213
			val = val >> w->shift;
3214 3215
			val &= w->mask;
			if (val == w->on_val)
3216 3217 3218
				w->power = 1;
		}

3219
		w->new = 1;
3220

3221
		dapm_mark_dirty(w, "new widget");
3222
		dapm_debugfs_add_widget(w);
3223 3224
	}

3225 3226
	dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
	mutex_unlock(&card->dapm_mutex);
3227 3228 3229 3230 3231 3232 3233
	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 已提交
3234
 * @ucontrol: control element information
3235 3236 3237 3238 3239 3240 3241 3242
 *
 * 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)
{
3243 3244
	struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
	struct snd_soc_card *card = dapm->card;
3245 3246
	struct soc_mixer_control *mc =
		(struct soc_mixer_control *)kcontrol->private_value;
3247
	int reg = mc->reg;
3248
	unsigned int shift = mc->shift;
3249
	int max = mc->max;
3250
	unsigned int width = fls(max);
3251
	unsigned int mask = (1 << fls(max)) - 1;
3252
	unsigned int invert = mc->invert;
3253
	unsigned int reg_val, val, rval = 0;
3254
	int ret = 0;
3255

3256
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3257
	if (dapm_kcontrol_is_powered(kcontrol) && reg != SND_SOC_NOPM) {
3258 3259 3260 3261 3262 3263 3264 3265
		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;
3266
	} else {
3267 3268 3269 3270 3271
		reg_val = dapm_kcontrol_get_value(kcontrol);
		val = reg_val & mask;

		if (snd_soc_volsw_is_stereo(mc))
			rval = (reg_val >> width) & mask;
3272
	}
3273 3274
	mutex_unlock(&card->dapm_mutex);

3275 3276 3277
	if (ret)
		return ret;

3278
	if (invert)
3279 3280 3281
		ucontrol->value.integer.value[0] = max - val;
	else
		ucontrol->value.integer.value[0] = val;
3282

3283 3284 3285 3286 3287 3288 3289
	if (snd_soc_volsw_is_stereo(mc)) {
		if (invert)
			ucontrol->value.integer.value[1] = max - rval;
		else
			ucontrol->value.integer.value[1] = rval;
	}

3290
	return ret;
3291 3292 3293 3294 3295 3296
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);

/**
 * snd_soc_dapm_put_volsw - dapm mixer set callback
 * @kcontrol: mixer control
M
Mark Brown 已提交
3297
 * @ucontrol: control element information
3298 3299 3300 3301 3302 3303 3304 3305
 *
 * 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)
{
3306 3307
	struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
	struct snd_soc_card *card = dapm->card;
3308 3309
	struct soc_mixer_control *mc =
		(struct soc_mixer_control *)kcontrol->private_value;
3310
	int reg = mc->reg;
3311
	unsigned int shift = mc->shift;
3312
	int max = mc->max;
3313 3314
	unsigned int width = fls(max);
	unsigned int mask = (1 << width) - 1;
3315
	unsigned int invert = mc->invert;
3316 3317
	unsigned int val, rval = 0;
	int connect, rconnect = -1, change, reg_change = 0;
3318
	struct snd_soc_dapm_update update = {};
3319
	int ret = 0;
3320 3321

	val = (ucontrol->value.integer.value[0] & mask);
3322
	connect = !!val;
3323 3324

	if (invert)
P
Philipp Zabel 已提交
3325
		val = max - val;
3326

3327 3328 3329 3330 3331 3332 3333
	if (snd_soc_volsw_is_stereo(mc)) {
		rval = (ucontrol->value.integer.value[1] & mask);
		rconnect = !!rval;
		if (invert)
			rval = max - rval;
	}

3334
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3335

3336 3337 3338 3339 3340 3341
	/* 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));
3342

3343 3344
	if (reg != SND_SOC_NOPM) {
		val = val << shift;
3345 3346 3347
		rval = rval << mc->rshift;

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

3349 3350 3351 3352
		if (snd_soc_volsw_is_stereo(mc))
			reg_change |= soc_dapm_test_bits(dapm, mc->rreg,
							 mask << mc->rshift,
							 rval);
3353 3354 3355 3356
	}

	if (change || reg_change) {
		if (reg_change) {
3357 3358 3359 3360 3361 3362
			if (snd_soc_volsw_is_stereo(mc)) {
				update.has_second_set = true;
				update.reg2 = mc->rreg;
				update.mask2 = mask << mc->rshift;
				update.val2 = rval;
			}
3363 3364
			update.kcontrol = kcontrol;
			update.reg = reg;
3365
			update.mask = mask << shift;
3366 3367
			update.val = val;
			card->update = &update;
3368
		}
3369
		change |= reg_change;
3370

3371 3372
		ret = soc_dapm_mixer_update_power(card, kcontrol, connect,
						  rconnect);
3373

3374
		card->update = NULL;
3375 3376
	}

3377
	mutex_unlock(&card->dapm_mutex);
3378 3379 3380 3381

	if (ret > 0)
		soc_dpcm_runtime_update(card);

3382
	return change;
3383 3384 3385 3386 3387 3388
}
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 已提交
3389
 * @ucontrol: control element information
3390 3391 3392 3393 3394 3395 3396 3397
 *
 * 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)
{
3398
	struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
3399
	struct snd_soc_card *card = dapm->card;
3400
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3401
	unsigned int reg_val, val;
3402

3403 3404
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
	if (e->reg != SND_SOC_NOPM && dapm_kcontrol_is_powered(kcontrol)) {
3405
		int ret = soc_dapm_read(dapm, e->reg, &reg_val);
3406 3407
		if (ret) {
			mutex_unlock(&card->dapm_mutex);
3408
			return ret;
3409
		}
3410
	} else {
3411
		reg_val = dapm_kcontrol_get_value(kcontrol);
3412
	}
3413
	mutex_unlock(&card->dapm_mutex);
P
Peter Ujfalusi 已提交
3414 3415

	val = (reg_val >> e->shift_l) & e->mask;
3416
	ucontrol->value.enumerated.item[0] = snd_soc_enum_val_to_item(e, val);
P
Peter Ujfalusi 已提交
3417 3418
	if (e->shift_l != e->shift_r) {
		val = (reg_val >> e->shift_r) & e->mask;
3419 3420
		val = snd_soc_enum_val_to_item(e, val);
		ucontrol->value.enumerated.item[1] = val;
P
Peter Ujfalusi 已提交
3421 3422
	}

3423
	return 0;
P
Peter Ujfalusi 已提交
3424
}
3425
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
P
Peter Ujfalusi 已提交
3426 3427

/**
3428
 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
P
Peter Ujfalusi 已提交
3429 3430 3431
 * @kcontrol: mixer control
 * @ucontrol: control element information
 *
3432
 * Callback to set the value of a dapm enumerated double mixer control.
P
Peter Ujfalusi 已提交
3433 3434 3435
 *
 * Returns 0 for success.
 */
3436
int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
P
Peter Ujfalusi 已提交
3437 3438
	struct snd_ctl_elem_value *ucontrol)
{
3439 3440
	struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
	struct snd_soc_card *card = dapm->card;
3441
	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3442
	unsigned int *item = ucontrol->value.enumerated.item;
3443
	unsigned int val, change, reg_change = 0;
3444
	unsigned int mask;
3445
	struct snd_soc_dapm_update update = {};
3446
	int ret = 0;
P
Peter Ujfalusi 已提交
3447

3448
	if (item[0] >= e->items)
P
Peter Ujfalusi 已提交
3449
		return -EINVAL;
3450 3451

	val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
P
Peter Ujfalusi 已提交
3452 3453
	mask = e->mask << e->shift_l;
	if (e->shift_l != e->shift_r) {
3454
		if (item[1] > e->items)
P
Peter Ujfalusi 已提交
3455
			return -EINVAL;
3456
		val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r;
P
Peter Ujfalusi 已提交
3457 3458 3459
		mask |= e->mask << e->shift_r;
	}

3460
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3461

3462 3463
	change = dapm_kcontrol_set_value(kcontrol, val);

3464
	if (e->reg != SND_SOC_NOPM)
3465
		reg_change = soc_dapm_test_bits(dapm, e->reg, mask, val);
3466

3467 3468
	if (change || reg_change) {
		if (reg_change) {
3469 3470 3471 3472 3473 3474
			update.kcontrol = kcontrol;
			update.reg = e->reg;
			update.mask = mask;
			update.val = val;
			card->update = &update;
		}
3475
		change |= reg_change;
3476

3477
		ret = soc_dapm_mux_update_power(card, kcontrol, item[0], e);
3478

3479
		card->update = NULL;
3480
	}
P
Peter Ujfalusi 已提交
3481

3482
	mutex_unlock(&card->dapm_mutex);
3483 3484 3485 3486

	if (ret > 0)
		soc_dpcm_runtime_update(card);

3487
	return change;
P
Peter Ujfalusi 已提交
3488
}
3489
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
P
Peter Ujfalusi 已提交
3490

3491 3492 3493 3494 3495 3496 3497 3498 3499 3500 3501 3502 3503 3504 3505 3506 3507 3508 3509 3510 3511 3512 3513 3514 3515 3516 3517 3518 3519
/**
 * 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)
{
3520
	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
3521 3522
	const char *pin = (const char *)kcontrol->private_value;

3523
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3524 3525

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

3528
	mutex_unlock(&card->dapm_mutex);
3529 3530 3531 3532 3533 3534 3535 3536 3537 3538 3539 3540 3541 3542

	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)
{
3543
	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
3544 3545 3546
	const char *pin = (const char *)kcontrol->private_value;

	if (ucontrol->value.integer.value[0])
3547
		snd_soc_dapm_enable_pin(&card->dapm, pin);
3548
	else
3549
		snd_soc_dapm_disable_pin(&card->dapm, pin);
3550

3551
	snd_soc_dapm_sync(&card->dapm);
3552 3553 3554 3555
	return 0;
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);

3556 3557
struct snd_soc_dapm_widget *
snd_soc_dapm_new_control_unlocked(struct snd_soc_dapm_context *dapm,
3558
			 const struct snd_soc_dapm_widget *widget)
3559
{
3560
	enum snd_soc_dapm_direction dir;
3561
	struct snd_soc_dapm_widget *w;
3562
	const char *prefix;
3563
	int ret;
3564 3565

	if ((w = dapm_cnew_widget(widget)) == NULL)
3566
		return ERR_PTR(-ENOMEM);
3567

3568 3569
	switch (w->id) {
	case snd_soc_dapm_regulator_supply:
3570 3571 3572
		w->regulator = devm_regulator_get(dapm->dev, w->name);
		if (IS_ERR(w->regulator)) {
			ret = PTR_ERR(w->regulator);
3573
			goto request_failed;
3574
		}
3575

3576
		if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
3577 3578
			ret = regulator_allow_bypass(w->regulator, true);
			if (ret != 0)
3579
				dev_warn(dapm->dev,
3580
					 "ASoC: Failed to bypass %s: %d\n",
3581 3582
					 w->name, ret);
		}
3583
		break;
3584 3585
	case snd_soc_dapm_pinctrl:
		w->pinctrl = devm_pinctrl_get(dapm->dev);
3586
		if (IS_ERR(w->pinctrl)) {
3587
			ret = PTR_ERR(w->pinctrl);
3588
			goto request_failed;
3589 3590
		}
		break;
3591
	case snd_soc_dapm_clock_supply:
M
Mark Brown 已提交
3592
		w->clk = devm_clk_get(dapm->dev, w->name);
3593 3594
		if (IS_ERR(w->clk)) {
			ret = PTR_ERR(w->clk);
3595
			goto request_failed;
3596 3597
		}
		break;
3598 3599 3600
	default:
		break;
	}
3601

3602
	prefix = soc_dapm_prefix(dapm);
3603
	if (prefix)
3604
		w->name = kasprintf(GFP_KERNEL, "%s %s", prefix, widget->name);
3605
	else
3606
		w->name = kstrdup_const(widget->name, GFP_KERNEL);
3607
	if (w->name == NULL) {
3608
		kfree_const(w->sname);
3609
		kfree(w);
3610
		return ERR_PTR(-ENOMEM);
3611 3612
	}

3613
	switch (w->id) {
3614
	case snd_soc_dapm_mic:
3615
		w->is_ep = SND_SOC_DAPM_EP_SOURCE;
3616 3617
		w->power_check = dapm_generic_check_power;
		break;
3618 3619
	case snd_soc_dapm_input:
		if (!dapm->card->fully_routed)
3620
			w->is_ep = SND_SOC_DAPM_EP_SOURCE;
3621 3622
		w->power_check = dapm_generic_check_power;
		break;
3623 3624
	case snd_soc_dapm_spk:
	case snd_soc_dapm_hp:
3625
		w->is_ep = SND_SOC_DAPM_EP_SINK;
3626 3627
		w->power_check = dapm_generic_check_power;
		break;
3628 3629
	case snd_soc_dapm_output:
		if (!dapm->card->fully_routed)
3630
			w->is_ep = SND_SOC_DAPM_EP_SINK;
3631 3632
		w->power_check = dapm_generic_check_power;
		break;
3633 3634
	case snd_soc_dapm_vmid:
	case snd_soc_dapm_siggen:
3635
		w->is_ep = SND_SOC_DAPM_EP_SOURCE;
3636 3637
		w->power_check = dapm_always_on_check_power;
		break;
V
Vinod Koul 已提交
3638 3639 3640 3641 3642
	case snd_soc_dapm_sink:
		w->is_ep = SND_SOC_DAPM_EP_SINK;
		w->power_check = dapm_always_on_check_power;
		break;

3643
	case snd_soc_dapm_mux:
3644
	case snd_soc_dapm_demux:
3645 3646 3647
	case snd_soc_dapm_switch:
	case snd_soc_dapm_mixer:
	case snd_soc_dapm_mixer_named_ctl:
3648 3649 3650 3651
	case snd_soc_dapm_adc:
	case snd_soc_dapm_aif_out:
	case snd_soc_dapm_dac:
	case snd_soc_dapm_aif_in:
3652
	case snd_soc_dapm_pga:
3653 3654 3655 3656 3657 3658 3659
	case snd_soc_dapm_buffer:
	case snd_soc_dapm_scheduler:
	case snd_soc_dapm_effect:
	case snd_soc_dapm_src:
	case snd_soc_dapm_asrc:
	case snd_soc_dapm_encoder:
	case snd_soc_dapm_decoder:
3660 3661 3662
	case snd_soc_dapm_out_drv:
	case snd_soc_dapm_micbias:
	case snd_soc_dapm_line:
3663
	case snd_soc_dapm_dai_link:
3664 3665
	case snd_soc_dapm_dai_out:
	case snd_soc_dapm_dai_in:
3666 3667 3668
		w->power_check = dapm_generic_check_power;
		break;
	case snd_soc_dapm_supply:
3669
	case snd_soc_dapm_regulator_supply:
3670
	case snd_soc_dapm_pinctrl:
3671
	case snd_soc_dapm_clock_supply:
3672
	case snd_soc_dapm_kcontrol:
3673
		w->is_supply = 1;
3674 3675 3676 3677 3678 3679 3680
		w->power_check = dapm_supply_check_power;
		break;
	default:
		w->power_check = dapm_always_on_check_power;
		break;
	}

L
Liam Girdwood 已提交
3681
	w->dapm = dapm;
3682
	INIT_LIST_HEAD(&w->list);
3683
	INIT_LIST_HEAD(&w->dirty);
3684
	list_add_tail(&w->list, &dapm->card->widgets);
3685

3686 3687 3688 3689
	snd_soc_dapm_for_each_direction(dir) {
		INIT_LIST_HEAD(&w->edges[dir]);
		w->endpoints[dir] = -1;
	}
3690

3691
	/* machine layer sets up unconnected pins and insertions */
3692
	w->connected = 1;
3693
	return w;
3694 3695 3696 3697 3698 3699 3700

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

	return ERR_PTR(ret);
3701 3702
}

3703 3704 3705 3706 3707 3708 3709 3710 3711 3712 3713 3714 3715 3716 3717 3718 3719 3720 3721 3722 3723 3724 3725
/**
 * 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);

3726 3727
/**
 * snd_soc_dapm_new_controls - create new dapm controls
L
Liam Girdwood 已提交
3728
 * @dapm: DAPM context
3729 3730 3731 3732 3733 3734 3735
 * @widget: widget array
 * @num: number of widgets
 *
 * Creates new DAPM controls based upon the templates.
 *
 * Returns 0 for success else error.
 */
L
Liam Girdwood 已提交
3736
int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
3737 3738 3739
	const struct snd_soc_dapm_widget *widget,
	int num)
{
3740 3741
	struct snd_soc_dapm_widget *w;
	int i;
3742
	int ret = 0;
3743

3744
	mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
3745
	for (i = 0; i < num; i++) {
3746
		w = snd_soc_dapm_new_control_unlocked(dapm, widget);
3747 3748
		if (IS_ERR(w)) {
			ret = PTR_ERR(w);
3749
			break;
3750
		}
3751 3752
		widget++;
	}
3753
	mutex_unlock(&dapm->card->dapm_mutex);
3754
	return ret;
3755 3756 3757
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);

3758 3759 3760
static int snd_soc_dai_link_event(struct snd_soc_dapm_widget *w,
				  struct snd_kcontrol *kcontrol, int event)
{
3761
	struct snd_soc_dapm_path *path;
3762
	struct snd_soc_dai *source, *sink;
3763
	struct snd_soc_pcm_runtime *rtd = w->priv;
3764
	const struct snd_soc_pcm_stream *config;
3765
	struct snd_pcm_substream substream;
3766
	struct snd_pcm_hw_params *params = NULL;
3767
	struct snd_pcm_runtime *runtime = NULL;
3768
	unsigned int fmt;
3769
	int ret = 0;
3770

3771 3772
	config = rtd->dai_link->params + rtd->params_select;

3773
	if (WARN_ON(!config) ||
3774 3775
	    WARN_ON(list_empty(&w->edges[SND_SOC_DAPM_DIR_OUT]) ||
		    list_empty(&w->edges[SND_SOC_DAPM_DIR_IN])))
3776
		return -EINVAL;
3777 3778 3779 3780 3781

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

	/* Currently very limited parameter selection */
3788 3789 3790 3791 3792 3793
	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);
3794

3795
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->min =
3796
		config->rate_min;
3797
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->max =
3798 3799
		config->rate_max;

3800
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->min
3801
		= config->channels_min;
3802
	hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->max
3803 3804 3805 3806
		= config->channels_max;

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

3807 3808 3809 3810 3811 3812 3813
	/* 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;
3814
	substream.private_data = rtd;
3815

3816 3817
	switch (event) {
	case SND_SOC_DAPM_PRE_PMU:
3818
		substream.stream = SNDRV_PCM_STREAM_CAPTURE;
3819 3820 3821 3822 3823 3824 3825 3826 3827 3828 3829 3830
		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;
				}
3831
			}
3832
			source->active++;
3833 3834 3835
			ret = soc_dai_hw_params(&substream, params, source);
			if (ret < 0)
				goto out;
3836 3837

			dapm_update_dai_unlocked(&substream, params, source);
3838
		}
3839

3840
		substream.stream = SNDRV_PCM_STREAM_PLAYBACK;
3841 3842 3843 3844 3845 3846 3847 3848 3849 3850 3851 3852
		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;
				}
3853
			}
3854
			sink->active++;
3855 3856 3857
			ret = soc_dai_hw_params(&substream, params, sink);
			if (ret < 0)
				goto out;
3858 3859

			dapm_update_dai_unlocked(&substream, params, sink);
3860
		}
3861 3862 3863
		break;

	case SND_SOC_DAPM_POST_PMU:
3864 3865 3866 3867 3868 3869 3870 3871 3872 3873
		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;
		}
3874 3875 3876
		break;

	case SND_SOC_DAPM_PRE_PMD:
3877 3878 3879 3880 3881 3882 3883 3884 3885 3886 3887
		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;
		}

3888
		substream.stream = SNDRV_PCM_STREAM_CAPTURE;
3889 3890
		snd_soc_dapm_widget_for_each_source_path(w, path) {
			source = path->source->priv;
3891

3892 3893 3894 3895
			if (source->driver->ops->hw_free)
				source->driver->ops->hw_free(&substream,
							     source);

3896
			source->active--;
3897
			if (source->driver->ops->shutdown)
3898 3899
				source->driver->ops->shutdown(&substream,
							      source);
3900 3901
		}

3902
		substream.stream = SNDRV_PCM_STREAM_PLAYBACK;
3903 3904 3905
		snd_soc_dapm_widget_for_each_sink_path(w, path) {
			sink = path->sink->priv;

3906 3907 3908
			if (sink->driver->ops->hw_free)
				sink->driver->ops->hw_free(&substream, sink);

3909
			sink->active--;
3910
			if (sink->driver->ops->shutdown)
3911
				sink->driver->ops->shutdown(&substream, sink);
3912
		}
3913 3914 3915
		break;

	default:
T
Takashi Iwai 已提交
3916
		WARN(1, "Unknown event %d\n", event);
S
Sudip Mukherjee 已提交
3917
		ret = -EINVAL;
3918 3919
	}

3920
out:
3921
	kfree(runtime);
3922 3923
	kfree(params);
	return ret;
3924 3925
}

3926 3927 3928 3929
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);
3930
	struct snd_soc_pcm_runtime *rtd = w->priv;
3931

3932
	ucontrol->value.enumerated.item[0] = rtd->params_select;
3933 3934 3935 3936 3937 3938 3939 3940

	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);
3941
	struct snd_soc_pcm_runtime *rtd = w->priv;
3942 3943 3944 3945 3946

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

3947
	if (ucontrol->value.enumerated.item[0] == rtd->params_select)
3948 3949
		return 0;

3950
	if (ucontrol->value.enumerated.item[0] >= rtd->dai_link->num_params)
3951 3952
		return -EINVAL;

3953
	rtd->params_select = ucontrol->value.enumerated.item[0];
3954 3955 3956 3957

	return 0;
}

3958
static void
3959 3960 3961 3962 3963 3964 3965 3966
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);
3967 3968 3969 3970

	if (!w_param_text)
		return;

3971 3972 3973 3974 3975 3976 3977 3978 3979 3980 3981
	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)
3982
{
3983 3984 3985 3986 3987 3988 3989 3990
	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),
	};
3991
	struct snd_kcontrol_new *kcontrol_news;
3992
	const struct snd_soc_pcm_stream *config = params;
3993
	int count;
3994

3995 3996 3997 3998 3999 4000
	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 已提交
4001 4002 4003
				devm_kasprintf(card->dev, GFP_KERNEL,
					       "Anonymous Configuration %d",
					       count);
4004 4005 4006 4007 4008 4009
		} else {
			w_param_text[count] = devm_kmemdup(card->dev,
						config->stream_name,
						strlen(config->stream_name) + 1,
						GFP_KERNEL);
		}
4010 4011
		if (!w_param_text[count])
			goto outfree_w_param;
4012 4013
		config++;
	}
4014

4015 4016
	w_param_enum[0].items = num_params;
	w_param_enum[0].texts = w_param_text;
4017

4018
	*private_value =
4019 4020 4021
		(unsigned long) devm_kmemdup(card->dev,
			(void *)(kcontrol_dai_link[0].private_value),
			sizeof(struct soc_enum), GFP_KERNEL);
4022
	if (!*private_value) {
4023 4024
		dev_err(card->dev, "ASoC: Failed to create control for %s widget\n",
			link_name);
4025
		goto outfree_w_param;
4026
	}
4027
	kcontrol_dai_link[0].private_value = *private_value;
4028
	/* duplicate kcontrol_dai_link on heap so that memory persists */
4029
	kcontrol_news = devm_kmemdup(card->dev, &kcontrol_dai_link[0],
4030 4031
					sizeof(struct snd_kcontrol_new),
					GFP_KERNEL);
4032
	if (!kcontrol_news) {
4033 4034
		dev_err(card->dev, "ASoC: Failed to create control for %s widget\n",
			link_name);
4035
		goto outfree_w_param;
4036
	}
4037
	return kcontrol_news;
4038

4039 4040 4041 4042 4043
outfree_w_param:
	snd_soc_dapm_free_kcontrol(card, private_value, num_params, w_param_text);
	return NULL;
}

4044 4045 4046 4047
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)
4048 4049 4050 4051
{
	struct snd_soc_dapm_widget template;
	struct snd_soc_dapm_widget *w;
	const char **w_param_text;
4052
	unsigned long private_value = 0;
4053 4054 4055 4056 4057 4058
	char *link_name;
	int ret;

	link_name = devm_kasprintf(card->dev, GFP_KERNEL, "%s-%s",
				   source->name, sink->name);
	if (!link_name)
4059
		return ERR_PTR(-ENOMEM);
4060 4061 4062 4063 4064 4065 4066 4067 4068 4069 4070

	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 */
4071 4072 4073 4074
	if (rtd->dai_link->num_params > 1) {
		w_param_text = devm_kcalloc(card->dev,
					    rtd->dai_link->num_params,
					    sizeof(char *), GFP_KERNEL);
4075 4076 4077 4078
		if (!w_param_text) {
			ret = -ENOMEM;
			goto param_fail;
		}
4079

4080 4081 4082
		template.num_kcontrols = 1;
		template.kcontrol_news =
					snd_soc_dapm_alloc_kcontrol(card,
4083 4084 4085
						link_name,
						rtd->dai_link->params,
						rtd->dai_link->num_params,
4086 4087 4088 4089 4090
						w_param_text, &private_value);
		if (!template.kcontrol_news) {
			ret = -ENOMEM;
			goto param_fail;
		}
4091 4092
	} else {
		w_param_text = NULL;
4093
	}
4094
	dev_dbg(card->dev, "ASoC: adding %s widget\n", link_name);
4095

4096
	w = snd_soc_dapm_new_control_unlocked(&card->dapm, &template);
4097 4098
	if (IS_ERR(w)) {
		ret = PTR_ERR(w);
4099
		goto outfree_kcontrol_news;
4100
	}
4101

4102
	w->priv = rtd;
4103

4104
	return w;
4105 4106 4107

outfree_kcontrol_news:
	devm_kfree(card->dev, (void *)template.kcontrol_news);
4108 4109
	snd_soc_dapm_free_kcontrol(card, &private_value,
				   rtd->dai_link->num_params, w_param_text);
4110
param_fail:
4111
	devm_kfree(card->dev, link_name);
4112
	return ERR_PTR(ret);
4113 4114
}

4115 4116
int snd_soc_dapm_new_dai_widgets(struct snd_soc_dapm_context *dapm,
				 struct snd_soc_dai *dai)
4117
{
4118
	struct snd_soc_dapm_widget template;
4119 4120
	struct snd_soc_dapm_widget *w;

4121 4122 4123 4124 4125 4126
	WARN_ON(dapm->dev != dai->dev);

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

	if (dai->driver->playback.stream_name) {
4127
		template.id = snd_soc_dapm_dai_in;
4128 4129 4130
		template.name = dai->driver->playback.stream_name;
		template.sname = dai->driver->playback.stream_name;

4131
		dev_dbg(dai->dev, "ASoC: adding %s widget\n",
4132 4133
			template.name);

4134
		w = snd_soc_dapm_new_control_unlocked(dapm, &template);
4135 4136
		if (IS_ERR(w))
			return PTR_ERR(w);
4137 4138 4139 4140 4141 4142

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

	if (dai->driver->capture.stream_name) {
4143
		template.id = snd_soc_dapm_dai_out;
4144 4145 4146
		template.name = dai->driver->capture.stream_name;
		template.sname = dai->driver->capture.stream_name;

4147
		dev_dbg(dai->dev, "ASoC: adding %s widget\n",
4148 4149
			template.name);

4150
		w = snd_soc_dapm_new_control_unlocked(dapm, &template);
4151 4152
		if (IS_ERR(w))
			return PTR_ERR(w);
4153 4154 4155 4156 4157 4158 4159 4160 4161 4162 4163

		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;
4164
	struct snd_soc_dapm_widget *src, *sink;
4165 4166 4167 4168
	struct snd_soc_dai *dai;

	/* For each DAI widget... */
	list_for_each_entry(dai_w, &card->widgets, list) {
4169 4170 4171 4172 4173
		switch (dai_w->id) {
		case snd_soc_dapm_dai_in:
		case snd_soc_dapm_dai_out:
			break;
		default:
4174
			continue;
4175
		}
4176

4177 4178 4179 4180 4181 4182 4183
		/* 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;
		}

4184 4185 4186 4187 4188 4189 4190
		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;

4191 4192 4193
			switch (w->id) {
			case snd_soc_dapm_dai_in:
			case snd_soc_dapm_dai_out:
4194
				continue;
4195 4196 4197
			default:
				break;
			}
4198

4199
			if (!w->sname || !strstr(w->sname, dai_w->sname))
4200 4201
				continue;

4202 4203 4204 4205 4206 4207
			if (dai_w->id == snd_soc_dapm_dai_in) {
				src = dai_w;
				sink = w;
			} else {
				src = w;
				sink = dai_w;
4208
			}
4209 4210
			dev_dbg(dai->dev, "%s -> %s\n", src->name, sink->name);
			snd_soc_dapm_add_path(w->dapm, src, sink, NULL, NULL);
4211 4212 4213
		}
	}

4214 4215
	return 0;
}
4216

4217 4218
static void dapm_connect_dai_link_widgets(struct snd_soc_card *card,
					  struct snd_soc_pcm_runtime *rtd)
4219
{
4220
	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
4221
	struct snd_soc_dai *codec_dai;
4222 4223
	struct snd_soc_dapm_widget *playback = NULL, *capture = NULL;
	struct snd_soc_dapm_widget *codec, *playback_cpu, *capture_cpu;
4224 4225
	int i;

4226 4227 4228 4229 4230 4231 4232 4233 4234 4235
	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;
	}

4236
	for_each_rtd_codec_dai(rtd, i, codec_dai) {
4237 4238

		/* connect BE DAI playback if widgets are valid */
4239 4240 4241 4242 4243 4244 4245
		codec = codec_dai->playback_widget;

		if (playback_cpu && codec) {
			if (!playback) {
				playback = snd_soc_dapm_new_dai(card, rtd,
								playback_cpu,
								codec);
4246 4247 4248 4249 4250 4251 4252
				if (IS_ERR(playback)) {
					dev_err(rtd->dev,
						"ASoC: Failed to create DAI %s: %ld\n",
						codec_dai->name,
						PTR_ERR(playback));
					continue;
				}
4253 4254 4255 4256 4257

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

4258
			dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n",
4259 4260
				cpu_dai->component->name, playback_cpu->name,
				codec_dai->component->name, codec->name);
4261

4262 4263
			snd_soc_dapm_add_path(&card->dapm, playback, codec,
					      NULL, NULL);
4264
		}
4265
	}
4266

4267
	for_each_rtd_codec_dai(rtd, i, codec_dai) {
4268
		/* connect BE DAI capture if widgets are valid */
4269 4270 4271 4272 4273 4274 4275
		codec = codec_dai->capture_widget;

		if (codec && capture_cpu) {
			if (!capture) {
				capture = snd_soc_dapm_new_dai(card, rtd,
							       codec,
							       capture_cpu);
4276 4277 4278 4279 4280 4281 4282
				if (IS_ERR(capture)) {
					dev_err(rtd->dev,
						"ASoC: Failed to create DAI %s: %ld\n",
						codec_dai->name,
						PTR_ERR(capture));
					continue;
				}
4283 4284 4285 4286 4287

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

4288
			dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n",
4289 4290
				codec_dai->component->name, codec->name,
				cpu_dai->component->name, capture_cpu->name);
4291

4292 4293
			snd_soc_dapm_add_path(&card->dapm, codec, capture,
					      NULL, NULL);
4294 4295 4296 4297
		}
	}
}

4298
static void soc_dapm_dai_stream_event(struct snd_soc_dai *dai, int stream,
4299
	int event)
4300
{
4301
	struct snd_soc_dapm_widget *w;
4302
	unsigned int ep;
4303

4304 4305 4306 4307
	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
		w = dai->playback_widget;
	else
		w = dai->capture_widget;
4308

4309 4310
	if (w) {
		dapm_mark_dirty(w, "stream event");
4311

4312 4313 4314 4315 4316 4317 4318 4319
		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);
		}

4320 4321
		switch (event) {
		case SND_SOC_DAPM_STREAM_START:
4322
			w->active = 1;
4323
			w->is_ep = ep;
4324 4325
			break;
		case SND_SOC_DAPM_STREAM_STOP:
4326
			w->active = 0;
4327
			w->is_ep = 0;
4328 4329 4330 4331 4332 4333 4334 4335
			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;
		}
	}
4336
}
4337

4338 4339
void snd_soc_dapm_connect_dai_link_widgets(struct snd_soc_card *card)
{
4340
	struct snd_soc_pcm_runtime *rtd;
4341 4342

	/* for each BE DAI link... */
4343
	for_each_card_rtds(card, rtd)  {
4344 4345 4346 4347
		/*
		 * dynamic FE links have no fixed DAI mapping.
		 * CODEC<->CODEC links have no direct connection.
		 */
4348
		if (rtd->dai_link->dynamic)
4349 4350 4351 4352 4353 4354
			continue;

		dapm_connect_dai_link_widgets(card, rtd);
	}
}

4355 4356 4357
static void soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
	int event)
{
4358
	struct snd_soc_dai *codec_dai;
4359 4360
	int i;

4361
	soc_dapm_dai_stream_event(rtd->cpu_dai, stream, event);
4362 4363
	for_each_rtd_codec_dai(rtd, i, codec_dai)
		soc_dapm_dai_stream_event(codec_dai, stream, event);
4364

4365
	dapm_power_widgets(rtd->card, event);
L
Liam Girdwood 已提交
4366 4367 4368 4369 4370 4371 4372 4373 4374 4375 4376 4377 4378
}

/**
 * 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.
 */
4379 4380
void snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
			      int event)
L
Liam Girdwood 已提交
4381
{
4382
	struct snd_soc_card *card = rtd->card;
L
Liam Girdwood 已提交
4383

4384
	mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
4385
	soc_dapm_stream_event(rtd, stream, event);
4386
	mutex_unlock(&card->dapm_mutex);
4387 4388
}

4389 4390 4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401 4402 4403 4404 4405 4406 4407 4408
/**
 * 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);

4409
/**
4410
 * snd_soc_dapm_enable_pin - enable pin.
L
Liam Girdwood 已提交
4411
 * @dapm: DAPM context
4412
 * @pin: pin name
4413
 *
M
Mark Brown 已提交
4414
 * Enables input/output pin and its parents or children widgets iff there is
4415
 * a valid audio route and active audio stream.
4416
 *
4417 4418
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
4419
 */
L
Liam Girdwood 已提交
4420
int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
4421
{
4422 4423 4424 4425 4426 4427 4428 4429 4430
	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;
4431 4432
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
4433

4434
/**
4435
 * snd_soc_dapm_force_enable_pin_unlocked - force a pin to be enabled
L
Liam Girdwood 已提交
4436
 * @dapm: DAPM context
4437 4438 4439 4440 4441 4442
 * @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.
 *
4443 4444
 * Requires external locking.
 *
4445 4446 4447
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
4448 4449
int snd_soc_dapm_force_enable_pin_unlocked(struct snd_soc_dapm_context *dapm,
					 const char *pin)
4450
{
4451
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
4452

4453
	if (!w) {
4454
		dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
4455
		return -EINVAL;
4456 4457
	}

4458
	dev_dbg(w->dapm->dev, "ASoC: force enable pin %s\n", pin);
4459 4460 4461 4462 4463 4464 4465 4466 4467
	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;
	}
4468
	w->force = 1;
4469
	dapm_mark_dirty(w, "force enable");
4470

4471
	return 0;
4472
}
4473 4474 4475 4476 4477 4478 4479 4480 4481 4482 4483 4484 4485 4486 4487 4488 4489 4490 4491 4492 4493 4494 4495 4496 4497 4498 4499
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;
}
4500 4501
EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);

4502 4503 4504 4505 4506 4507 4508 4509 4510 4511 4512 4513 4514 4515 4516 4517 4518 4519 4520
/**
 * 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);

4521 4522
/**
 * snd_soc_dapm_disable_pin - disable pin.
L
Liam Girdwood 已提交
4523
 * @dapm: DAPM context
4524 4525
 * @pin: pin name
 *
M
Mark Brown 已提交
4526
 * Disables input/output pin and its parents or children widgets.
4527
 *
4528 4529 4530
 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
 * do any widget power switching.
 */
L
Liam Girdwood 已提交
4531 4532
int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
			     const char *pin)
4533
{
4534 4535 4536 4537 4538 4539 4540 4541 4542
	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;
4543
}
4544
EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
4545

4546 4547 4548 4549 4550 4551 4552 4553 4554 4555 4556 4557 4558 4559 4560 4561 4562 4563 4564 4565 4566 4567 4568
/**
 * 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);

4569 4570
/**
 * snd_soc_dapm_nc_pin - permanently disable pin.
L
Liam Girdwood 已提交
4571
 * @dapm: DAPM context
4572 4573 4574 4575 4576 4577 4578 4579 4580 4581 4582
 * @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 已提交
4583
int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
4584
{
4585 4586 4587 4588 4589 4590 4591 4592 4593
	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;
4594 4595 4596
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);

4597
/**
4598
 * snd_soc_dapm_get_pin_status - get audio pin status
L
Liam Girdwood 已提交
4599
 * @dapm: DAPM context
4600
 * @pin: audio signal pin endpoint (or start point)
4601
 *
4602
 * Get audio pin status - connected or disconnected.
4603
 *
4604
 * Returns 1 for connected otherwise 0.
4605
 */
L
Liam Girdwood 已提交
4606 4607
int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
				const char *pin)
4608
{
4609
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
4610

4611 4612
	if (w)
		return w->connected;
4613

4614 4615
	return 0;
}
4616
EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
4617

4618 4619
/**
 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
L
Liam Girdwood 已提交
4620
 * @dapm: DAPM context
4621 4622 4623 4624 4625 4626 4627 4628
 * @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 已提交
4629 4630
int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
				const char *pin)
4631
{
4632
	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
4633

4634
	if (!w) {
4635
		dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
4636
		return -EINVAL;
4637 4638
	}

4639 4640 4641
	w->ignore_suspend = 1;

	return 0;
4642 4643 4644
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);

4645 4646
/**
 * snd_soc_dapm_free - free dapm resources
4647
 * @dapm: DAPM context
4648 4649 4650
 *
 * Free all dapm widgets and resources.
 */
L
Liam Girdwood 已提交
4651
void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
4652
{
4653
	dapm_debugfs_cleanup(dapm);
L
Liam Girdwood 已提交
4654
	dapm_free_widgets(dapm);
4655
	list_del(&dapm->list);
4656 4657 4658
}
EXPORT_SYMBOL_GPL(snd_soc_dapm_free);

4659
static void soc_dapm_shutdown_dapm(struct snd_soc_dapm_context *dapm)
M
Mark Brown 已提交
4660
{
4661
	struct snd_soc_card *card = dapm->card;
M
Mark Brown 已提交
4662 4663 4664 4665
	struct snd_soc_dapm_widget *w;
	LIST_HEAD(down_list);
	int powerdown = 0;

4666 4667
	mutex_lock(&card->dapm_mutex);

4668 4669 4670
	list_for_each_entry(w, &dapm->card->widgets, list) {
		if (w->dapm != dapm)
			continue;
M
Mark Brown 已提交
4671
		if (w->power) {
4672
			dapm_seq_insert(w, &down_list, false);
4673
			w->power = 0;
M
Mark Brown 已提交
4674 4675 4676 4677 4678 4679 4680 4681
			powerdown = 1;
		}
	}

	/* If there were no widgets to power down we're already in
	 * standby.
	 */
	if (powerdown) {
4682 4683 4684
		if (dapm->bias_level == SND_SOC_BIAS_ON)
			snd_soc_dapm_set_bias_level(dapm,
						    SND_SOC_BIAS_PREPARE);
4685
		dapm_seq_run(card, &down_list, 0, false);
4686 4687 4688
		if (dapm->bias_level == SND_SOC_BIAS_PREPARE)
			snd_soc_dapm_set_bias_level(dapm,
						    SND_SOC_BIAS_STANDBY);
M
Mark Brown 已提交
4689
	}
4690 4691

	mutex_unlock(&card->dapm_mutex);
4692 4693 4694 4695 4696 4697 4698
}

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

4701
	list_for_each_entry(dapm, &card->dapm_list, list) {
4702 4703 4704 4705 4706 4707
		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 已提交
4708
	}
4709 4710 4711 4712 4713

	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 已提交
4714 4715
}

4716
/* Module information */
4717
MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
4718 4719
MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
MODULE_LICENSE("GPL");