hda_codec.c 135.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 * Universal Interface for Intel High Definition Audio Codec
 *
 * Copyright (c) 2004 Takashi Iwai <tiwai@suse.de>
 *
 *
 *  This driver is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This driver is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
 */

22
#include <linux/mm.h>
L
Linus Torvalds 已提交
23 24 25
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/slab.h>
26
#include <linux/mutex.h>
27
#include <linux/module.h>
28
#include <linux/async.h>
29 30
#include <linux/pm.h>
#include <linux/pm_runtime.h>
L
Linus Torvalds 已提交
31 32 33
#include <sound/core.h>
#include "hda_codec.h"
#include <sound/asoundef.h>
34
#include <sound/tlv.h>
L
Linus Torvalds 已提交
35
#include <sound/initval.h>
36
#include <sound/jack.h>
L
Linus Torvalds 已提交
37
#include "hda_local.h"
38
#include "hda_beep.h"
39
#include "hda_jack.h"
40
#include <sound/hda_hwdep.h>
L
Linus Torvalds 已提交
41

42
#ifdef CONFIG_PM
43
#define codec_in_pm(codec)	atomic_read(&(codec)->core.in_pm)
44 45
#define hda_codec_is_power_on(codec) \
	(!pm_runtime_suspended(hda_codec_dev(codec)))
46
#else
47
#define codec_in_pm(codec)	0
48
#define hda_codec_is_power_on(codec)	1
49 50
#endif

51 52 53 54 55
#define codec_has_epss(codec) \
	((codec)->core.power_caps & AC_PWRST_EPSS)
#define codec_has_clkstop(codec) \
	((codec)->core.power_caps & AC_PWRST_CLKSTOP)

56 57 58 59 60 61 62
/**
 * snd_hda_get_jack_location - Give a location string of the jack
 * @cfg: pin default config value
 *
 * Parse the pin default config value and returns the string of the
 * jack location, e.g. "Rear", "Front", etc.
 */
63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87
const char *snd_hda_get_jack_location(u32 cfg)
{
	static char *bases[7] = {
		"N/A", "Rear", "Front", "Left", "Right", "Top", "Bottom",
	};
	static unsigned char specials_idx[] = {
		0x07, 0x08,
		0x17, 0x18, 0x19,
		0x37, 0x38
	};
	static char *specials[] = {
		"Rear Panel", "Drive Bar",
		"Riser", "HDMI", "ATAPI",
		"Mobile-In", "Mobile-Out"
	};
	int i;
	cfg = (cfg & AC_DEFCFG_LOCATION) >> AC_DEFCFG_LOCATION_SHIFT;
	if ((cfg & 0x0f) < 7)
		return bases[cfg & 0x0f];
	for (i = 0; i < ARRAY_SIZE(specials_idx); i++) {
		if (cfg == specials_idx[i])
			return specials[i];
	}
	return "UNKNOWN";
}
88
EXPORT_SYMBOL_GPL(snd_hda_get_jack_location);
89

90 91 92 93 94 95 96
/**
 * snd_hda_get_jack_connectivity - Give a connectivity string of the jack
 * @cfg: pin default config value
 *
 * Parse the pin default config value and returns the string of the
 * jack connectivity, i.e. external or internal connection.
 */
97 98 99 100 101 102
const char *snd_hda_get_jack_connectivity(u32 cfg)
{
	static char *jack_locations[4] = { "Ext", "Int", "Sep", "Oth" };

	return jack_locations[(cfg >> (AC_DEFCFG_LOCATION_SHIFT + 4)) & 3];
}
103
EXPORT_SYMBOL_GPL(snd_hda_get_jack_connectivity);
104

105 106 107 108 109 110 111
/**
 * snd_hda_get_jack_type - Give a type string of the jack
 * @cfg: pin default config value
 *
 * Parse the pin default config value and returns the string of the
 * jack type, i.e. the purpose of the jack, such as Line-Out or CD.
 */
112 113 114 115 116 117
const char *snd_hda_get_jack_type(u32 cfg)
{
	static char *jack_types[16] = {
		"Line Out", "Speaker", "HP Out", "CD",
		"SPDIF Out", "Digital Out", "Modem Line", "Modem Hand",
		"Line In", "Aux", "Mic", "Telephony",
118
		"SPDIF In", "Digital In", "Reserved", "Other"
119 120 121 122 123
	};

	return jack_types[(cfg & AC_DEFCFG_DEVICE)
				>> AC_DEFCFG_DEVICE_SHIFT];
}
124
EXPORT_SYMBOL_GPL(snd_hda_get_jack_type);
125

126 127 128 129
/*
 * Send and receive a verb
 */
static int codec_exec_verb(struct hda_codec *codec, unsigned int cmd,
130
			   int flags, unsigned int *res)
131 132
{
	struct hda_bus *bus = codec->bus;
133
	int err;
134

135 136 137
	if (cmd == ~0)
		return -1;

138
 again:
139
	snd_hda_power_up(codec);
140
	mutex_lock(&bus->core.cmd_mutex);
141 142
	if (flags & HDA_RW_NO_RESPONSE_FALLBACK)
		bus->no_response_fallback = 1;
143 144
	err = snd_hdac_bus_exec_verb_unlocked(&bus->core, codec->core.addr,
					      cmd, res);
145
	bus->no_response_fallback = 0;
146
	mutex_unlock(&bus->core.cmd_mutex);
147
	snd_hda_power_down(codec);
148
	if (!codec_in_pm(codec) && res && err < 0 && bus->rirb_error) {
149
		if (bus->response_reset) {
150 151
			codec_dbg(codec,
				  "resetting BUS due to fatal communication error\n");
152 153 154 155 156
			bus->ops.bus_reset(bus);
		}
		goto again;
	}
	/* clear reset-flag when the communication gets recovered */
157
	if (!err || codec_in_pm(codec))
158
		bus->response_reset = 0;
159 160 161
	return err;
}

L
Linus Torvalds 已提交
162 163 164 165
/**
 * snd_hda_codec_read - send a command and get the response
 * @codec: the HDA codec
 * @nid: NID to send the command
166
 * @flags: optional bit flags
L
Linus Torvalds 已提交
167 168 169 170 171 172 173
 * @verb: the verb to send
 * @parm: the parameter for the verb
 *
 * Send a single command and read the corresponding response.
 *
 * Returns the obtained response value, or -1 for an error.
 */
T
Takashi Iwai 已提交
174
unsigned int snd_hda_codec_read(struct hda_codec *codec, hda_nid_t nid,
175
				int flags,
L
Linus Torvalds 已提交
176 177
				unsigned int verb, unsigned int parm)
{
178
	unsigned int cmd = snd_hdac_make_cmd(&codec->core, nid, verb, parm);
179
	unsigned int res;
180
	if (codec_exec_verb(codec, cmd, flags, &res))
181
		return -1;
L
Linus Torvalds 已提交
182 183
	return res;
}
184
EXPORT_SYMBOL_GPL(snd_hda_codec_read);
L
Linus Torvalds 已提交
185 186 187 188 189

/**
 * snd_hda_codec_write - send a single command without waiting for response
 * @codec: the HDA codec
 * @nid: NID to send the command
190
 * @flags: optional bit flags
L
Linus Torvalds 已提交
191 192 193 194 195 196 197
 * @verb: the verb to send
 * @parm: the parameter for the verb
 *
 * Send a single command without waiting for response.
 *
 * Returns 0 if successful, or a negative error code.
 */
198 199
int snd_hda_codec_write(struct hda_codec *codec, hda_nid_t nid, int flags,
			unsigned int verb, unsigned int parm)
L
Linus Torvalds 已提交
200
{
201
	unsigned int cmd = snd_hdac_make_cmd(&codec->core, nid, verb, parm);
202
	return codec_exec_verb(codec, cmd, flags, NULL);
L
Linus Torvalds 已提交
203
}
204
EXPORT_SYMBOL_GPL(snd_hda_codec_write);
L
Linus Torvalds 已提交
205 206 207 208 209 210 211 212 213 214 215 216 217 218

/**
 * snd_hda_sequence_write - sequence writes
 * @codec: the HDA codec
 * @seq: VERB array to send
 *
 * Send the commands sequentially from the given array.
 * The array must be terminated with NID=0.
 */
void snd_hda_sequence_write(struct hda_codec *codec, const struct hda_verb *seq)
{
	for (; seq->nid; seq++)
		snd_hda_codec_write(codec, seq->nid, 0, seq->verb, seq->param);
}
219
EXPORT_SYMBOL_GPL(snd_hda_sequence_write);
L
Linus Torvalds 已提交
220

221 222 223 224 225 226 227 228
/* connection list element */
struct hda_conn_list {
	struct list_head list;
	int len;
	hda_nid_t nid;
	hda_nid_t conns[0];
};

229
/* look up the cached results */
230 231
static struct hda_conn_list *
lookup_conn_list(struct hda_codec *codec, hda_nid_t nid)
232
{
233 234 235
	struct hda_conn_list *p;
	list_for_each_entry(p, &codec->conn_list, list) {
		if (p->nid == nid)
236 237 238 239
			return p;
	}
	return NULL;
}
240

241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265
static int add_conn_list(struct hda_codec *codec, hda_nid_t nid, int len,
			 const hda_nid_t *list)
{
	struct hda_conn_list *p;

	p = kmalloc(sizeof(*p) + len * sizeof(hda_nid_t), GFP_KERNEL);
	if (!p)
		return -ENOMEM;
	p->len = len;
	p->nid = nid;
	memcpy(p->conns, list, len * sizeof(hda_nid_t));
	list_add(&p->list, &codec->conn_list);
	return 0;
}

static void remove_conn_list(struct hda_codec *codec)
{
	while (!list_empty(&codec->conn_list)) {
		struct hda_conn_list *p;
		p = list_first_entry(&codec->conn_list, typeof(*p), list);
		list_del(&p->list);
		kfree(p);
	}
}

266 267 268
/* read the connection and add to the cache */
static int read_and_add_raw_conns(struct hda_codec *codec, hda_nid_t nid)
{
269 270
	hda_nid_t list[32];
	hda_nid_t *result = list;
271 272 273
	int len;

	len = snd_hda_get_raw_connections(codec, nid, list, ARRAY_SIZE(list));
274 275 276 277 278 279 280 281 282 283 284 285
	if (len == -ENOSPC) {
		len = snd_hda_get_num_raw_conns(codec, nid);
		result = kmalloc(sizeof(hda_nid_t) * len, GFP_KERNEL);
		if (!result)
			return -ENOMEM;
		len = snd_hda_get_raw_connections(codec, nid, result, len);
	}
	if (len >= 0)
		len = snd_hda_override_conn_list(codec, nid, len, result);
	if (result != list)
		kfree(result);
	return len;
286 287
}

288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327
/**
 * snd_hda_get_conn_list - get connection list
 * @codec: the HDA codec
 * @nid: NID to parse
 * @listp: the pointer to store NID list
 *
 * Parses the connection list of the given widget and stores the pointer
 * to the list of NIDs.
 *
 * Returns the number of connections, or a negative error code.
 *
 * Note that the returned pointer isn't protected against the list
 * modification.  If snd_hda_override_conn_list() might be called
 * concurrently, protect with a mutex appropriately.
 */
int snd_hda_get_conn_list(struct hda_codec *codec, hda_nid_t nid,
			  const hda_nid_t **listp)
{
	bool added = false;

	for (;;) {
		int err;
		const struct hda_conn_list *p;

		/* if the connection-list is already cached, read it */
		p = lookup_conn_list(codec, nid);
		if (p) {
			if (listp)
				*listp = p->conns;
			return p->len;
		}
		if (snd_BUG_ON(added))
			return -EINVAL;

		err = read_and_add_raw_conns(codec, nid);
		if (err < 0)
			return err;
		added = true;
	}
}
328
EXPORT_SYMBOL_GPL(snd_hda_get_conn_list);
329

L
Linus Torvalds 已提交
330
/**
331
 * snd_hda_get_connections - copy connection list
L
Linus Torvalds 已提交
332 333
 * @codec: the HDA codec
 * @nid: NID to parse
334 335
 * @conn_list: connection list array; when NULL, checks only the size
 * @max_conns: max. number of connections to store
L
Linus Torvalds 已提交
336 337 338 339 340 341
 *
 * Parses the connection list of the given widget and stores the list
 * of NIDs.
 *
 * Returns the number of connections, or a negative error code.
 */
342 343
int snd_hda_get_connections(struct hda_codec *codec, hda_nid_t nid,
			    hda_nid_t *conn_list, int max_conns)
344
{
345 346
	const hda_nid_t *list;
	int len = snd_hda_get_conn_list(codec, nid, &list);
347

348 349
	if (len > 0 && conn_list) {
		if (len > max_conns) {
350
			codec_err(codec, "Too many connections %d for NID 0x%x\n",
351 352 353
				   len, nid);
			return -EINVAL;
		}
354
		memcpy(conn_list, list, len * sizeof(hda_nid_t));
355 356
	}

357
	return len;
358
}
359
EXPORT_SYMBOL_GPL(snd_hda_get_connections);
360

361 362 363 364 365 366 367 368 369 370 371 372 373 374 375
/**
 * snd_hda_override_conn_list - add/modify the connection-list to cache
 * @codec: the HDA codec
 * @nid: NID to parse
 * @len: number of connection list entries
 * @list: the list of connection entries
 *
 * Add or modify the given connection-list to the cache.  If the corresponding
 * cache already exists, invalidate it and append a new one.
 *
 * Returns zero or a negative error code.
 */
int snd_hda_override_conn_list(struct hda_codec *codec, hda_nid_t nid, int len,
			       const hda_nid_t *list)
{
376
	struct hda_conn_list *p;
377

378 379 380 381 382
	p = lookup_conn_list(codec, nid);
	if (p) {
		list_del(&p->list);
		kfree(p);
	}
383

384
	return add_conn_list(codec, nid, len, list);
385
}
386
EXPORT_SYMBOL_GPL(snd_hda_override_conn_list);
387

388 389 390 391 392 393 394 395 396 397 398 399 400
/**
 * snd_hda_get_conn_index - get the connection index of the given NID
 * @codec: the HDA codec
 * @mux: NID containing the list
 * @nid: NID to select
 * @recursive: 1 when searching NID recursively, otherwise 0
 *
 * Parses the connection list of the widget @mux and checks whether the
 * widget @nid is present.  If it is, return the connection index.
 * Otherwise it returns -1.
 */
int snd_hda_get_conn_index(struct hda_codec *codec, hda_nid_t mux,
			   hda_nid_t nid, int recursive)
401
{
402
	const hda_nid_t *conn;
403 404
	int i, nums;

405
	nums = snd_hda_get_conn_list(codec, mux, &conn);
406 407 408 409 410
	for (i = 0; i < nums; i++)
		if (conn[i] == nid)
			return i;
	if (!recursive)
		return -1;
411
	if (recursive > 10) {
412
		codec_dbg(codec, "too deep connection for 0x%x\n", nid);
413
		return -1;
414
	}
415
	recursive++;
416 417 418 419
	for (i = 0; i < nums; i++) {
		unsigned int type = get_wcaps_type(get_wcaps(codec, conn[i]));
		if (type == AC_WID_PIN || type == AC_WID_AUD_OUT)
			continue;
420 421
		if (snd_hda_get_conn_index(codec, conn[i], nid, recursive) >= 0)
			return i;
422
	}
423
	return -1;
424
}
425
EXPORT_SYMBOL_GPL(snd_hda_get_conn_index);
L
Linus Torvalds 已提交
426

427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484

/* return DEVLIST_LEN parameter of the given widget */
static unsigned int get_num_devices(struct hda_codec *codec, hda_nid_t nid)
{
	unsigned int wcaps = get_wcaps(codec, nid);
	unsigned int parm;

	if (!codec->dp_mst || !(wcaps & AC_WCAP_DIGITAL) ||
	    get_wcaps_type(wcaps) != AC_WID_PIN)
		return 0;

	parm = snd_hda_param_read(codec, nid, AC_PAR_DEVLIST_LEN);
	if (parm == -1 && codec->bus->rirb_error)
		parm = 0;
	return parm & AC_DEV_LIST_LEN_MASK;
}

/**
 * snd_hda_get_devices - copy device list without cache
 * @codec: the HDA codec
 * @nid: NID of the pin to parse
 * @dev_list: device list array
 * @max_devices: max. number of devices to store
 *
 * Copy the device list. This info is dynamic and so not cached.
 * Currently called only from hda_proc.c, so not exported.
 */
int snd_hda_get_devices(struct hda_codec *codec, hda_nid_t nid,
			u8 *dev_list, int max_devices)
{
	unsigned int parm;
	int i, dev_len, devices;

	parm = get_num_devices(codec, nid);
	if (!parm)	/* not multi-stream capable */
		return 0;

	dev_len = parm + 1;
	dev_len = dev_len < max_devices ? dev_len : max_devices;

	devices = 0;
	while (devices < dev_len) {
		parm = snd_hda_codec_read(codec, nid, 0,
					  AC_VERB_GET_DEVICE_LIST, devices);
		if (parm == -1 && codec->bus->rirb_error)
			break;

		for (i = 0; i < 8; i++) {
			dev_list[devices] = (u8)parm;
			parm >>= 4;
			devices++;
			if (devices >= dev_len)
				break;
		}
	}
	return devices;
}

L
Linus Torvalds 已提交
485 486 487
/*
 * destructor
 */
488
static void snd_hda_bus_free(struct hda_bus *bus)
L
Linus Torvalds 已提交
489
{
T
Takashi Iwai 已提交
490
	if (!bus)
491
		return;
L
Linus Torvalds 已提交
492 493
	if (bus->ops.private_free)
		bus->ops.private_free(bus);
494
	snd_hdac_bus_exit(&bus->core);
L
Linus Torvalds 已提交
495 496 497
	kfree(bus);
}

498
static int snd_hda_bus_dev_free(struct snd_device *device)
499 500 501 502 503 504
{
	snd_hda_bus_free(device->device_data);
	return 0;
}

static int snd_hda_bus_dev_disconnect(struct snd_device *device)
L
Linus Torvalds 已提交
505 506
{
	struct hda_bus *bus = device->device_data;
507
	bus->shutdown = 1;
508
	return 0;
L
Linus Torvalds 已提交
509 510
}

511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530
/* hdac_bus_ops translations */
static int _hda_bus_command(struct hdac_bus *_bus, unsigned int cmd)
{
	struct hda_bus *bus = container_of(_bus, struct hda_bus, core);
	return bus->ops.command(bus, cmd);
}

static int _hda_bus_get_response(struct hdac_bus *_bus, unsigned int addr,
				 unsigned int *res)
{
	struct hda_bus *bus = container_of(_bus, struct hda_bus, core);
	*res = bus->ops.get_response(bus, addr);
	return bus->rirb_error ? -EIO : 0;
}

static const struct hdac_bus_ops bus_ops = {
	.command = _hda_bus_command,
	.get_response = _hda_bus_get_response,
};

L
Linus Torvalds 已提交
531 532 533 534 535 536 537
/**
 * snd_hda_bus_new - create a HDA bus
 * @card: the card entry
 * @busp: the pointer to store the created bus instance
 *
 * Returns 0 if successful, or a negative error code.
 */
538
int snd_hda_bus_new(struct snd_card *card,
539
		    struct hda_bus **busp)
L
Linus Torvalds 已提交
540 541 542
{
	struct hda_bus *bus;
	int err;
543
	static struct snd_device_ops dev_ops = {
544
		.dev_disconnect = snd_hda_bus_dev_disconnect,
L
Linus Torvalds 已提交
545 546 547 548 549 550
		.dev_free = snd_hda_bus_dev_free,
	};

	if (busp)
		*busp = NULL;

551
	bus = kzalloc(sizeof(*bus), GFP_KERNEL);
552
	if (!bus)
L
Linus Torvalds 已提交
553 554
		return -ENOMEM;

555 556 557 558 559 560
	err = snd_hdac_bus_init(&bus->core, card->dev, &bus_ops);
	if (err < 0) {
		kfree(bus);
		return err;
	}

L
Linus Torvalds 已提交
561
	bus->card = card;
562
	mutex_init(&bus->prepare_mutex);
L
Linus Torvalds 已提交
563

T
Takashi Iwai 已提交
564 565
	err = snd_device_new(card, SNDRV_DEV_BUS, bus, &dev_ops);
	if (err < 0) {
L
Linus Torvalds 已提交
566 567 568 569 570 571 572
		snd_hda_bus_free(bus);
		return err;
	}
	if (busp)
		*busp = bus;
	return 0;
}
573
EXPORT_SYMBOL_GPL(snd_hda_bus_new);
L
Linus Torvalds 已提交
574

575 576 577 578 579 580 581 582
/*
 * read widget caps for each widget and store in cache
 */
static int read_widget_caps(struct hda_codec *codec, hda_nid_t fg_node)
{
	int i;
	hda_nid_t nid;

583
	codec->wcaps = kmalloc(codec->core.num_nodes * 4, GFP_KERNEL);
T
Takashi Iwai 已提交
584
	if (!codec->wcaps)
585
		return -ENOMEM;
586 587
	nid = codec->core.start_nid;
	for (i = 0; i < codec->core.num_nodes; i++, nid++)
588 589 590 591 592
		codec->wcaps[i] = snd_hda_param_read(codec, nid,
						     AC_PAR_AUDIO_WIDGET_CAP);
	return 0;
}

593 594 595
/* read all pin default configurations and save codec->init_pins */
static int read_pin_defaults(struct hda_codec *codec)
{
596
	hda_nid_t nid;
597

598
	for_each_hda_codec_node(nid, codec) {
599 600
		struct hda_pincfg *pin;
		unsigned int wcaps = get_wcaps(codec, nid);
601
		unsigned int wid_type = get_wcaps_type(wcaps);
602 603 604 605 606 607 608 609
		if (wid_type != AC_WID_PIN)
			continue;
		pin = snd_array_new(&codec->init_pins);
		if (!pin)
			return -ENOMEM;
		pin->nid = nid;
		pin->cfg = snd_hda_codec_read(codec, nid, 0,
					      AC_VERB_GET_CONFIG_DEFAULT, 0);
610 611 612
		pin->ctrl = snd_hda_codec_read(codec, nid, 0,
					       AC_VERB_GET_PIN_WIDGET_CONTROL,
					       0);
613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638
	}
	return 0;
}

/* look up the given pin config list and return the item matching with NID */
static struct hda_pincfg *look_up_pincfg(struct hda_codec *codec,
					 struct snd_array *array,
					 hda_nid_t nid)
{
	int i;
	for (i = 0; i < array->used; i++) {
		struct hda_pincfg *pin = snd_array_elem(array, i);
		if (pin->nid == nid)
			return pin;
	}
	return NULL;
}

/* set the current pin config value for the given NID.
 * the value is cached, and read via snd_hda_codec_get_pincfg()
 */
int snd_hda_add_pincfg(struct hda_codec *codec, struct snd_array *list,
		       hda_nid_t nid, unsigned int cfg)
{
	struct hda_pincfg *pin;

639 640 641 642 643
	/* the check below may be invalid when pins are added by a fixup
	 * dynamically (e.g. via snd_hda_codec_update_widgets()), so disabled
	 * for now
	 */
	/*
644 645
	if (get_wcaps_type(get_wcaps(codec, nid)) != AC_WID_PIN)
		return -EINVAL;
646
	*/
647

648 649 650 651 652 653 654 655 656 657 658
	pin = look_up_pincfg(codec, list, nid);
	if (!pin) {
		pin = snd_array_new(list);
		if (!pin)
			return -ENOMEM;
		pin->nid = nid;
	}
	pin->cfg = cfg;
	return 0;
}

659 660 661 662 663 664 665 666 667 668
/**
 * snd_hda_codec_set_pincfg - Override a pin default configuration
 * @codec: the HDA codec
 * @nid: NID to set the pin config
 * @cfg: the pin default config value
 *
 * Override a pin default configuration value in the cache.
 * This value can be read by snd_hda_codec_get_pincfg() in a higher
 * priority than the real hardware value.
 */
669 670 671
int snd_hda_codec_set_pincfg(struct hda_codec *codec,
			     hda_nid_t nid, unsigned int cfg)
{
672
	return snd_hda_add_pincfg(codec, &codec->driver_pins, nid, cfg);
673
}
674
EXPORT_SYMBOL_GPL(snd_hda_codec_set_pincfg);
675

676 677 678 679 680 681 682 683 684
/**
 * snd_hda_codec_get_pincfg - Obtain a pin-default configuration
 * @codec: the HDA codec
 * @nid: NID to get the pin config
 *
 * Get the current pin config value of the given pin NID.
 * If the pincfg value is cached or overridden via sysfs or driver,
 * returns the cached value.
 */
685 686 687 688
unsigned int snd_hda_codec_get_pincfg(struct hda_codec *codec, hda_nid_t nid)
{
	struct hda_pincfg *pin;

689
#ifdef CONFIG_SND_HDA_RECONFIG
690 691 692 693 694 695 696 697 698 699
	{
		unsigned int cfg = 0;
		mutex_lock(&codec->user_mutex);
		pin = look_up_pincfg(codec, &codec->user_pins, nid);
		if (pin)
			cfg = pin->cfg;
		mutex_unlock(&codec->user_mutex);
		if (cfg)
			return cfg;
	}
700
#endif
701 702 703
	pin = look_up_pincfg(codec, &codec->driver_pins, nid);
	if (pin)
		return pin->cfg;
704 705 706 707 708
	pin = look_up_pincfg(codec, &codec->init_pins, nid);
	if (pin)
		return pin->cfg;
	return 0;
}
709
EXPORT_SYMBOL_GPL(snd_hda_codec_get_pincfg);
710

T
Takashi Iwai 已提交
711 712 713 714 715 716 717 718 719 720
/**
 * snd_hda_codec_set_pin_target - remember the current pinctl target value
 * @codec: the HDA codec
 * @nid: pin NID
 * @val: assigned pinctl value
 *
 * This function stores the given value to a pinctl target value in the
 * pincfg table.  This isn't always as same as the actually written value
 * but can be referred at any time via snd_hda_codec_get_pin_target().
 */
721 722 723 724 725 726 727 728 729 730 731
int snd_hda_codec_set_pin_target(struct hda_codec *codec, hda_nid_t nid,
				 unsigned int val)
{
	struct hda_pincfg *pin;

	pin = look_up_pincfg(codec, &codec->init_pins, nid);
	if (!pin)
		return -EINVAL;
	pin->target = val;
	return 0;
}
732
EXPORT_SYMBOL_GPL(snd_hda_codec_set_pin_target);
733

T
Takashi Iwai 已提交
734 735 736 737 738
/**
 * snd_hda_codec_get_pin_target - return the current pinctl target value
 * @codec: the HDA codec
 * @nid: pin NID
 */
739 740 741 742 743 744 745 746 747
int snd_hda_codec_get_pin_target(struct hda_codec *codec, hda_nid_t nid)
{
	struct hda_pincfg *pin;

	pin = look_up_pincfg(codec, &codec->init_pins, nid);
	if (!pin)
		return 0;
	return pin->target;
}
748
EXPORT_SYMBOL_GPL(snd_hda_codec_get_pin_target);
749

750 751 752 753 754 755 756 757 758 759
/**
 * snd_hda_shutup_pins - Shut up all pins
 * @codec: the HDA codec
 *
 * Clear all pin controls to shup up before suspend for avoiding click noise.
 * The controls aren't cached so that they can be resumed properly.
 */
void snd_hda_shutup_pins(struct hda_codec *codec)
{
	int i;
760 761 762 763 764
	/* don't shut up pins when unloading the driver; otherwise it breaks
	 * the default pin setup at the next load of the driver
	 */
	if (codec->bus->shutdown)
		return;
765 766 767 768 769 770
	for (i = 0; i < codec->init_pins.used; i++) {
		struct hda_pincfg *pin = snd_array_elem(&codec->init_pins, i);
		/* use read here for syncing after issuing each verb */
		snd_hda_codec_read(codec, pin->nid, 0,
				   AC_VERB_SET_PIN_WIDGET_CONTROL, 0);
	}
771
	codec->pins_shutup = 1;
772
}
773
EXPORT_SYMBOL_GPL(snd_hda_shutup_pins);
774

775
#ifdef CONFIG_PM
776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791
/* Restore the pin controls cleared previously via snd_hda_shutup_pins() */
static void restore_shutup_pins(struct hda_codec *codec)
{
	int i;
	if (!codec->pins_shutup)
		return;
	if (codec->bus->shutdown)
		return;
	for (i = 0; i < codec->init_pins.used; i++) {
		struct hda_pincfg *pin = snd_array_elem(&codec->init_pins, i);
		snd_hda_codec_write(codec, pin->nid, 0,
				    AC_VERB_SET_PIN_WIDGET_CONTROL,
				    pin->ctrl);
	}
	codec->pins_shutup = 0;
}
792
#endif
793

794 795 796 797 798 799 800
static void hda_jackpoll_work(struct work_struct *work)
{
	struct hda_codec *codec =
		container_of(work, struct hda_codec, jackpoll_work.work);

	snd_hda_jack_set_dirty_all(codec);
	snd_hda_jack_poll_all(codec);
801 802 803 804

	if (!codec->jackpoll_interval)
		return;

805 806
	schedule_delayed_work(&codec->jackpoll_work,
			      codec->jackpoll_interval);
807 808
}

809 810
static void init_hda_cache(struct hda_cache_rec *cache,
			   unsigned int record_size);
811
static void free_hda_cache(struct hda_cache_rec *cache);
812

813 814
/* release all pincfg lists */
static void free_init_pincfgs(struct hda_codec *codec)
815
{
816
	snd_array_free(&codec->driver_pins);
817
#ifdef CONFIG_SND_HDA_RECONFIG
818
	snd_array_free(&codec->user_pins);
819 820 821 822
#endif
	snd_array_free(&codec->init_pins);
}

823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852
/*
 * audio-converter setup caches
 */
struct hda_cvt_setup {
	hda_nid_t nid;
	u8 stream_tag;
	u8 channel_id;
	u16 format_id;
	unsigned char active;	/* cvt is currently used */
	unsigned char dirty;	/* setups should be cleared */
};

/* get or create a cache entry for the given audio converter NID */
static struct hda_cvt_setup *
get_hda_cvt_setup(struct hda_codec *codec, hda_nid_t nid)
{
	struct hda_cvt_setup *p;
	int i;

	for (i = 0; i < codec->cvt_setups.used; i++) {
		p = snd_array_elem(&codec->cvt_setups, i);
		if (p->nid == nid)
			return p;
	}
	p = snd_array_new(&codec->cvt_setups);
	if (p)
		p->nid = nid;
	return p;
}

853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896
/*
 * PCM device
 */
static void release_pcm(struct kref *kref)
{
	struct hda_pcm *pcm = container_of(kref, struct hda_pcm, kref);

	if (pcm->pcm)
		snd_device_free(pcm->codec->card, pcm->pcm);
	clear_bit(pcm->device, pcm->codec->bus->pcm_dev_bits);
	kfree(pcm->name);
	kfree(pcm);
}

void snd_hda_codec_pcm_put(struct hda_pcm *pcm)
{
	kref_put(&pcm->kref, release_pcm);
}
EXPORT_SYMBOL_GPL(snd_hda_codec_pcm_put);

struct hda_pcm *snd_hda_codec_pcm_new(struct hda_codec *codec,
				      const char *fmt, ...)
{
	struct hda_pcm *pcm;
	va_list args;

	va_start(args, fmt);
	pcm = kzalloc(sizeof(*pcm), GFP_KERNEL);
	if (!pcm)
		return NULL;

	pcm->codec = codec;
	kref_init(&pcm->kref);
	pcm->name = kvasprintf(GFP_KERNEL, fmt, args);
	if (!pcm->name) {
		kfree(pcm);
		return NULL;
	}

	list_add_tail(&pcm->list, &codec->pcm_list_head);
	return pcm;
}
EXPORT_SYMBOL_GPL(snd_hda_codec_pcm_new);

897 898 899
/*
 * codec destructor
 */
900 901 902 903 904 905
static void codec_release_pcms(struct hda_codec *codec)
{
	struct hda_pcm *pcm, *n;

	list_for_each_entry_safe(pcm, n, &codec->pcm_list_head, list) {
		list_del_init(&pcm->list);
906 907
		if (pcm->pcm)
			snd_device_disconnect(codec->card, pcm->pcm);
908 909 910 911
		snd_hda_codec_pcm_put(pcm);
	}
}

912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941
void snd_hda_codec_cleanup_for_unbind(struct hda_codec *codec)
{
	cancel_delayed_work_sync(&codec->jackpoll_work);
	if (!codec->in_freeing)
		snd_hda_ctls_clear(codec);
	codec_release_pcms(codec);
	snd_hda_detach_beep_device(codec);
	memset(&codec->patch_ops, 0, sizeof(codec->patch_ops));
	snd_hda_jack_tbl_clear(codec);
	codec->proc_widget_hook = NULL;
	codec->spec = NULL;

	free_hda_cache(&codec->amp_cache);
	free_hda_cache(&codec->cmd_cache);
	init_hda_cache(&codec->amp_cache, sizeof(struct hda_amp_info));
	init_hda_cache(&codec->cmd_cache, sizeof(struct hda_cache_head));

	/* free only driver_pins so that init_pins + user_pins are restored */
	snd_array_free(&codec->driver_pins);
	snd_array_free(&codec->cvt_setups);
	snd_array_free(&codec->spdif_out);
	snd_array_free(&codec->verbs);
	codec->preset = NULL;
	codec->slave_dig_outs = NULL;
	codec->spdif_status_reset = 0;
	snd_array_free(&codec->mixers);
	snd_array_free(&codec->nids);
	remove_conn_list(codec);
}

942
static unsigned int hda_set_power_state(struct hda_codec *codec,
943 944
				unsigned int power_state);

945 946 947 948
static int snd_hda_codec_dev_register(struct snd_device *device)
{
	struct hda_codec *codec = device->device_data;

949
	snd_hda_register_beep_device(codec);
950
	if (device_is_registered(hda_codec_dev(codec)))
951
		pm_runtime_enable(hda_codec_dev(codec));
952 953
	/* it was powered up in snd_hda_codec_new(), now all done */
	snd_hda_power_down(codec);
954
	return 0;
955 956 957 958 959 960
}

static int snd_hda_codec_dev_disconnect(struct snd_device *device)
{
	struct hda_codec *codec = device->device_data;

961
	snd_hda_detach_beep_device(codec);
962 963 964
	return 0;
}

965 966
static int snd_hda_codec_dev_free(struct snd_device *device)
{
967 968 969
	struct hda_codec *codec = device->device_data;

	codec->in_freeing = 1;
T
Takashi Iwai 已提交
970
	snd_hdac_device_unregister(&codec->core);
971
	put_device(hda_codec_dev(codec));
972 973 974
	return 0;
}

975 976
static void snd_hda_codec_dev_release(struct device *dev)
{
977 978 979
	struct hda_codec *codec = dev_to_hda_codec(dev);

	free_init_pincfgs(codec);
980
	snd_hdac_device_exit(&codec->core);
981 982 983 984 985 986
	snd_hda_sysfs_clear(codec);
	free_hda_cache(&codec->amp_cache);
	free_hda_cache(&codec->cmd_cache);
	kfree(codec->modelname);
	kfree(codec->wcaps);
	kfree(codec);
987 988
}

L
Linus Torvalds 已提交
989 990 991 992 993 994 995 996
/**
 * snd_hda_codec_new - create a HDA codec
 * @bus: the bus to assign
 * @codec_addr: the codec address
 * @codecp: the pointer to store the generated codec
 *
 * Returns 0 if successful, or a negative error code.
 */
997 998
int snd_hda_codec_new(struct hda_bus *bus, struct snd_card *card,
		      unsigned int codec_addr, struct hda_codec **codecp)
L
Linus Torvalds 已提交
999 1000
{
	struct hda_codec *codec;
1001
	char component[31];
1002
	hda_nid_t fg;
L
Linus Torvalds 已提交
1003
	int err;
1004
	static struct snd_device_ops dev_ops = {
1005 1006
		.dev_register = snd_hda_codec_dev_register,
		.dev_disconnect = snd_hda_codec_dev_disconnect,
1007 1008
		.dev_free = snd_hda_codec_dev_free,
	};
L
Linus Torvalds 已提交
1009

1010 1011 1012 1013
	if (snd_BUG_ON(!bus))
		return -EINVAL;
	if (snd_BUG_ON(codec_addr > HDA_MAX_CODEC_ADDRESS))
		return -EINVAL;
L
Linus Torvalds 已提交
1014

1015
	codec = kzalloc(sizeof(*codec), GFP_KERNEL);
1016
	if (!codec)
L
Linus Torvalds 已提交
1017 1018
		return -ENOMEM;

1019 1020 1021 1022 1023 1024 1025
	sprintf(component, "hdaudioC%dD%d", card->number, codec_addr);
	err = snd_hdac_device_init(&codec->core, &bus->core, component,
				   codec_addr);
	if (err < 0) {
		kfree(codec);
		return err;
	}
1026

1027 1028
	codec->core.dev.release = snd_hda_codec_dev_release;
	codec->core.type = HDA_DEV_LEGACY;
1029

L
Linus Torvalds 已提交
1030
	codec->bus = bus;
1031
	codec->card = card;
L
Linus Torvalds 已提交
1032
	codec->addr = codec_addr;
1033
	mutex_init(&codec->spdif_mutex);
1034
	mutex_init(&codec->control_mutex);
1035
	mutex_init(&codec->hash_mutex);
1036
	init_hda_cache(&codec->amp_cache, sizeof(struct hda_amp_info));
1037
	init_hda_cache(&codec->cmd_cache, sizeof(struct hda_cache_head));
1038 1039
	snd_array_init(&codec->mixers, sizeof(struct hda_nid_item), 32);
	snd_array_init(&codec->nids, sizeof(struct hda_nid_item), 32);
1040
	snd_array_init(&codec->init_pins, sizeof(struct hda_pincfg), 16);
1041
	snd_array_init(&codec->driver_pins, sizeof(struct hda_pincfg), 16);
1042
	snd_array_init(&codec->cvt_setups, sizeof(struct hda_cvt_setup), 8);
1043
	snd_array_init(&codec->spdif_out, sizeof(struct hda_spdif_out), 16);
1044
	snd_array_init(&codec->jacktbl, sizeof(struct hda_jack_tbl), 16);
1045
	snd_array_init(&codec->verbs, sizeof(struct hda_verb *), 8);
1046
	INIT_LIST_HEAD(&codec->conn_list);
1047
	INIT_LIST_HEAD(&codec->pcm_list_head);
1048

1049
	INIT_DELAYED_WORK(&codec->jackpoll_work, hda_jackpoll_work);
1050
	codec->depop_delay = -1;
1051
	codec->fixup_id = HDA_FIXUP_ID_NOT_SET;
L
Linus Torvalds 已提交
1052

1053
#ifdef CONFIG_PM
1054
	codec->power_jiffies = jiffies;
1055 1056
#endif

1057 1058
	snd_hda_sysfs_init(codec);

1059 1060 1061
	if (codec->bus->modelname) {
		codec->modelname = kstrdup(codec->bus->modelname, GFP_KERNEL);
		if (!codec->modelname) {
1062 1063
			err = -ENODEV;
			goto error;
1064 1065 1066
		}
	}

1067
	fg = codec->core.afg ? codec->core.afg : codec->core.mfg;
1068
	err = read_widget_caps(codec, fg);
1069
	if (err < 0)
1070 1071 1072 1073
		goto error;
	err = read_pin_defaults(codec);
	if (err < 0)
		goto error;
1074

1075
	/* power-up all before initialization */
1076
	hda_set_power_state(codec, AC_PWRST_D0);
1077

1078 1079 1080 1081
	snd_hda_codec_proc_new(codec);

	snd_hda_create_hwdep(codec);

1082 1083
	sprintf(component, "HDA:%08x,%08x,%08x", codec->core.vendor_id,
		codec->core.subsystem_id, codec->core.revision_id);
1084
	snd_component_add(card, component);
1085

1086
	err = snd_device_new(card, SNDRV_DEV_CODEC, codec, &dev_ops);
1087 1088 1089
	if (err < 0)
		goto error;

1090 1091 1092
	if (codecp)
		*codecp = codec;
	return 0;
1093 1094

 error:
1095
	pm_runtime_put_noidle(hda_codec_dev(codec));
1096
	put_device(hda_codec_dev(codec));
1097
	return err;
1098
}
1099
EXPORT_SYMBOL_GPL(snd_hda_codec_new);
1100

T
Takashi Iwai 已提交
1101 1102 1103 1104 1105 1106 1107
/**
 * snd_hda_codec_update_widgets - Refresh widget caps and pin defaults
 * @codec: the HDA codec
 *
 * Forcibly refresh the all widget caps and the init pin configurations of
 * the given codec.
 */
1108 1109 1110 1111 1112
int snd_hda_codec_update_widgets(struct hda_codec *codec)
{
	hda_nid_t fg;
	int err;

1113 1114 1115 1116
	err = snd_hdac_refresh_widgets(&codec->core);
	if (err < 0)
		return err;

1117 1118 1119 1120
	/* Assume the function group node does not change,
	 * only the widget nodes may change.
	 */
	kfree(codec->wcaps);
1121
	fg = codec->core.afg ? codec->core.afg : codec->core.mfg;
1122
	err = read_widget_caps(codec, fg);
1123
	if (err < 0)
1124 1125 1126 1127 1128 1129 1130
		return err;

	snd_array_free(&codec->init_pins);
	err = read_pin_defaults(codec);

	return err;
}
1131
EXPORT_SYMBOL_GPL(snd_hda_codec_update_widgets);
1132

1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170
/* update the stream-id if changed */
static void update_pcm_stream_id(struct hda_codec *codec,
				 struct hda_cvt_setup *p, hda_nid_t nid,
				 u32 stream_tag, int channel_id)
{
	unsigned int oldval, newval;

	if (p->stream_tag != stream_tag || p->channel_id != channel_id) {
		oldval = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_CONV, 0);
		newval = (stream_tag << 4) | channel_id;
		if (oldval != newval)
			snd_hda_codec_write(codec, nid, 0,
					    AC_VERB_SET_CHANNEL_STREAMID,
					    newval);
		p->stream_tag = stream_tag;
		p->channel_id = channel_id;
	}
}

/* update the format-id if changed */
static void update_pcm_format(struct hda_codec *codec, struct hda_cvt_setup *p,
			      hda_nid_t nid, int format)
{
	unsigned int oldval;

	if (p->format_id != format) {
		oldval = snd_hda_codec_read(codec, nid, 0,
					    AC_VERB_GET_STREAM_FORMAT, 0);
		if (oldval != format) {
			msleep(1);
			snd_hda_codec_write(codec, nid, 0,
					    AC_VERB_SET_STREAM_FORMAT,
					    format);
		}
		p->format_id = format;
	}
}

L
Linus Torvalds 已提交
1171 1172 1173 1174 1175 1176 1177 1178
/**
 * snd_hda_codec_setup_stream - set up the codec for streaming
 * @codec: the CODEC to set up
 * @nid: the NID to set up
 * @stream_tag: stream tag to pass, it's between 0x1 and 0xf.
 * @channel_id: channel id to pass, zero based.
 * @format: stream format.
 */
T
Takashi Iwai 已提交
1179 1180
void snd_hda_codec_setup_stream(struct hda_codec *codec, hda_nid_t nid,
				u32 stream_tag,
L
Linus Torvalds 已提交
1181 1182
				int channel_id, int format)
{
1183
	struct hda_codec *c;
1184
	struct hda_cvt_setup *p;
1185
	int type;
1186 1187
	int i;

T
Takashi Iwai 已提交
1188
	if (!nid)
1189 1190
		return;

1191 1192 1193
	codec_dbg(codec,
		  "hda_codec_setup_stream: NID=0x%x, stream=0x%x, channel=%d, format=0x%x\n",
		  nid, stream_tag, channel_id, format);
1194
	p = get_hda_cvt_setup(codec, nid);
1195
	if (!p)
1196
		return;
1197

1198 1199
	if (codec->patch_ops.stream_pm)
		codec->patch_ops.stream_pm(codec, nid, true);
1200 1201 1202 1203 1204 1205
	if (codec->pcm_format_first)
		update_pcm_format(codec, p, nid, format);
	update_pcm_stream_id(codec, p, nid, stream_tag, channel_id);
	if (!codec->pcm_format_first)
		update_pcm_format(codec, p, nid, format);

1206 1207 1208 1209
	p->active = 1;
	p->dirty = 0;

	/* make other inactive cvts with the same stream-tag dirty */
1210
	type = get_wcaps_type(get_wcaps(codec, nid));
1211
	list_for_each_codec(c, codec->bus) {
1212 1213
		for (i = 0; i < c->cvt_setups.used; i++) {
			p = snd_array_elem(&c->cvt_setups, i);
1214
			if (!p->active && p->stream_tag == stream_tag &&
1215
			    get_wcaps_type(get_wcaps(c, p->nid)) == type)
1216 1217
				p->dirty = 1;
		}
1218
	}
L
Linus Torvalds 已提交
1219
}
1220
EXPORT_SYMBOL_GPL(snd_hda_codec_setup_stream);
L
Linus Torvalds 已提交
1221

1222 1223 1224
static void really_cleanup_stream(struct hda_codec *codec,
				  struct hda_cvt_setup *q);

1225
/**
1226
 * __snd_hda_codec_cleanup_stream - clean up the codec for closing
1227 1228
 * @codec: the CODEC to clean up
 * @nid: the NID to clean up
1229
 * @do_now: really clean up the stream instead of clearing the active flag
1230
 */
1231 1232
void __snd_hda_codec_cleanup_stream(struct hda_codec *codec, hda_nid_t nid,
				    int do_now)
1233
{
1234 1235
	struct hda_cvt_setup *p;

1236 1237 1238
	if (!nid)
		return;

1239 1240 1241
	if (codec->no_sticky_stream)
		do_now = 1;

1242
	codec_dbg(codec, "hda_codec_cleanup_stream: NID=0x%x\n", nid);
1243
	p = get_hda_cvt_setup(codec, nid);
1244
	if (p) {
1245 1246 1247 1248 1249 1250 1251 1252 1253
		/* here we just clear the active flag when do_now isn't set;
		 * actual clean-ups will be done later in
		 * purify_inactive_streams() called from snd_hda_codec_prpapre()
		 */
		if (do_now)
			really_cleanup_stream(codec, p);
		else
			p->active = 0;
	}
1254
}
1255
EXPORT_SYMBOL_GPL(__snd_hda_codec_cleanup_stream);
1256 1257 1258 1259 1260

static void really_cleanup_stream(struct hda_codec *codec,
				  struct hda_cvt_setup *q)
{
	hda_nid_t nid = q->nid;
1261 1262 1263 1264 1265
	if (q->stream_tag || q->channel_id)
		snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID, 0);
	if (q->format_id)
		snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, 0
);
1266 1267
	memset(q, 0, sizeof(*q));
	q->nid = nid;
1268 1269
	if (codec->patch_ops.stream_pm)
		codec->patch_ops.stream_pm(codec, nid, false);
1270 1271 1272 1273 1274
}

/* clean up the all conflicting obsolete streams */
static void purify_inactive_streams(struct hda_codec *codec)
{
1275
	struct hda_codec *c;
1276 1277
	int i;

1278
	list_for_each_codec(c, codec->bus) {
1279 1280 1281 1282 1283 1284
		for (i = 0; i < c->cvt_setups.used; i++) {
			struct hda_cvt_setup *p;
			p = snd_array_elem(&c->cvt_setups, i);
			if (p->dirty)
				really_cleanup_stream(c, p);
		}
1285 1286 1287
	}
}

1288
#ifdef CONFIG_PM
1289 1290 1291 1292 1293 1294 1295 1296 1297 1298
/* clean up all streams; called from suspend */
static void hda_cleanup_all_streams(struct hda_codec *codec)
{
	int i;

	for (i = 0; i < codec->cvt_setups.used; i++) {
		struct hda_cvt_setup *p = snd_array_elem(&codec->cvt_setups, i);
		if (p->stream_tag)
			really_cleanup_stream(codec, p);
	}
1299
}
1300
#endif
1301

L
Linus Torvalds 已提交
1302 1303 1304 1305
/*
 * amp access functions
 */

1306
/* FIXME: more better hash key? */
1307
#define HDA_HASH_KEY(nid, dir, idx) (u32)((nid) + ((idx) << 16) + ((dir) << 24))
T
Takashi Iwai 已提交
1308
#define HDA_HASH_PINCAP_KEY(nid) (u32)((nid) + (0x02 << 24))
1309 1310
#define HDA_HASH_PARPCM_KEY(nid) (u32)((nid) + (0x03 << 24))
#define HDA_HASH_PARSTR_KEY(nid) (u32)((nid) + (0x04 << 24))
L
Linus Torvalds 已提交
1311
#define INFO_AMP_CAPS	(1<<0)
1312
#define INFO_AMP_VOL(ch)	(1 << (1 + (ch)))
L
Linus Torvalds 已提交
1313 1314

/* initialize the hash table */
1315
static void init_hda_cache(struct hda_cache_rec *cache,
1316 1317 1318 1319
				     unsigned int record_size)
{
	memset(cache, 0, sizeof(*cache));
	memset(cache->hash, 0xff, sizeof(cache->hash));
1320
	snd_array_init(&cache->buf, record_size, 64);
1321 1322
}

1323
static void free_hda_cache(struct hda_cache_rec *cache)
L
Linus Torvalds 已提交
1324
{
1325
	snd_array_free(&cache->buf);
L
Linus Torvalds 已提交
1326 1327 1328
}

/* query the hash.  allocate an entry if not found. */
1329
static struct hda_cache_head  *get_hash(struct hda_cache_rec *cache, u32 key)
L
Linus Torvalds 已提交
1330
{
1331 1332 1333
	u16 idx = key % (u16)ARRAY_SIZE(cache->hash);
	u16 cur = cache->hash[idx];
	struct hda_cache_head *info;
L
Linus Torvalds 已提交
1334 1335

	while (cur != 0xffff) {
1336
		info = snd_array_elem(&cache->buf, cur);
L
Linus Torvalds 已提交
1337 1338 1339 1340
		if (info->key == key)
			return info;
		cur = info->next;
	}
1341 1342
	return NULL;
}
L
Linus Torvalds 已提交
1343

1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357
/* query the hash.  allocate an entry if not found. */
static struct hda_cache_head  *get_alloc_hash(struct hda_cache_rec *cache,
					      u32 key)
{
	struct hda_cache_head *info = get_hash(cache, key);
	if (!info) {
		u16 idx, cur;
		/* add a new hash entry */
		info = snd_array_new(&cache->buf);
		if (!info)
			return NULL;
		cur = snd_array_index(&cache->buf, info);
		info->key = key;
		info->val = 0;
1358
		info->dirty = 0;
1359 1360 1361 1362
		idx = key % (u16)ARRAY_SIZE(cache->hash);
		info->next = cache->hash[idx];
		cache->hash[idx] = cur;
	}
L
Linus Torvalds 已提交
1363 1364 1365
	return info;
}

1366 1367 1368 1369 1370 1371 1372
/* query and allocate an amp hash entry */
static inline struct hda_amp_info *
get_alloc_amp_hash(struct hda_codec *codec, u32 key)
{
	return (struct hda_amp_info *)get_alloc_hash(&codec->amp_cache, key);
}

1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420
/* overwrite the value with the key in the caps hash */
static int write_caps_hash(struct hda_codec *codec, u32 key, unsigned int val)
{
	struct hda_amp_info *info;

	mutex_lock(&codec->hash_mutex);
	info = get_alloc_amp_hash(codec, key);
	if (!info) {
		mutex_unlock(&codec->hash_mutex);
		return -EINVAL;
	}
	info->amp_caps = val;
	info->head.val |= INFO_AMP_CAPS;
	mutex_unlock(&codec->hash_mutex);
	return 0;
}

/* query the value from the caps hash; if not found, fetch the current
 * value from the given function and store in the hash
 */
static unsigned int
query_caps_hash(struct hda_codec *codec, hda_nid_t nid, int dir, u32 key,
		unsigned int (*func)(struct hda_codec *, hda_nid_t, int))
{
	struct hda_amp_info *info;
	unsigned int val;

	mutex_lock(&codec->hash_mutex);
	info = get_alloc_amp_hash(codec, key);
	if (!info) {
		mutex_unlock(&codec->hash_mutex);
		return 0;
	}
	if (!(info->head.val & INFO_AMP_CAPS)) {
		mutex_unlock(&codec->hash_mutex); /* for reentrance */
		val = func(codec, nid, dir);
		write_caps_hash(codec, key, val);
	} else {
		val = info->amp_caps;
		mutex_unlock(&codec->hash_mutex);
	}
	return val;
}

static unsigned int read_amp_cap(struct hda_codec *codec, hda_nid_t nid,
				 int direction)
{
	if (!(get_wcaps(codec, nid) & AC_WCAP_AMP_OVRD))
1421
		nid = codec->core.afg;
1422 1423 1424 1425 1426
	return snd_hda_param_read(codec, nid,
				  direction == HDA_OUTPUT ?
				  AC_PAR_AMP_OUT_CAP : AC_PAR_AMP_IN_CAP);
}

1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437
/**
 * query_amp_caps - query AMP capabilities
 * @codec: the HD-auio codec
 * @nid: the NID to query
 * @direction: either #HDA_INPUT or #HDA_OUTPUT
 *
 * Query AMP capabilities for the given widget and direction.
 * Returns the obtained capability bits.
 *
 * When cap bits have been already read, this doesn't read again but
 * returns the cached value.
L
Linus Torvalds 已提交
1438
 */
1439
u32 query_amp_caps(struct hda_codec *codec, hda_nid_t nid, int direction)
L
Linus Torvalds 已提交
1440
{
1441 1442 1443
	return query_caps_hash(codec, nid, direction,
			       HDA_HASH_KEY(nid, direction, 0),
			       read_amp_cap);
L
Linus Torvalds 已提交
1444
}
1445
EXPORT_SYMBOL_GPL(query_amp_caps);
L
Linus Torvalds 已提交
1446

1447 1448 1449 1450 1451
/**
 * snd_hda_check_amp_caps - query AMP capabilities
 * @codec: the HD-audio codec
 * @nid: the NID to query
 * @dir: either #HDA_INPUT or #HDA_OUTPUT
1452
 * @bits: bit mask to check the result
1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467
 *
 * Check whether the widget has the given amp capability for the direction.
 */
bool snd_hda_check_amp_caps(struct hda_codec *codec, hda_nid_t nid,
			   int dir, unsigned int bits)
{
	if (!nid)
		return false;
	if (get_wcaps(codec, nid) & (1 << (dir + 1)))
		if (query_amp_caps(codec, nid, dir) & bits)
			return true;
	return false;
}
EXPORT_SYMBOL_GPL(snd_hda_check_amp_caps);

1468 1469 1470 1471
/**
 * snd_hda_override_amp_caps - Override the AMP capabilities
 * @codec: the CODEC to clean up
 * @nid: the NID to clean up
1472
 * @dir: either #HDA_INPUT or #HDA_OUTPUT
1473 1474 1475 1476 1477 1478 1479 1480
 * @caps: the capability bits to set
 *
 * Override the cached AMP caps bits value by the given one.
 * This function is useful if the driver needs to adjust the AMP ranges,
 * e.g. limit to 0dB, etc.
 *
 * Returns zero if successful or a negative error code.
 */
1481 1482 1483
int snd_hda_override_amp_caps(struct hda_codec *codec, hda_nid_t nid, int dir,
			      unsigned int caps)
{
1484
	return write_caps_hash(codec, HDA_HASH_KEY(nid, dir, 0), caps);
1485
}
1486
EXPORT_SYMBOL_GPL(snd_hda_override_amp_caps);
T
Takashi Iwai 已提交
1487

1488 1489
static unsigned int read_pin_cap(struct hda_codec *codec, hda_nid_t nid,
				 int dir)
1490 1491 1492 1493
{
	return snd_hda_param_read(codec, nid, AC_PAR_PIN_CAP);
}

1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504
/**
 * snd_hda_query_pin_caps - Query PIN capabilities
 * @codec: the HD-auio codec
 * @nid: the NID to query
 *
 * Query PIN capabilities for the given widget.
 * Returns the obtained capability bits.
 *
 * When cap bits have been already read, this doesn't read again but
 * returns the cached value.
 */
1505 1506
u32 snd_hda_query_pin_caps(struct hda_codec *codec, hda_nid_t nid)
{
1507
	return query_caps_hash(codec, nid, 0, HDA_HASH_PINCAP_KEY(nid),
1508 1509
			       read_pin_cap);
}
1510
EXPORT_SYMBOL_GPL(snd_hda_query_pin_caps);
1511

1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524
/**
 * snd_hda_override_pin_caps - Override the pin capabilities
 * @codec: the CODEC
 * @nid: the NID to override
 * @caps: the capability bits to set
 *
 * Override the cached PIN capabilitiy bits value by the given one.
 *
 * Returns zero if successful or a negative error code.
 */
int snd_hda_override_pin_caps(struct hda_codec *codec, hda_nid_t nid,
			      unsigned int caps)
{
1525
	return write_caps_hash(codec, HDA_HASH_PINCAP_KEY(nid), caps);
1526
}
1527
EXPORT_SYMBOL_GPL(snd_hda_override_pin_caps);
1528

1529 1530
/* read or sync the hash value with the current value;
 * call within hash_mutex
L
Linus Torvalds 已提交
1531
 */
1532 1533
static struct hda_amp_info *
update_amp_hash(struct hda_codec *codec, hda_nid_t nid, int ch,
1534
		int direction, int index, bool init_only)
L
Linus Torvalds 已提交
1535
{
1536 1537 1538
	struct hda_amp_info *info;
	unsigned int parm, val = 0;
	bool val_read = false;
L
Linus Torvalds 已提交
1539

1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551
 retry:
	info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, index));
	if (!info)
		return NULL;
	if (!(info->head.val & INFO_AMP_VOL(ch))) {
		if (!val_read) {
			mutex_unlock(&codec->hash_mutex);
			parm = ch ? AC_AMP_GET_RIGHT : AC_AMP_GET_LEFT;
			parm |= direction == HDA_OUTPUT ?
				AC_AMP_GET_OUTPUT : AC_AMP_GET_INPUT;
			parm |= index;
			val = snd_hda_codec_read(codec, nid, 0,
T
Takashi Iwai 已提交
1552
				 AC_VERB_GET_AMP_GAIN_MUTE, parm);
1553 1554 1555 1556 1557 1558 1559
			val &= 0xff;
			val_read = true;
			mutex_lock(&codec->hash_mutex);
			goto retry;
		}
		info->vol[ch] = val;
		info->head.val |= INFO_AMP_VOL(ch);
1560 1561
	} else if (init_only)
		return NULL;
1562
	return info;
L
Linus Torvalds 已提交
1563 1564 1565
}

/*
1566
 * write the current volume in info to the h/w
L
Linus Torvalds 已提交
1567
 */
1568
static void put_vol_mute(struct hda_codec *codec, unsigned int amp_caps,
T
Takashi Iwai 已提交
1569 1570
			 hda_nid_t nid, int ch, int direction, int index,
			 int val)
L
Linus Torvalds 已提交
1571 1572 1573 1574 1575 1576
{
	u32 parm;

	parm = ch ? AC_AMP_SET_RIGHT : AC_AMP_SET_LEFT;
	parm |= direction == HDA_OUTPUT ? AC_AMP_SET_OUTPUT : AC_AMP_SET_INPUT;
	parm |= index << AC_AMP_SET_INDEX_SHIFT;
1577 1578
	if ((val & HDA_AMP_MUTE) && !(amp_caps & AC_AMPCAP_MUTE) &&
	    (amp_caps & AC_AMPCAP_MIN_MUTE))
1579 1580 1581
		; /* set the zero value as a fake mute */
	else
		parm |= val;
L
Linus Torvalds 已提交
1582 1583 1584
	snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE, parm);
}

1585 1586 1587 1588 1589 1590 1591 1592 1593
/**
 * snd_hda_codec_amp_read - Read AMP value
 * @codec: HD-audio codec
 * @nid: NID to read the AMP value
 * @ch: channel (left=0 or right=1)
 * @direction: #HDA_INPUT or #HDA_OUTPUT
 * @index: the index value (only for input direction)
 *
 * Read AMP value.  The volume is between 0 to 0x7f, 0x80 = mute bit.
L
Linus Torvalds 已提交
1594
 */
1595 1596
int snd_hda_codec_amp_read(struct hda_codec *codec, hda_nid_t nid, int ch,
			   int direction, int index)
L
Linus Torvalds 已提交
1597
{
T
Takashi Iwai 已提交
1598
	struct hda_amp_info *info;
1599 1600 1601
	unsigned int val = 0;

	mutex_lock(&codec->hash_mutex);
1602
	info = update_amp_hash(codec, nid, ch, direction, index, false);
1603 1604 1605 1606
	if (info)
		val = info->vol[ch];
	mutex_unlock(&codec->hash_mutex);
	return val;
L
Linus Torvalds 已提交
1607
}
1608
EXPORT_SYMBOL_GPL(snd_hda_codec_amp_read);
L
Linus Torvalds 已提交
1609

1610 1611
static int codec_amp_update(struct hda_codec *codec, hda_nid_t nid, int ch,
			    int direction, int idx, int mask, int val,
1612
			    bool init_only, bool cache_only)
L
Linus Torvalds 已提交
1613
{
T
Takashi Iwai 已提交
1614
	struct hda_amp_info *info;
1615
	unsigned int caps;
1616

1617 1618
	if (snd_BUG_ON(mask & ~0xff))
		mask &= 0xff;
1619
	val &= mask;
1620 1621

	mutex_lock(&codec->hash_mutex);
1622
	info = update_amp_hash(codec, nid, ch, direction, idx, init_only);
1623 1624 1625 1626 1627 1628 1629
	if (!info) {
		mutex_unlock(&codec->hash_mutex);
		return 0;
	}
	val |= info->vol[ch] & ~mask;
	if (info->vol[ch] == val) {
		mutex_unlock(&codec->hash_mutex);
L
Linus Torvalds 已提交
1630
		return 0;
1631 1632
	}
	info->vol[ch] = val;
1633
	info->head.dirty |= cache_only;
1634
	caps = info->amp_caps;
1635
	mutex_unlock(&codec->hash_mutex);
1636
	if (!cache_only)
1637
		put_vol_mute(codec, caps, nid, ch, direction, idx, val);
L
Linus Torvalds 已提交
1638 1639
	return 1;
}
1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656

/**
 * snd_hda_codec_amp_update - update the AMP value
 * @codec: HD-audio codec
 * @nid: NID to read the AMP value
 * @ch: channel (left=0 or right=1)
 * @direction: #HDA_INPUT or #HDA_OUTPUT
 * @idx: the index value (only for input direction)
 * @mask: bit mask to set
 * @val: the bits value to set
 *
 * Update the AMP value with a bit mask.
 * Returns 0 if the value is unchanged, 1 if changed.
 */
int snd_hda_codec_amp_update(struct hda_codec *codec, hda_nid_t nid, int ch,
			     int direction, int idx, int mask, int val)
{
1657 1658
	return codec_amp_update(codec, nid, ch, direction, idx, mask, val,
				false, codec->cached_write);
1659
}
1660
EXPORT_SYMBOL_GPL(snd_hda_codec_amp_update);
L
Linus Torvalds 已提交
1661

1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672
/**
 * snd_hda_codec_amp_stereo - update the AMP stereo values
 * @codec: HD-audio codec
 * @nid: NID to read the AMP value
 * @direction: #HDA_INPUT or #HDA_OUTPUT
 * @idx: the index value (only for input direction)
 * @mask: bit mask to set
 * @val: the bits value to set
 *
 * Update the AMP values like snd_hda_codec_amp_update(), but for a
 * stereo widget with the same mask and value.
1673 1674 1675 1676 1677
 */
int snd_hda_codec_amp_stereo(struct hda_codec *codec, hda_nid_t nid,
			     int direction, int idx, int mask, int val)
{
	int ch, ret = 0;
1678 1679 1680

	if (snd_BUG_ON(mask & ~0xff))
		mask &= 0xff;
1681 1682 1683 1684 1685
	for (ch = 0; ch < 2; ch++)
		ret |= snd_hda_codec_amp_update(codec, nid, ch, direction,
						idx, mask, val);
	return ret;
}
1686
EXPORT_SYMBOL_GPL(snd_hda_codec_amp_stereo);
1687

T
Takashi Iwai 已提交
1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698
/**
 * snd_hda_codec_amp_init - initialize the AMP value
 * @codec: the HDA codec
 * @nid: NID to read the AMP value
 * @ch: channel (left=0 or right=1)
 * @dir: #HDA_INPUT or #HDA_OUTPUT
 * @idx: the index value (only for input direction)
 * @mask: bit mask to set
 * @val: the bits value to set
 *
 * Works like snd_hda_codec_amp_update() but it writes the value only at
1699 1700 1701 1702 1703 1704
 * the first access.  If the amp was already initialized / updated beforehand,
 * this does nothing.
 */
int snd_hda_codec_amp_init(struct hda_codec *codec, hda_nid_t nid, int ch,
			   int dir, int idx, int mask, int val)
{
1705 1706
	return codec_amp_update(codec, nid, ch, dir, idx, mask, val, true,
				codec->cached_write);
1707
}
1708
EXPORT_SYMBOL_GPL(snd_hda_codec_amp_init);
1709

T
Takashi Iwai 已提交
1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720
/**
 * snd_hda_codec_amp_init_stereo - initialize the stereo AMP value
 * @codec: the HDA codec
 * @nid: NID to read the AMP value
 * @dir: #HDA_INPUT or #HDA_OUTPUT
 * @idx: the index value (only for input direction)
 * @mask: bit mask to set
 * @val: the bits value to set
 *
 * Call snd_hda_codec_amp_init() for both stereo channels.
 */
1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732
int snd_hda_codec_amp_init_stereo(struct hda_codec *codec, hda_nid_t nid,
				  int dir, int idx, int mask, int val)
{
	int ch, ret = 0;

	if (snd_BUG_ON(mask & ~0xff))
		mask &= 0xff;
	for (ch = 0; ch < 2; ch++)
		ret |= snd_hda_codec_amp_init(codec, nid, ch, dir,
					      idx, mask, val);
	return ret;
}
1733
EXPORT_SYMBOL_GPL(snd_hda_codec_amp_init_stereo);
1734

1735 1736 1737 1738 1739 1740
/**
 * snd_hda_codec_resume_amp - Resume all AMP commands from the cache
 * @codec: HD-audio codec
 *
 * Resume the all amp commands from the cache.
 */
1741 1742 1743 1744
void snd_hda_codec_resume_amp(struct hda_codec *codec)
{
	int i;

1745
	mutex_lock(&codec->hash_mutex);
1746
	codec->cached_write = 0;
1747 1748 1749
	for (i = 0; i < codec->amp_cache.buf.used; i++) {
		struct hda_amp_info *buffer;
		u32 key;
1750 1751
		hda_nid_t nid;
		unsigned int idx, dir, ch;
1752
		struct hda_amp_info info;
1753 1754

		buffer = snd_array_elem(&codec->amp_cache.buf, i);
1755 1756 1757
		if (!buffer->head.dirty)
			continue;
		buffer->head.dirty = 0;
1758 1759
		info = *buffer;
		key = info.head.key;
1760 1761 1762 1763 1764 1765
		if (!key)
			continue;
		nid = key & 0xff;
		idx = (key >> 16) & 0xff;
		dir = (key >> 24) & 0xff;
		for (ch = 0; ch < 2; ch++) {
1766
			if (!(info.head.val & INFO_AMP_VOL(ch)))
1767
				continue;
1768
			mutex_unlock(&codec->hash_mutex);
1769 1770
			put_vol_mute(codec, info.amp_caps, nid, ch, dir, idx,
				     info.vol[ch]);
1771
			mutex_lock(&codec->hash_mutex);
1772 1773
		}
	}
1774
	mutex_unlock(&codec->hash_mutex);
1775
}
1776
EXPORT_SYMBOL_GPL(snd_hda_codec_resume_amp);
L
Linus Torvalds 已提交
1777

1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788
static u32 get_amp_max_value(struct hda_codec *codec, hda_nid_t nid, int dir,
			     unsigned int ofs)
{
	u32 caps = query_amp_caps(codec, nid, dir);
	/* get num steps */
	caps = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
	if (ofs < caps)
		caps -= ofs;
	return caps;
}

1789 1790
/**
 * snd_hda_mixer_amp_volume_info - Info callback for a standard AMP mixer
1791 1792
 * @kcontrol: referred ctl element
 * @uinfo: pointer to get/store the data
1793 1794 1795 1796
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
 */
T
Takashi Iwai 已提交
1797 1798
int snd_hda_mixer_amp_volume_info(struct snd_kcontrol *kcontrol,
				  struct snd_ctl_elem_info *uinfo)
L
Linus Torvalds 已提交
1799 1800 1801 1802 1803
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	u16 nid = get_amp_nid(kcontrol);
	u8 chs = get_amp_channels(kcontrol);
	int dir = get_amp_direction(kcontrol);
1804
	unsigned int ofs = get_amp_offset(kcontrol);
L
Linus Torvalds 已提交
1805

1806 1807 1808 1809 1810
	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
	uinfo->count = chs == 3 ? 2 : 1;
	uinfo->value.integer.min = 0;
	uinfo->value.integer.max = get_amp_max_value(codec, nid, dir, ofs);
	if (!uinfo->value.integer.max) {
1811 1812 1813
		codec_warn(codec,
			   "num_steps = 0 for NID=0x%x (ctl = %s)\n",
			   nid, kcontrol->id.name);
L
Linus Torvalds 已提交
1814 1815 1816 1817
		return -EINVAL;
	}
	return 0;
}
1818
EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_volume_info);
L
Linus Torvalds 已提交
1819

1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839

static inline unsigned int
read_amp_value(struct hda_codec *codec, hda_nid_t nid,
	       int ch, int dir, int idx, unsigned int ofs)
{
	unsigned int val;
	val = snd_hda_codec_amp_read(codec, nid, ch, dir, idx);
	val &= HDA_AMP_VOLMASK;
	if (val >= ofs)
		val -= ofs;
	else
		val = 0;
	return val;
}

static inline int
update_amp_value(struct hda_codec *codec, hda_nid_t nid,
		 int ch, int dir, int idx, unsigned int ofs,
		 unsigned int val)
{
1840 1841
	unsigned int maxval;

1842 1843
	if (val > 0)
		val += ofs;
1844 1845
	/* ofs = 0: raw max value */
	maxval = get_amp_max_value(codec, nid, dir, 0);
1846 1847
	if (val > maxval)
		val = maxval;
1848 1849
	return codec_amp_update(codec, nid, ch, dir, idx, HDA_AMP_VOLMASK, val,
				false, !hda_codec_is_power_on(codec));
1850 1851
}

1852 1853
/**
 * snd_hda_mixer_amp_volume_get - Get callback for a standard AMP mixer volume
1854 1855
 * @kcontrol: ctl element
 * @ucontrol: pointer to get/store the data
1856 1857 1858 1859
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
 */
T
Takashi Iwai 已提交
1860 1861
int snd_hda_mixer_amp_volume_get(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
1862 1863 1864 1865 1866 1867
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	hda_nid_t nid = get_amp_nid(kcontrol);
	int chs = get_amp_channels(kcontrol);
	int dir = get_amp_direction(kcontrol);
	int idx = get_amp_index(kcontrol);
1868
	unsigned int ofs = get_amp_offset(kcontrol);
L
Linus Torvalds 已提交
1869 1870 1871
	long *valp = ucontrol->value.integer.value;

	if (chs & 1)
1872
		*valp++ = read_amp_value(codec, nid, 0, dir, idx, ofs);
L
Linus Torvalds 已提交
1873
	if (chs & 2)
1874
		*valp = read_amp_value(codec, nid, 1, dir, idx, ofs);
L
Linus Torvalds 已提交
1875 1876
	return 0;
}
1877
EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_volume_get);
L
Linus Torvalds 已提交
1878

1879 1880
/**
 * snd_hda_mixer_amp_volume_put - Put callback for a standard AMP mixer volume
1881 1882
 * @kcontrol: ctl element
 * @ucontrol: pointer to get/store the data
1883 1884 1885 1886
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
 */
T
Takashi Iwai 已提交
1887 1888
int snd_hda_mixer_amp_volume_put(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
1889 1890 1891 1892 1893 1894
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	hda_nid_t nid = get_amp_nid(kcontrol);
	int chs = get_amp_channels(kcontrol);
	int dir = get_amp_direction(kcontrol);
	int idx = get_amp_index(kcontrol);
1895
	unsigned int ofs = get_amp_offset(kcontrol);
L
Linus Torvalds 已提交
1896 1897 1898
	long *valp = ucontrol->value.integer.value;
	int change = 0;

1899
	if (chs & 1) {
1900
		change = update_amp_value(codec, nid, 0, dir, idx, ofs, *valp);
1901 1902
		valp++;
	}
1903
	if (chs & 2)
1904
		change |= update_amp_value(codec, nid, 1, dir, idx, ofs, *valp);
L
Linus Torvalds 已提交
1905 1906
	return change;
}
1907
EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_volume_put);
L
Linus Torvalds 已提交
1908

1909 1910
/**
 * snd_hda_mixer_amp_volume_put - TLV callback for a standard AMP mixer volume
1911 1912 1913 1914
 * @kcontrol: ctl element
 * @op_flag: operation flag
 * @size: byte size of input TLV
 * @_tlv: TLV data
1915 1916 1917 1918
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
 */
1919 1920 1921 1922 1923 1924
int snd_hda_mixer_amp_tlv(struct snd_kcontrol *kcontrol, int op_flag,
			  unsigned int size, unsigned int __user *_tlv)
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	hda_nid_t nid = get_amp_nid(kcontrol);
	int dir = get_amp_direction(kcontrol);
1925
	unsigned int ofs = get_amp_offset(kcontrol);
1926
	bool min_mute = get_amp_min_mute(kcontrol);
1927 1928 1929 1930 1931
	u32 caps, val1, val2;

	if (size < 4 * sizeof(unsigned int))
		return -ENOMEM;
	caps = query_amp_caps(codec, nid, dir);
T
Takashi Iwai 已提交
1932 1933
	val2 = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
	val2 = (val2 + 1) * 25;
1934
	val1 = -((caps & AC_AMPCAP_OFFSET) >> AC_AMPCAP_OFFSET_SHIFT);
1935
	val1 += ofs;
1936
	val1 = ((int)val1) * ((int)val2);
1937
	if (min_mute || (caps & AC_AMPCAP_MIN_MUTE))
1938
		val2 |= TLV_DB_SCALE_MUTE;
1939 1940 1941 1942 1943 1944 1945 1946 1947 1948
	if (put_user(SNDRV_CTL_TLVT_DB_SCALE, _tlv))
		return -EFAULT;
	if (put_user(2 * sizeof(unsigned int), _tlv + 1))
		return -EFAULT;
	if (put_user(val1, _tlv + 2))
		return -EFAULT;
	if (put_user(val2, _tlv + 3))
		return -EFAULT;
	return 0;
}
1949
EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_tlv);
1950

1951 1952 1953 1954 1955 1956 1957 1958 1959 1960
/**
 * snd_hda_set_vmaster_tlv - Set TLV for a virtual master control
 * @codec: HD-audio codec
 * @nid: NID of a reference widget
 * @dir: #HDA_INPUT or #HDA_OUTPUT
 * @tlv: TLV data to be stored, at least 4 elements
 *
 * Set (static) TLV data for a virtual master volume using the AMP caps
 * obtained from the reference NID.
 * The volume range is recalculated as if the max volume is 0dB.
1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976
 */
void snd_hda_set_vmaster_tlv(struct hda_codec *codec, hda_nid_t nid, int dir,
			     unsigned int *tlv)
{
	u32 caps;
	int nums, step;

	caps = query_amp_caps(codec, nid, dir);
	nums = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
	step = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
	step = (step + 1) * 25;
	tlv[0] = SNDRV_CTL_TLVT_DB_SCALE;
	tlv[1] = 2 * sizeof(unsigned int);
	tlv[2] = -nums * step;
	tlv[3] = step;
}
1977
EXPORT_SYMBOL_GPL(snd_hda_set_vmaster_tlv);
1978 1979

/* find a mixer control element with the given name */
1980
static struct snd_kcontrol *
1981
find_mixer_ctl(struct hda_codec *codec, const char *name, int dev, int idx)
1982 1983 1984 1985
{
	struct snd_ctl_elem_id id;
	memset(&id, 0, sizeof(id));
	id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1986
	id.device = dev;
1987
	id.index = idx;
T
Takashi Iwai 已提交
1988 1989
	if (snd_BUG_ON(strlen(name) >= sizeof(id.name)))
		return NULL;
1990
	strcpy(id.name, name);
1991
	return snd_ctl_find_id(codec->card, &id);
1992 1993
}

1994 1995 1996 1997 1998 1999 2000
/**
 * snd_hda_find_mixer_ctl - Find a mixer control element with the given name
 * @codec: HD-audio codec
 * @name: ctl id name string
 *
 * Get the control element with the given id string and IFACE_MIXER.
 */
2001 2002 2003
struct snd_kcontrol *snd_hda_find_mixer_ctl(struct hda_codec *codec,
					    const char *name)
{
2004
	return find_mixer_ctl(codec, name, 0, 0);
2005
}
2006
EXPORT_SYMBOL_GPL(snd_hda_find_mixer_ctl);
2007

2008
static int find_empty_mixer_ctl_idx(struct hda_codec *codec, const char *name,
2009
				    int start_idx)
2010
{
2011 2012 2013 2014
	int i, idx;
	/* 16 ctlrs should be large enough */
	for (i = 0, idx = start_idx; i < 16; i++, idx++) {
		if (!find_mixer_ctl(codec, name, 0, idx))
2015 2016 2017 2018 2019
			return idx;
	}
	return -EBUSY;
}

2020
/**
2021
 * snd_hda_ctl_add - Add a control element and assign to the codec
2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035
 * @codec: HD-audio codec
 * @nid: corresponding NID (optional)
 * @kctl: the control element to assign
 *
 * Add the given control element to an array inside the codec instance.
 * All control elements belonging to a codec are supposed to be added
 * by this function so that a proper clean-up works at the free or
 * reconfiguration time.
 *
 * If non-zero @nid is passed, the NID is assigned to the control element.
 * The assignment is shown in the codec proc file.
 *
 * snd_hda_ctl_add() checks the control subdev id field whether
 * #HDA_SUBDEV_NID_FLAG bit is set.  If set (and @nid is zero), the lower
2036 2037
 * bits value is taken as the NID to assign. The #HDA_NID_ITEM_AMP bit
 * specifies if kctl->private_value is a HDA amplifier value.
2038
 */
2039 2040
int snd_hda_ctl_add(struct hda_codec *codec, hda_nid_t nid,
		    struct snd_kcontrol *kctl)
T
Takashi Iwai 已提交
2041 2042
{
	int err;
2043
	unsigned short flags = 0;
2044
	struct hda_nid_item *item;
T
Takashi Iwai 已提交
2045

2046
	if (kctl->id.subdevice & HDA_SUBDEV_AMP_FLAG) {
2047
		flags |= HDA_NID_ITEM_AMP;
2048 2049 2050
		if (nid == 0)
			nid = get_amp_nid_(kctl->private_value);
	}
2051 2052
	if ((kctl->id.subdevice & HDA_SUBDEV_NID_FLAG) != 0 && nid == 0)
		nid = kctl->id.subdevice & 0xffff;
2053
	if (kctl->id.subdevice & (HDA_SUBDEV_NID_FLAG|HDA_SUBDEV_AMP_FLAG))
2054
		kctl->id.subdevice = 0;
2055
	err = snd_ctl_add(codec->card, kctl);
T
Takashi Iwai 已提交
2056 2057
	if (err < 0)
		return err;
2058 2059
	item = snd_array_new(&codec->mixers);
	if (!item)
T
Takashi Iwai 已提交
2060
		return -ENOMEM;
2061 2062
	item->kctl = kctl;
	item->nid = nid;
2063
	item->flags = flags;
T
Takashi Iwai 已提交
2064 2065
	return 0;
}
2066
EXPORT_SYMBOL_GPL(snd_hda_ctl_add);
T
Takashi Iwai 已提交
2067

2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092
/**
 * snd_hda_add_nid - Assign a NID to a control element
 * @codec: HD-audio codec
 * @nid: corresponding NID (optional)
 * @kctl: the control element to assign
 * @index: index to kctl
 *
 * Add the given control element to an array inside the codec instance.
 * This function is used when #snd_hda_ctl_add cannot be used for 1:1
 * NID:KCTL mapping - for example "Capture Source" selector.
 */
int snd_hda_add_nid(struct hda_codec *codec, struct snd_kcontrol *kctl,
		    unsigned int index, hda_nid_t nid)
{
	struct hda_nid_item *item;

	if (nid > 0) {
		item = snd_array_new(&codec->nids);
		if (!item)
			return -ENOMEM;
		item->kctl = kctl;
		item->index = index;
		item->nid = nid;
		return 0;
	}
2093 2094
	codec_err(codec, "no NID for mapping control %s:%d:%d\n",
		  kctl->id.name, kctl->id.index, index);
2095 2096
	return -EINVAL;
}
2097
EXPORT_SYMBOL_GPL(snd_hda_add_nid);
2098

2099 2100 2101 2102
/**
 * snd_hda_ctls_clear - Clear all controls assigned to the given codec
 * @codec: HD-audio codec
 */
T
Takashi Iwai 已提交
2103 2104 2105
void snd_hda_ctls_clear(struct hda_codec *codec)
{
	int i;
2106
	struct hda_nid_item *items = codec->mixers.list;
T
Takashi Iwai 已提交
2107
	for (i = 0; i < codec->mixers.used; i++)
2108
		snd_ctl_remove(codec->card, items[i].kctl);
T
Takashi Iwai 已提交
2109
	snd_array_free(&codec->mixers);
2110
	snd_array_free(&codec->nids);
T
Takashi Iwai 已提交
2111 2112
}

T
Takashi Iwai 已提交
2113 2114 2115 2116
/**
 * snd_hda_lock_devices - pseudo device locking
 * @bus: the BUS
 *
2117 2118
 * toggle card->shutdown to allow/disallow the device access (as a hack)
 */
2119
int snd_hda_lock_devices(struct hda_bus *bus)
2120
{
2121 2122 2123
	struct snd_card *card = bus->card;
	struct hda_codec *codec;

2124
	spin_lock(&card->files_lock);
2125 2126
	if (card->shutdown)
		goto err_unlock;
2127
	card->shutdown = 1;
2128 2129 2130
	if (!list_empty(&card->ctl_files))
		goto err_clear;

2131
	list_for_each_codec(codec, bus) {
2132 2133
		struct hda_pcm *cpcm;
		list_for_each_entry(cpcm, &codec->pcm_list_head, list) {
2134 2135 2136 2137 2138 2139 2140
			if (!cpcm->pcm)
				continue;
			if (cpcm->pcm->streams[0].substream_opened ||
			    cpcm->pcm->streams[1].substream_opened)
				goto err_clear;
		}
	}
2141 2142
	spin_unlock(&card->files_lock);
	return 0;
2143 2144 2145 2146 2147 2148

 err_clear:
	card->shutdown = 0;
 err_unlock:
	spin_unlock(&card->files_lock);
	return -EINVAL;
2149
}
2150
EXPORT_SYMBOL_GPL(snd_hda_lock_devices);
2151

T
Takashi Iwai 已提交
2152 2153 2154 2155
/**
 * snd_hda_unlock_devices - pseudo device unlocking
 * @bus: the BUS
 */
2156
void snd_hda_unlock_devices(struct hda_bus *bus)
2157
{
2158 2159
	struct snd_card *card = bus->card;

2160 2161 2162 2163
	spin_lock(&card->files_lock);
	card->shutdown = 0;
	spin_unlock(&card->files_lock);
}
2164
EXPORT_SYMBOL_GPL(snd_hda_unlock_devices);
2165

2166 2167 2168 2169 2170 2171 2172 2173 2174 2175
/**
 * snd_hda_codec_reset - Clear all objects assigned to the codec
 * @codec: HD-audio codec
 *
 * This frees the all PCM and control elements assigned to the codec, and
 * clears the caches and restores the pin default configurations.
 *
 * When a device is being used, it returns -EBSY.  If successfully freed,
 * returns zero.
 */
2176 2177
int snd_hda_codec_reset(struct hda_codec *codec)
{
2178
	struct hda_bus *bus = codec->bus;
2179

2180
	if (snd_hda_lock_devices(bus) < 0)
2181 2182 2183
		return -EBUSY;

	/* OK, let it free */
T
Takashi Iwai 已提交
2184
	snd_hdac_device_unregister(&codec->core);
2185

2186
	/* allow device access again */
2187
	snd_hda_unlock_devices(bus);
2188
	return 0;
2189 2190
}

2191
typedef int (*map_slave_func_t)(struct hda_codec *, void *, struct snd_kcontrol *);
2192 2193 2194

/* apply the function to all matching slave ctls in the mixer list */
static int map_slaves(struct hda_codec *codec, const char * const *slaves,
2195
		      const char *suffix, map_slave_func_t func, void *data) 
2196 2197 2198 2199 2200 2201 2202 2203
{
	struct hda_nid_item *items;
	const char * const *s;
	int i, err;

	items = codec->mixers.list;
	for (i = 0; i < codec->mixers.used; i++) {
		struct snd_kcontrol *sctl = items[i].kctl;
2204
		if (!sctl || sctl->id.iface != SNDRV_CTL_ELEM_IFACE_MIXER)
2205 2206
			continue;
		for (s = slaves; *s; s++) {
2207 2208 2209 2210 2211 2212 2213 2214
			char tmpname[sizeof(sctl->id.name)];
			const char *name = *s;
			if (suffix) {
				snprintf(tmpname, sizeof(tmpname), "%s %s",
					 name, suffix);
				name = tmpname;
			}
			if (!strcmp(sctl->id.name, name)) {
2215
				err = func(codec, data, sctl);
2216 2217 2218 2219 2220 2221 2222 2223 2224
				if (err)
					return err;
				break;
			}
		}
	}
	return 0;
}

2225 2226
static int check_slave_present(struct hda_codec *codec,
			       void *data, struct snd_kcontrol *sctl)
2227 2228 2229 2230
{
	return 1;
}

2231
/* guess the value corresponding to 0dB */
2232 2233
static int get_kctl_0dB_offset(struct hda_codec *codec,
			       struct snd_kcontrol *kctl, int *step_to_check)
2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247
{
	int _tlv[4];
	const int *tlv = NULL;
	int val = -1;

	if (kctl->vd[0].access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
		/* FIXME: set_fs() hack for obtaining user-space TLV data */
		mm_segment_t fs = get_fs();
		set_fs(get_ds());
		if (!kctl->tlv.c(kctl, 0, sizeof(_tlv), _tlv))
			tlv = _tlv;
		set_fs(fs);
	} else if (kctl->vd[0].access & SNDRV_CTL_ELEM_ACCESS_TLV_READ)
		tlv = kctl->tlv.p;
2248 2249 2250 2251 2252
	if (tlv && tlv[0] == SNDRV_CTL_TLVT_DB_SCALE) {
		int step = tlv[3];
		step &= ~TLV_DB_SCALE_MUTE;
		if (!step)
			return -1;
2253
		if (*step_to_check && *step_to_check != step) {
2254
			codec_err(codec, "Mismatching dB step for vmaster slave (%d!=%d)\n",
2255
-				   *step_to_check, step);
2256 2257 2258
			return -1;
		}
		*step_to_check = step;
2259 2260
		val = -tlv[2] / step;
	}
2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278
	return val;
}

/* call kctl->put with the given value(s) */
static int put_kctl_with_value(struct snd_kcontrol *kctl, int val)
{
	struct snd_ctl_elem_value *ucontrol;
	ucontrol = kzalloc(sizeof(*ucontrol), GFP_KERNEL);
	if (!ucontrol)
		return -ENOMEM;
	ucontrol->value.integer.value[0] = val;
	ucontrol->value.integer.value[1] = val;
	kctl->put(kctl, ucontrol);
	kfree(ucontrol);
	return 0;
}

/* initialize the slave volume with 0dB */
2279 2280
static int init_slave_0dB(struct hda_codec *codec,
			  void *data, struct snd_kcontrol *slave)
2281
{
2282
	int offset = get_kctl_0dB_offset(codec, slave, data);
2283 2284 2285 2286 2287 2288
	if (offset > 0)
		put_kctl_with_value(slave, offset);
	return 0;
}

/* unmute the slave */
2289 2290
static int init_slave_unmute(struct hda_codec *codec,
			     void *data, struct snd_kcontrol *slave)
2291 2292 2293 2294
{
	return put_kctl_with_value(slave, 1);
}

2295 2296 2297 2298 2299 2300
static int add_slave(struct hda_codec *codec,
		     void *data, struct snd_kcontrol *slave)
{
	return snd_ctl_add_slave(data, slave);
}

2301
/**
T
Takashi Iwai 已提交
2302
 * __snd_hda_add_vmaster - create a virtual master control and add slaves
2303 2304 2305 2306
 * @codec: HD-audio codec
 * @name: vmaster control name
 * @tlv: TLV data (optional)
 * @slaves: slave control names (optional)
2307
 * @suffix: suffix string to each slave name (optional)
2308
 * @init_slave_vol: initialize slaves to unmute/0dB
2309
 * @ctl_ret: store the vmaster kcontrol in return
2310 2311 2312 2313 2314 2315 2316 2317 2318 2319
 *
 * Create a virtual master control with the given name.  The TLV data
 * must be either NULL or a valid data.
 *
 * @slaves is a NULL-terminated array of strings, each of which is a
 * slave control name.  All controls with these names are assigned to
 * the new virtual master control.
 *
 * This function returns zero if successful or a negative error code.
 */
2320
int __snd_hda_add_vmaster(struct hda_codec *codec, char *name,
2321
			unsigned int *tlv, const char * const *slaves,
2322 2323
			  const char *suffix, bool init_slave_vol,
			  struct snd_kcontrol **ctl_ret)
2324 2325 2326 2327
{
	struct snd_kcontrol *kctl;
	int err;

2328 2329 2330
	if (ctl_ret)
		*ctl_ret = NULL;

2331
	err = map_slaves(codec, slaves, suffix, check_slave_present, NULL);
2332
	if (err != 1) {
2333
		codec_dbg(codec, "No slave found for %s\n", name);
2334 2335
		return 0;
	}
2336 2337 2338
	kctl = snd_ctl_make_virtual_master(name, tlv);
	if (!kctl)
		return -ENOMEM;
2339
	err = snd_hda_ctl_add(codec, 0, kctl);
2340 2341
	if (err < 0)
		return err;
2342

2343
	err = map_slaves(codec, slaves, suffix, add_slave, kctl);
2344 2345
	if (err < 0)
		return err;
2346 2347 2348

	/* init with master mute & zero volume */
	put_kctl_with_value(kctl, 0);
2349 2350
	if (init_slave_vol) {
		int step = 0;
2351
		map_slaves(codec, slaves, suffix,
2352 2353
			   tlv ? init_slave_0dB : init_slave_unmute, &step);
	}
2354

2355 2356
	if (ctl_ret)
		*ctl_ret = kctl;
2357 2358
	return 0;
}
2359
EXPORT_SYMBOL_GPL(__snd_hda_add_vmaster);
2360

2361 2362 2363 2364 2365 2366 2367
/*
 * mute-LED control using vmaster
 */
static int vmaster_mute_mode_info(struct snd_kcontrol *kcontrol,
				  struct snd_ctl_elem_info *uinfo)
{
	static const char * const texts[] = {
2368
		"On", "Off", "Follow Master"
2369 2370
	};

T
Takashi Iwai 已提交
2371
	return snd_ctl_enum_info(uinfo, 1, 3, texts);
2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404
}

static int vmaster_mute_mode_get(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
{
	struct hda_vmaster_mute_hook *hook = snd_kcontrol_chip(kcontrol);
	ucontrol->value.enumerated.item[0] = hook->mute_mode;
	return 0;
}

static int vmaster_mute_mode_put(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
{
	struct hda_vmaster_mute_hook *hook = snd_kcontrol_chip(kcontrol);
	unsigned int old_mode = hook->mute_mode;

	hook->mute_mode = ucontrol->value.enumerated.item[0];
	if (hook->mute_mode > HDA_VMUTE_FOLLOW_MASTER)
		hook->mute_mode = HDA_VMUTE_FOLLOW_MASTER;
	if (old_mode == hook->mute_mode)
		return 0;
	snd_hda_sync_vmaster_hook(hook);
	return 1;
}

static struct snd_kcontrol_new vmaster_mute_mode = {
	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
	.name = "Mute-LED Mode",
	.info = vmaster_mute_mode_info,
	.get = vmaster_mute_mode_get,
	.put = vmaster_mute_mode_put,
};

T
Takashi Iwai 已提交
2405 2406 2407 2408 2409 2410 2411 2412 2413
/**
 * snd_hda_add_vmaster_hook - Add a vmaster hook for mute-LED
 * @codec: the HDA codec
 * @hook: the vmaster hook object
 * @expose_enum_ctl: flag to create an enum ctl
 *
 * Add a mute-LED hook with the given vmaster switch kctl.
 * When @expose_enum_ctl is set, "Mute-LED Mode" control is automatically
 * created and associated with the given hook.
2414 2415
 */
int snd_hda_add_vmaster_hook(struct hda_codec *codec,
2416 2417
			     struct hda_vmaster_mute_hook *hook,
			     bool expose_enum_ctl)
2418 2419 2420 2421 2422 2423 2424 2425
{
	struct snd_kcontrol *kctl;

	if (!hook->hook || !hook->sw_kctl)
		return 0;
	snd_ctl_add_vmaster_hook(hook->sw_kctl, hook->hook, codec);
	hook->codec = codec;
	hook->mute_mode = HDA_VMUTE_FOLLOW_MASTER;
2426 2427
	if (!expose_enum_ctl)
		return 0;
2428 2429 2430 2431 2432
	kctl = snd_ctl_new1(&vmaster_mute_mode, hook);
	if (!kctl)
		return -ENOMEM;
	return snd_hda_ctl_add(codec, 0, kctl);
}
2433
EXPORT_SYMBOL_GPL(snd_hda_add_vmaster_hook);
2434

T
Takashi Iwai 已提交
2435 2436 2437 2438 2439 2440
/**
 * snd_hda_sync_vmaster_hook - Sync vmaster hook
 * @hook: the vmaster hook
 *
 * Call the hook with the current value for synchronization.
 * Should be called in init callback.
2441 2442 2443 2444 2445
 */
void snd_hda_sync_vmaster_hook(struct hda_vmaster_mute_hook *hook)
{
	if (!hook->hook || !hook->codec)
		return;
2446 2447 2448 2449 2450
	/* don't call vmaster hook in the destructor since it might have
	 * been already destroyed
	 */
	if (hook->codec->bus->shutdown)
		return;
2451 2452 2453 2454 2455 2456 2457 2458 2459
	switch (hook->mute_mode) {
	case HDA_VMUTE_FOLLOW_MASTER:
		snd_ctl_sync_vmaster_hook(hook->sw_kctl);
		break;
	default:
		hook->hook(hook->codec, hook->mute_mode);
		break;
	}
}
2460
EXPORT_SYMBOL_GPL(snd_hda_sync_vmaster_hook);
2461 2462


2463 2464
/**
 * snd_hda_mixer_amp_switch_info - Info callback for a standard AMP mixer switch
2465 2466
 * @kcontrol: referred ctl element
 * @uinfo: pointer to get/store the data
2467 2468 2469 2470
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
 */
T
Takashi Iwai 已提交
2471 2472
int snd_hda_mixer_amp_switch_info(struct snd_kcontrol *kcontrol,
				  struct snd_ctl_elem_info *uinfo)
L
Linus Torvalds 已提交
2473 2474 2475 2476 2477 2478 2479 2480 2481
{
	int chs = get_amp_channels(kcontrol);

	uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
	uinfo->count = chs == 3 ? 2 : 1;
	uinfo->value.integer.min = 0;
	uinfo->value.integer.max = 1;
	return 0;
}
2482
EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_switch_info);
L
Linus Torvalds 已提交
2483

2484 2485
/**
 * snd_hda_mixer_amp_switch_get - Get callback for a standard AMP mixer switch
2486 2487
 * @kcontrol: ctl element
 * @ucontrol: pointer to get/store the data
2488 2489 2490 2491
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
 */
T
Takashi Iwai 已提交
2492 2493
int snd_hda_mixer_amp_switch_get(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
2494 2495 2496 2497 2498 2499 2500 2501 2502
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	hda_nid_t nid = get_amp_nid(kcontrol);
	int chs = get_amp_channels(kcontrol);
	int dir = get_amp_direction(kcontrol);
	int idx = get_amp_index(kcontrol);
	long *valp = ucontrol->value.integer.value;

	if (chs & 1)
T
Takashi Iwai 已提交
2503
		*valp++ = (snd_hda_codec_amp_read(codec, nid, 0, dir, idx) &
2504
			   HDA_AMP_MUTE) ? 0 : 1;
L
Linus Torvalds 已提交
2505
	if (chs & 2)
T
Takashi Iwai 已提交
2506
		*valp = (snd_hda_codec_amp_read(codec, nid, 1, dir, idx) &
2507
			 HDA_AMP_MUTE) ? 0 : 1;
L
Linus Torvalds 已提交
2508 2509
	return 0;
}
2510
EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_switch_get);
L
Linus Torvalds 已提交
2511

2512 2513
/**
 * snd_hda_mixer_amp_switch_put - Put callback for a standard AMP mixer switch
2514 2515
 * @kcontrol: ctl element
 * @ucontrol: pointer to get/store the data
2516 2517 2518 2519
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_COMPOSE_AMP_VAL*() or related macros.
 */
T
Takashi Iwai 已提交
2520 2521
int snd_hda_mixer_amp_switch_put(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
2522 2523 2524 2525 2526 2527 2528 2529 2530
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	hda_nid_t nid = get_amp_nid(kcontrol);
	int chs = get_amp_channels(kcontrol);
	int dir = get_amp_direction(kcontrol);
	int idx = get_amp_index(kcontrol);
	long *valp = ucontrol->value.integer.value;
	int change = 0;

2531
	if (chs & 1) {
2532 2533 2534 2535
		change = codec_amp_update(codec, nid, 0, dir, idx,
					  HDA_AMP_MUTE,
					  *valp ? 0 : HDA_AMP_MUTE, false,
					  !hda_codec_is_power_on(codec));
2536 2537
		valp++;
	}
2538
	if (chs & 2)
2539 2540 2541 2542
		change |= codec_amp_update(codec, nid, 1, dir, idx,
					   HDA_AMP_MUTE,
					   *valp ? 0 : HDA_AMP_MUTE, false,
					   !hda_codec_is_power_on(codec));
2543
	hda_call_check_power_status(codec, nid);
L
Linus Torvalds 已提交
2544 2545
	return change;
}
2546
EXPORT_SYMBOL_GPL(snd_hda_mixer_amp_switch_put);
L
Linus Torvalds 已提交
2547

T
Takashi Iwai 已提交
2548 2549 2550 2551 2552 2553 2554 2555 2556
/*
 * bound volume controls
 *
 * bind multiple volumes (# indices, from 0)
 */

#define AMP_VAL_IDX_SHIFT	19
#define AMP_VAL_IDX_MASK	(0x0f<<19)

2557 2558
/**
 * snd_hda_mixer_bind_switch_get - Get callback for a bound volume control
2559 2560
 * @kcontrol: ctl element
 * @ucontrol: pointer to get/store the data
2561 2562 2563 2564
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_BIND_MUTE*() macros.
 */
T
Takashi Iwai 已提交
2565 2566
int snd_hda_mixer_bind_switch_get(struct snd_kcontrol *kcontrol,
				  struct snd_ctl_elem_value *ucontrol)
T
Takashi Iwai 已提交
2567 2568 2569 2570 2571
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	unsigned long pval;
	int err;

2572
	mutex_lock(&codec->control_mutex);
T
Takashi Iwai 已提交
2573 2574 2575 2576
	pval = kcontrol->private_value;
	kcontrol->private_value = pval & ~AMP_VAL_IDX_MASK; /* index 0 */
	err = snd_hda_mixer_amp_switch_get(kcontrol, ucontrol);
	kcontrol->private_value = pval;
2577
	mutex_unlock(&codec->control_mutex);
T
Takashi Iwai 已提交
2578 2579
	return err;
}
2580
EXPORT_SYMBOL_GPL(snd_hda_mixer_bind_switch_get);
T
Takashi Iwai 已提交
2581

2582 2583
/**
 * snd_hda_mixer_bind_switch_put - Put callback for a bound volume control
2584 2585
 * @kcontrol: ctl element
 * @ucontrol: pointer to get/store the data
2586 2587 2588 2589
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_BIND_MUTE*() macros.
 */
T
Takashi Iwai 已提交
2590 2591
int snd_hda_mixer_bind_switch_put(struct snd_kcontrol *kcontrol,
				  struct snd_ctl_elem_value *ucontrol)
T
Takashi Iwai 已提交
2592 2593 2594 2595 2596
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	unsigned long pval;
	int i, indices, err = 0, change = 0;

2597
	mutex_lock(&codec->control_mutex);
T
Takashi Iwai 已提交
2598 2599 2600
	pval = kcontrol->private_value;
	indices = (pval & AMP_VAL_IDX_MASK) >> AMP_VAL_IDX_SHIFT;
	for (i = 0; i < indices; i++) {
T
Takashi Iwai 已提交
2601 2602
		kcontrol->private_value = (pval & ~AMP_VAL_IDX_MASK) |
			(i << AMP_VAL_IDX_SHIFT);
T
Takashi Iwai 已提交
2603 2604 2605 2606 2607 2608
		err = snd_hda_mixer_amp_switch_put(kcontrol, ucontrol);
		if (err < 0)
			break;
		change |= err;
	}
	kcontrol->private_value = pval;
2609
	mutex_unlock(&codec->control_mutex);
T
Takashi Iwai 已提交
2610 2611
	return err < 0 ? err : change;
}
2612
EXPORT_SYMBOL_GPL(snd_hda_mixer_bind_switch_put);
T
Takashi Iwai 已提交
2613

2614 2615
/**
 * snd_hda_mixer_bind_ctls_info - Info callback for a generic bound control
2616 2617
 * @kcontrol: referred ctl element
 * @uinfo: pointer to get/store the data
2618 2619 2620
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_BIND_VOL() or HDA_BIND_SW() macros.
2621 2622 2623 2624 2625 2626 2627 2628
 */
int snd_hda_mixer_bind_ctls_info(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_info *uinfo)
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	struct hda_bind_ctls *c;
	int err;

2629
	mutex_lock(&codec->control_mutex);
2630
	c = (struct hda_bind_ctls *)kcontrol->private_value;
2631 2632 2633
	kcontrol->private_value = *c->values;
	err = c->ops->info(kcontrol, uinfo);
	kcontrol->private_value = (long)c;
2634
	mutex_unlock(&codec->control_mutex);
2635 2636
	return err;
}
2637
EXPORT_SYMBOL_GPL(snd_hda_mixer_bind_ctls_info);
2638

2639 2640
/**
 * snd_hda_mixer_bind_ctls_get - Get callback for a generic bound control
2641 2642
 * @kcontrol: ctl element
 * @ucontrol: pointer to get/store the data
2643 2644 2645 2646
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_BIND_VOL() or HDA_BIND_SW() macros.
 */
2647 2648 2649 2650 2651 2652 2653
int snd_hda_mixer_bind_ctls_get(struct snd_kcontrol *kcontrol,
				struct snd_ctl_elem_value *ucontrol)
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	struct hda_bind_ctls *c;
	int err;

2654
	mutex_lock(&codec->control_mutex);
2655
	c = (struct hda_bind_ctls *)kcontrol->private_value;
2656 2657 2658
	kcontrol->private_value = *c->values;
	err = c->ops->get(kcontrol, ucontrol);
	kcontrol->private_value = (long)c;
2659
	mutex_unlock(&codec->control_mutex);
2660 2661
	return err;
}
2662
EXPORT_SYMBOL_GPL(snd_hda_mixer_bind_ctls_get);
2663

2664 2665
/**
 * snd_hda_mixer_bind_ctls_put - Put callback for a generic bound control
2666 2667
 * @kcontrol: ctl element
 * @ucontrol: pointer to get/store the data
2668 2669 2670 2671
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_BIND_VOL() or HDA_BIND_SW() macros.
 */
2672 2673 2674 2675 2676 2677 2678 2679
int snd_hda_mixer_bind_ctls_put(struct snd_kcontrol *kcontrol,
				struct snd_ctl_elem_value *ucontrol)
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	struct hda_bind_ctls *c;
	unsigned long *vals;
	int err = 0, change = 0;

2680
	mutex_lock(&codec->control_mutex);
2681
	c = (struct hda_bind_ctls *)kcontrol->private_value;
2682 2683 2684 2685 2686 2687 2688 2689
	for (vals = c->values; *vals; vals++) {
		kcontrol->private_value = *vals;
		err = c->ops->put(kcontrol, ucontrol);
		if (err < 0)
			break;
		change |= err;
	}
	kcontrol->private_value = (long)c;
2690
	mutex_unlock(&codec->control_mutex);
2691 2692
	return err < 0 ? err : change;
}
2693
EXPORT_SYMBOL_GPL(snd_hda_mixer_bind_ctls_put);
2694

2695 2696
/**
 * snd_hda_mixer_bind_tlv - TLV callback for a generic bound control
2697 2698 2699 2700
 * @kcontrol: ctl element
 * @op_flag: operation flag
 * @size: byte size of input TLV
 * @tlv: TLV data
2701 2702 2703 2704
 *
 * The control element is supposed to have the private_value field
 * set up via HDA_BIND_VOL() macro.
 */
2705 2706 2707 2708 2709 2710 2711
int snd_hda_mixer_bind_tlv(struct snd_kcontrol *kcontrol, int op_flag,
			   unsigned int size, unsigned int __user *tlv)
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	struct hda_bind_ctls *c;
	int err;

2712
	mutex_lock(&codec->control_mutex);
2713
	c = (struct hda_bind_ctls *)kcontrol->private_value;
2714 2715 2716
	kcontrol->private_value = *c->values;
	err = c->ops->tlv(kcontrol, op_flag, size, tlv);
	kcontrol->private_value = (long)c;
2717
	mutex_unlock(&codec->control_mutex);
2718 2719
	return err;
}
2720
EXPORT_SYMBOL_GPL(snd_hda_mixer_bind_tlv);
2721 2722 2723 2724 2725 2726 2727

struct hda_ctl_ops snd_hda_bind_vol = {
	.info = snd_hda_mixer_amp_volume_info,
	.get = snd_hda_mixer_amp_volume_get,
	.put = snd_hda_mixer_amp_volume_put,
	.tlv = snd_hda_mixer_amp_tlv
};
2728
EXPORT_SYMBOL_GPL(snd_hda_bind_vol);
2729 2730 2731 2732 2733 2734 2735

struct hda_ctl_ops snd_hda_bind_sw = {
	.info = snd_hda_mixer_amp_switch_info,
	.get = snd_hda_mixer_amp_switch_get,
	.put = snd_hda_mixer_amp_switch_put,
	.tlv = snd_hda_mixer_amp_tlv
};
2736
EXPORT_SYMBOL_GPL(snd_hda_bind_sw);
2737

L
Linus Torvalds 已提交
2738 2739 2740 2741
/*
 * SPDIF out controls
 */

T
Takashi Iwai 已提交
2742 2743
static int snd_hda_spdif_mask_info(struct snd_kcontrol *kcontrol,
				   struct snd_ctl_elem_info *uinfo)
L
Linus Torvalds 已提交
2744 2745 2746 2747 2748 2749
{
	uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
	uinfo->count = 1;
	return 0;
}

T
Takashi Iwai 已提交
2750 2751
static int snd_hda_spdif_cmask_get(struct snd_kcontrol *kcontrol,
				   struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
2752 2753 2754 2755 2756 2757 2758 2759 2760 2761
{
	ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
					   IEC958_AES0_NONAUDIO |
					   IEC958_AES0_CON_EMPHASIS_5015 |
					   IEC958_AES0_CON_NOT_COPYRIGHT;
	ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
					   IEC958_AES1_CON_ORIGINAL;
	return 0;
}

T
Takashi Iwai 已提交
2762 2763
static int snd_hda_spdif_pmask_get(struct snd_kcontrol *kcontrol,
				   struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
2764 2765 2766 2767 2768 2769 2770
{
	ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
					   IEC958_AES0_NONAUDIO |
					   IEC958_AES0_PRO_EMPHASIS_5015;
	return 0;
}

T
Takashi Iwai 已提交
2771 2772
static int snd_hda_spdif_default_get(struct snd_kcontrol *kcontrol,
				     struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
2773 2774
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2775
	int idx = kcontrol->private_value;
2776
	struct hda_spdif_out *spdif;
L
Linus Torvalds 已提交
2777

2778 2779
	mutex_lock(&codec->spdif_mutex);
	spdif = snd_array_elem(&codec->spdif_out, idx);
2780 2781 2782 2783
	ucontrol->value.iec958.status[0] = spdif->status & 0xff;
	ucontrol->value.iec958.status[1] = (spdif->status >> 8) & 0xff;
	ucontrol->value.iec958.status[2] = (spdif->status >> 16) & 0xff;
	ucontrol->value.iec958.status[3] = (spdif->status >> 24) & 0xff;
2784
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796

	return 0;
}

/* convert from SPDIF status bits to HDA SPDIF bits
 * bit 0 (DigEn) is always set zero (to be filled later)
 */
static unsigned short convert_from_spdif_status(unsigned int sbits)
{
	unsigned short val = 0;

	if (sbits & IEC958_AES0_PROFESSIONAL)
T
Takashi Iwai 已提交
2797
		val |= AC_DIG1_PROFESSIONAL;
L
Linus Torvalds 已提交
2798
	if (sbits & IEC958_AES0_NONAUDIO)
T
Takashi Iwai 已提交
2799
		val |= AC_DIG1_NONAUDIO;
L
Linus Torvalds 已提交
2800
	if (sbits & IEC958_AES0_PROFESSIONAL) {
T
Takashi Iwai 已提交
2801 2802 2803
		if ((sbits & IEC958_AES0_PRO_EMPHASIS) ==
		    IEC958_AES0_PRO_EMPHASIS_5015)
			val |= AC_DIG1_EMPHASIS;
L
Linus Torvalds 已提交
2804
	} else {
T
Takashi Iwai 已提交
2805 2806 2807 2808 2809
		if ((sbits & IEC958_AES0_CON_EMPHASIS) ==
		    IEC958_AES0_CON_EMPHASIS_5015)
			val |= AC_DIG1_EMPHASIS;
		if (!(sbits & IEC958_AES0_CON_NOT_COPYRIGHT))
			val |= AC_DIG1_COPYRIGHT;
L
Linus Torvalds 已提交
2810
		if (sbits & (IEC958_AES1_CON_ORIGINAL << 8))
T
Takashi Iwai 已提交
2811
			val |= AC_DIG1_LEVEL;
L
Linus Torvalds 已提交
2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822
		val |= sbits & (IEC958_AES1_CON_CATEGORY << 8);
	}
	return val;
}

/* convert to SPDIF status bits from HDA SPDIF bits
 */
static unsigned int convert_to_spdif_status(unsigned short val)
{
	unsigned int sbits = 0;

T
Takashi Iwai 已提交
2823
	if (val & AC_DIG1_NONAUDIO)
L
Linus Torvalds 已提交
2824
		sbits |= IEC958_AES0_NONAUDIO;
T
Takashi Iwai 已提交
2825
	if (val & AC_DIG1_PROFESSIONAL)
L
Linus Torvalds 已提交
2826 2827
		sbits |= IEC958_AES0_PROFESSIONAL;
	if (sbits & IEC958_AES0_PROFESSIONAL) {
2828
		if (val & AC_DIG1_EMPHASIS)
L
Linus Torvalds 已提交
2829 2830
			sbits |= IEC958_AES0_PRO_EMPHASIS_5015;
	} else {
T
Takashi Iwai 已提交
2831
		if (val & AC_DIG1_EMPHASIS)
L
Linus Torvalds 已提交
2832
			sbits |= IEC958_AES0_CON_EMPHASIS_5015;
T
Takashi Iwai 已提交
2833
		if (!(val & AC_DIG1_COPYRIGHT))
L
Linus Torvalds 已提交
2834
			sbits |= IEC958_AES0_CON_NOT_COPYRIGHT;
T
Takashi Iwai 已提交
2835
		if (val & AC_DIG1_LEVEL)
L
Linus Torvalds 已提交
2836 2837 2838 2839 2840 2841
			sbits |= (IEC958_AES1_CON_ORIGINAL << 8);
		sbits |= val & (0x7f << 8);
	}
	return sbits;
}

2842 2843 2844 2845
/* set digital convert verbs both for the given NID and its slaves */
static void set_dig_out(struct hda_codec *codec, hda_nid_t nid,
			int verb, int val)
{
2846
	const hda_nid_t *d;
2847

2848
	snd_hda_codec_write_cache(codec, nid, 0, verb, val);
2849 2850 2851 2852
	d = codec->slave_dig_outs;
	if (!d)
		return;
	for (; *d; d++)
2853
		snd_hda_codec_write_cache(codec, *d, 0, verb, val);
2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864
}

static inline void set_dig_out_convert(struct hda_codec *codec, hda_nid_t nid,
				       int dig1, int dig2)
{
	if (dig1 != -1)
		set_dig_out(codec, nid, AC_VERB_SET_DIGI_CONVERT_1, dig1);
	if (dig2 != -1)
		set_dig_out(codec, nid, AC_VERB_SET_DIGI_CONVERT_2, dig2);
}

T
Takashi Iwai 已提交
2865 2866
static int snd_hda_spdif_default_put(struct snd_kcontrol *kcontrol,
				     struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
2867 2868
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2869
	int idx = kcontrol->private_value;
2870 2871
	struct hda_spdif_out *spdif;
	hda_nid_t nid;
L
Linus Torvalds 已提交
2872 2873 2874
	unsigned short val;
	int change;

2875
	mutex_lock(&codec->spdif_mutex);
2876 2877
	spdif = snd_array_elem(&codec->spdif_out, idx);
	nid = spdif->nid;
2878
	spdif->status = ucontrol->value.iec958.status[0] |
L
Linus Torvalds 已提交
2879 2880 2881
		((unsigned int)ucontrol->value.iec958.status[1] << 8) |
		((unsigned int)ucontrol->value.iec958.status[2] << 16) |
		((unsigned int)ucontrol->value.iec958.status[3] << 24);
2882 2883 2884 2885
	val = convert_from_spdif_status(spdif->status);
	val |= spdif->ctls & 1;
	change = spdif->ctls != val;
	spdif->ctls = val;
2886
	if (change && nid != (u16)-1)
2887
		set_dig_out_convert(codec, nid, val & 0xff, (val >> 8) & 0xff);
2888
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
2889 2890 2891
	return change;
}

2892
#define snd_hda_spdif_out_switch_info	snd_ctl_boolean_mono_info
L
Linus Torvalds 已提交
2893

T
Takashi Iwai 已提交
2894 2895
static int snd_hda_spdif_out_switch_get(struct snd_kcontrol *kcontrol,
					struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
2896 2897
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2898
	int idx = kcontrol->private_value;
2899
	struct hda_spdif_out *spdif;
L
Linus Torvalds 已提交
2900

2901 2902
	mutex_lock(&codec->spdif_mutex);
	spdif = snd_array_elem(&codec->spdif_out, idx);
2903
	ucontrol->value.integer.value[0] = spdif->ctls & AC_DIG1_ENABLE;
2904
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
2905 2906 2907
	return 0;
}

2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918
static inline void set_spdif_ctls(struct hda_codec *codec, hda_nid_t nid,
				  int dig1, int dig2)
{
	set_dig_out_convert(codec, nid, dig1, dig2);
	/* unmute amp switch (if any) */
	if ((get_wcaps(codec, nid) & AC_WCAP_OUT_AMP) &&
	    (dig1 & AC_DIG1_ENABLE))
		snd_hda_codec_amp_stereo(codec, nid, HDA_OUTPUT, 0,
					    HDA_AMP_MUTE, 0);
}

T
Takashi Iwai 已提交
2919 2920
static int snd_hda_spdif_out_switch_put(struct snd_kcontrol *kcontrol,
					struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
2921 2922
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2923
	int idx = kcontrol->private_value;
2924 2925
	struct hda_spdif_out *spdif;
	hda_nid_t nid;
L
Linus Torvalds 已提交
2926 2927 2928
	unsigned short val;
	int change;

2929
	mutex_lock(&codec->spdif_mutex);
2930 2931
	spdif = snd_array_elem(&codec->spdif_out, idx);
	nid = spdif->nid;
2932
	val = spdif->ctls & ~AC_DIG1_ENABLE;
L
Linus Torvalds 已提交
2933
	if (ucontrol->value.integer.value[0])
T
Takashi Iwai 已提交
2934
		val |= AC_DIG1_ENABLE;
2935
	change = spdif->ctls != val;
2936 2937 2938
	spdif->ctls = val;
	if (change && nid != (u16)-1)
		set_spdif_ctls(codec, nid, val & 0xff, -1);
2939
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
2940 2941 2942
	return change;
}

2943
static struct snd_kcontrol_new dig_mixes[] = {
L
Linus Torvalds 已提交
2944 2945 2946
	{
		.access = SNDRV_CTL_ELEM_ACCESS_READ,
		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2947
		.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, CON_MASK),
L
Linus Torvalds 已提交
2948 2949 2950 2951 2952 2953
		.info = snd_hda_spdif_mask_info,
		.get = snd_hda_spdif_cmask_get,
	},
	{
		.access = SNDRV_CTL_ELEM_ACCESS_READ,
		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2954
		.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, PRO_MASK),
L
Linus Torvalds 已提交
2955 2956 2957 2958 2959
		.info = snd_hda_spdif_mask_info,
		.get = snd_hda_spdif_pmask_get,
	},
	{
		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2960
		.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, DEFAULT),
L
Linus Torvalds 已提交
2961 2962 2963 2964 2965 2966
		.info = snd_hda_spdif_mask_info,
		.get = snd_hda_spdif_default_get,
		.put = snd_hda_spdif_default_put,
	},
	{
		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2967
		.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, SWITCH),
L
Linus Torvalds 已提交
2968 2969 2970 2971 2972 2973 2974 2975
		.info = snd_hda_spdif_out_switch_info,
		.get = snd_hda_spdif_out_switch_get,
		.put = snd_hda_spdif_out_switch_put,
	},
	{ } /* end */
};

/**
2976
 * snd_hda_create_dig_out_ctls - create Output SPDIF-related controls
L
Linus Torvalds 已提交
2977
 * @codec: the HDA codec
2978 2979 2980 2981 2982
 * @associated_nid: NID that new ctls associated with
 * @cvt_nid: converter NID
 * @type: HDA_PCM_TYPE_*
 * Creates controls related with the digital output.
 * Called from each patch supporting the digital out.
L
Linus Torvalds 已提交
2983 2984 2985
 *
 * Returns 0 if successful, or a negative error code.
 */
2986 2987 2988 2989
int snd_hda_create_dig_out_ctls(struct hda_codec *codec,
				hda_nid_t associated_nid,
				hda_nid_t cvt_nid,
				int type)
L
Linus Torvalds 已提交
2990 2991
{
	int err;
2992 2993
	struct snd_kcontrol *kctl;
	struct snd_kcontrol_new *dig_mix;
2994 2995
	int idx = 0;
	const int spdif_index = 16;
2996
	struct hda_spdif_out *spdif;
2997
	struct hda_bus *bus = codec->bus;
L
Linus Torvalds 已提交
2998

2999
	if (bus->primary_dig_out_type == HDA_PCM_TYPE_HDMI &&
3000
	    type == HDA_PCM_TYPE_SPDIF) {
3001 3002
		idx = spdif_index;
	} else if (bus->primary_dig_out_type == HDA_PCM_TYPE_SPDIF &&
3003
		   type == HDA_PCM_TYPE_HDMI) {
3004 3005 3006 3007 3008 3009
		/* suppose a single SPDIF device */
		for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
			kctl = find_mixer_ctl(codec, dig_mix->name, 0, 0);
			if (!kctl)
				break;
			kctl->id.index = spdif_index;
3010
		}
3011
		bus->primary_dig_out_type = HDA_PCM_TYPE_HDMI;
3012
	}
3013 3014
	if (!bus->primary_dig_out_type)
		bus->primary_dig_out_type = type;
3015

3016
	idx = find_empty_mixer_ctl_idx(codec, "IEC958 Playback Switch", idx);
3017
	if (idx < 0) {
3018
		codec_err(codec, "too many IEC958 outputs\n");
3019 3020
		return -EBUSY;
	}
3021
	spdif = snd_array_new(&codec->spdif_out);
3022 3023
	if (!spdif)
		return -ENOMEM;
L
Linus Torvalds 已提交
3024 3025
	for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
		kctl = snd_ctl_new1(dig_mix, codec);
3026 3027
		if (!kctl)
			return -ENOMEM;
3028
		kctl->id.index = idx;
3029
		kctl->private_value = codec->spdif_out.used - 1;
3030
		err = snd_hda_ctl_add(codec, associated_nid, kctl);
T
Takashi Iwai 已提交
3031
		if (err < 0)
L
Linus Torvalds 已提交
3032 3033
			return err;
	}
3034 3035
	spdif->nid = cvt_nid;
	spdif->ctls = snd_hda_codec_read(codec, cvt_nid, 0,
3036 3037
					 AC_VERB_GET_DIGI_CONVERT_1, 0);
	spdif->status = convert_to_spdif_status(spdif->ctls);
L
Linus Torvalds 已提交
3038 3039
	return 0;
}
3040
EXPORT_SYMBOL_GPL(snd_hda_create_dig_out_ctls);
L
Linus Torvalds 已提交
3041

T
Takashi Iwai 已提交
3042 3043 3044 3045 3046
/**
 * snd_hda_spdif_out_of_nid - get the hda_spdif_out entry from the given NID
 * @codec: the HDA codec
 * @nid: widget NID
 *
3047 3048
 * call within spdif_mutex lock
 */
3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059 3060
struct hda_spdif_out *snd_hda_spdif_out_of_nid(struct hda_codec *codec,
					       hda_nid_t nid)
{
	int i;
	for (i = 0; i < codec->spdif_out.used; i++) {
		struct hda_spdif_out *spdif =
				snd_array_elem(&codec->spdif_out, i);
		if (spdif->nid == nid)
			return spdif;
	}
	return NULL;
}
3061
EXPORT_SYMBOL_GPL(snd_hda_spdif_out_of_nid);
3062

T
Takashi Iwai 已提交
3063 3064 3065 3066 3067 3068 3069
/**
 * snd_hda_spdif_ctls_unassign - Unassign the given SPDIF ctl
 * @codec: the HDA codec
 * @idx: the SPDIF ctl index
 *
 * Unassign the widget from the given SPDIF control.
 */
3070 3071
void snd_hda_spdif_ctls_unassign(struct hda_codec *codec, int idx)
{
3072
	struct hda_spdif_out *spdif;
3073 3074

	mutex_lock(&codec->spdif_mutex);
3075
	spdif = snd_array_elem(&codec->spdif_out, idx);
3076 3077 3078
	spdif->nid = (u16)-1;
	mutex_unlock(&codec->spdif_mutex);
}
3079
EXPORT_SYMBOL_GPL(snd_hda_spdif_ctls_unassign);
3080

T
Takashi Iwai 已提交
3081 3082 3083 3084 3085 3086 3087 3088
/**
 * snd_hda_spdif_ctls_assign - Assign the SPDIF controls to the given NID
 * @codec: the HDA codec
 * @idx: the SPDIF ctl idx
 * @nid: widget NID
 *
 * Assign the widget to the SPDIF control with the given index.
 */
3089 3090
void snd_hda_spdif_ctls_assign(struct hda_codec *codec, int idx, hda_nid_t nid)
{
3091
	struct hda_spdif_out *spdif;
3092 3093 3094
	unsigned short val;

	mutex_lock(&codec->spdif_mutex);
3095
	spdif = snd_array_elem(&codec->spdif_out, idx);
3096 3097 3098 3099 3100 3101 3102
	if (spdif->nid != nid) {
		spdif->nid = nid;
		val = spdif->ctls;
		set_spdif_ctls(codec, nid, val & 0xff, (val >> 8) & 0xff);
	}
	mutex_unlock(&codec->spdif_mutex);
}
3103
EXPORT_SYMBOL_GPL(snd_hda_spdif_ctls_assign);
3104

3105 3106 3107 3108 3109 3110 3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131
/*
 * SPDIF sharing with analog output
 */
static int spdif_share_sw_get(struct snd_kcontrol *kcontrol,
			      struct snd_ctl_elem_value *ucontrol)
{
	struct hda_multi_out *mout = snd_kcontrol_chip(kcontrol);
	ucontrol->value.integer.value[0] = mout->share_spdif;
	return 0;
}

static int spdif_share_sw_put(struct snd_kcontrol *kcontrol,
			      struct snd_ctl_elem_value *ucontrol)
{
	struct hda_multi_out *mout = snd_kcontrol_chip(kcontrol);
	mout->share_spdif = !!ucontrol->value.integer.value[0];
	return 0;
}

static struct snd_kcontrol_new spdif_share_sw = {
	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
	.name = "IEC958 Default PCM Playback Switch",
	.info = snd_ctl_boolean_mono_info,
	.get = spdif_share_sw_get,
	.put = spdif_share_sw_put,
};

3132 3133 3134 3135 3136
/**
 * snd_hda_create_spdif_share_sw - create Default PCM switch
 * @codec: the HDA codec
 * @mout: multi-out instance
 */
3137 3138 3139
int snd_hda_create_spdif_share_sw(struct hda_codec *codec,
				  struct hda_multi_out *mout)
{
3140 3141
	struct snd_kcontrol *kctl;

3142 3143
	if (!mout->dig_out_nid)
		return 0;
3144 3145 3146 3147

	kctl = snd_ctl_new1(&spdif_share_sw, mout);
	if (!kctl)
		return -ENOMEM;
3148
	/* ATTENTION: here mout is passed as private_data, instead of codec */
3149
	return snd_hda_ctl_add(codec, mout->dig_out_nid, kctl);
3150
}
3151
EXPORT_SYMBOL_GPL(snd_hda_create_spdif_share_sw);
3152

L
Linus Torvalds 已提交
3153 3154 3155 3156 3157 3158
/*
 * SPDIF input
 */

#define snd_hda_spdif_in_switch_info	snd_hda_spdif_out_switch_info

T
Takashi Iwai 已提交
3159 3160
static int snd_hda_spdif_in_switch_get(struct snd_kcontrol *kcontrol,
				       struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
3161 3162 3163 3164 3165 3166 3167
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);

	ucontrol->value.integer.value[0] = codec->spdif_in_enable;
	return 0;
}

T
Takashi Iwai 已提交
3168 3169
static int snd_hda_spdif_in_switch_put(struct snd_kcontrol *kcontrol,
				       struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
3170 3171 3172 3173 3174 3175
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	hda_nid_t nid = kcontrol->private_value;
	unsigned int val = !!ucontrol->value.integer.value[0];
	int change;

3176
	mutex_lock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
3177
	change = codec->spdif_in_enable != val;
3178
	if (change) {
L
Linus Torvalds 已提交
3179
		codec->spdif_in_enable = val;
3180 3181
		snd_hda_codec_write_cache(codec, nid, 0,
					  AC_VERB_SET_DIGI_CONVERT_1, val);
L
Linus Torvalds 已提交
3182
	}
3183
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
3184 3185 3186
	return change;
}

T
Takashi Iwai 已提交
3187 3188
static int snd_hda_spdif_in_status_get(struct snd_kcontrol *kcontrol,
				       struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
3189 3190 3191 3192 3193 3194
{
	struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
	hda_nid_t nid = kcontrol->private_value;
	unsigned short val;
	unsigned int sbits;

3195
	val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT_1, 0);
L
Linus Torvalds 已提交
3196 3197 3198 3199 3200 3201 3202 3203
	sbits = convert_to_spdif_status(val);
	ucontrol->value.iec958.status[0] = sbits;
	ucontrol->value.iec958.status[1] = sbits >> 8;
	ucontrol->value.iec958.status[2] = sbits >> 16;
	ucontrol->value.iec958.status[3] = sbits >> 24;
	return 0;
}

3204
static struct snd_kcontrol_new dig_in_ctls[] = {
L
Linus Torvalds 已提交
3205 3206
	{
		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
3207
		.name = SNDRV_CTL_NAME_IEC958("", CAPTURE, SWITCH),
L
Linus Torvalds 已提交
3208 3209 3210 3211 3212 3213 3214
		.info = snd_hda_spdif_in_switch_info,
		.get = snd_hda_spdif_in_switch_get,
		.put = snd_hda_spdif_in_switch_put,
	},
	{
		.access = SNDRV_CTL_ELEM_ACCESS_READ,
		.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
3215
		.name = SNDRV_CTL_NAME_IEC958("", CAPTURE, DEFAULT),
L
Linus Torvalds 已提交
3216 3217 3218 3219 3220 3221 3222 3223 3224 3225 3226 3227 3228 3229 3230 3231
		.info = snd_hda_spdif_mask_info,
		.get = snd_hda_spdif_in_status_get,
	},
	{ } /* end */
};

/**
 * snd_hda_create_spdif_in_ctls - create Input SPDIF-related controls
 * @codec: the HDA codec
 * @nid: audio in widget NID
 *
 * Creates controls related with the SPDIF input.
 * Called from each patch supporting the SPDIF in.
 *
 * Returns 0 if successful, or a negative error code.
 */
3232
int snd_hda_create_spdif_in_ctls(struct hda_codec *codec, hda_nid_t nid)
L
Linus Torvalds 已提交
3233 3234
{
	int err;
3235 3236
	struct snd_kcontrol *kctl;
	struct snd_kcontrol_new *dig_mix;
3237
	int idx;
L
Linus Torvalds 已提交
3238

3239
	idx = find_empty_mixer_ctl_idx(codec, "IEC958 Capture Switch", 0);
3240
	if (idx < 0) {
3241
		codec_err(codec, "too many IEC958 inputs\n");
3242 3243
		return -EBUSY;
	}
L
Linus Torvalds 已提交
3244 3245
	for (dig_mix = dig_in_ctls; dig_mix->name; dig_mix++) {
		kctl = snd_ctl_new1(dig_mix, codec);
3246 3247
		if (!kctl)
			return -ENOMEM;
L
Linus Torvalds 已提交
3248
		kctl->private_value = nid;
3249
		err = snd_hda_ctl_add(codec, nid, kctl);
T
Takashi Iwai 已提交
3250
		if (err < 0)
L
Linus Torvalds 已提交
3251 3252
			return err;
	}
T
Takashi Iwai 已提交
3253
	codec->spdif_in_enable =
3254 3255
		snd_hda_codec_read(codec, nid, 0,
				   AC_VERB_GET_DIGI_CONVERT_1, 0) &
T
Takashi Iwai 已提交
3256
		AC_DIG1_ENABLE;
L
Linus Torvalds 已提交
3257 3258
	return 0;
}
3259
EXPORT_SYMBOL_GPL(snd_hda_create_spdif_in_ctls);
L
Linus Torvalds 已提交
3260

3261 3262 3263
/*
 * command cache
 */
L
Linus Torvalds 已提交
3264

3265
/* build a 31bit cache key with the widget id and the command parameter */
3266 3267 3268 3269 3270 3271 3272 3273
#define build_cmd_cache_key(nid, verb)	((verb << 8) | nid)
#define get_cmd_cache_nid(key)		((key) & 0xff)
#define get_cmd_cache_cmd(key)		(((key) >> 8) & 0xffff)

/**
 * snd_hda_codec_write_cache - send a single command with caching
 * @codec: the HDA codec
 * @nid: NID to send the command
3274
 * @flags: optional bit flags
3275 3276 3277 3278 3279 3280 3281 3282
 * @verb: the verb to send
 * @parm: the parameter for the verb
 *
 * Send a single command without waiting for response.
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_codec_write_cache(struct hda_codec *codec, hda_nid_t nid,
3283
			      int flags, unsigned int verb, unsigned int parm)
3284
{
3285
	int err;
3286 3287
	struct hda_cache_head *c;
	u32 key;
3288
	unsigned int cache_only;
3289

3290 3291
	cache_only = codec->cached_write;
	if (!cache_only) {
3292
		err = snd_hda_codec_write(codec, nid, flags, verb, parm);
3293 3294 3295 3296
		if (err < 0)
			return err;
	}

3297 3298 3299 3300
	/* parm may contain the verb stuff for get/set amp */
	verb = verb | (parm >> 8);
	parm &= 0xff;
	key = build_cmd_cache_key(nid, verb);
3301
	mutex_lock(&codec->bus->core.cmd_mutex);
3302
	c = get_alloc_hash(&codec->cmd_cache, key);
3303
	if (c) {
3304
		c->val = parm;
3305
		c->dirty = cache_only;
3306
	}
3307
	mutex_unlock(&codec->bus->core.cmd_mutex);
3308
	return 0;
3309
}
3310
EXPORT_SYMBOL_GPL(snd_hda_codec_write_cache);
3311

3312 3313 3314 3315
/**
 * snd_hda_codec_update_cache - check cache and write the cmd only when needed
 * @codec: the HDA codec
 * @nid: NID to send the command
3316
 * @flags: optional bit flags
3317 3318 3319 3320 3321 3322 3323 3324 3325 3326
 * @verb: the verb to send
 * @parm: the parameter for the verb
 *
 * This function works like snd_hda_codec_write_cache(), but it doesn't send
 * command if the parameter is already identical with the cached value.
 * If not, it sends the command and refreshes the cache.
 *
 * Returns 0 if successful, or a negative error code.
 */
int snd_hda_codec_update_cache(struct hda_codec *codec, hda_nid_t nid,
3327
			       int flags, unsigned int verb, unsigned int parm)
3328 3329 3330 3331 3332 3333 3334 3335
{
	struct hda_cache_head *c;
	u32 key;

	/* parm may contain the verb stuff for get/set amp */
	verb = verb | (parm >> 8);
	parm &= 0xff;
	key = build_cmd_cache_key(nid, verb);
3336
	mutex_lock(&codec->bus->core.cmd_mutex);
3337 3338
	c = get_hash(&codec->cmd_cache, key);
	if (c && c->val == parm) {
3339
		mutex_unlock(&codec->bus->core.cmd_mutex);
3340 3341
		return 0;
	}
3342
	mutex_unlock(&codec->bus->core.cmd_mutex);
3343
	return snd_hda_codec_write_cache(codec, nid, flags, verb, parm);
3344
}
3345
EXPORT_SYMBOL_GPL(snd_hda_codec_update_cache);
3346

3347 3348 3349 3350 3351 3352
/**
 * snd_hda_codec_resume_cache - Resume the all commands from the cache
 * @codec: HD-audio codec
 *
 * Execute all verbs recorded in the command caches to resume.
 */
3353 3354 3355 3356
void snd_hda_codec_resume_cache(struct hda_codec *codec)
{
	int i;

3357
	mutex_lock(&codec->hash_mutex);
3358
	codec->cached_write = 0;
3359 3360 3361 3362 3363 3364
	for (i = 0; i < codec->cmd_cache.buf.used; i++) {
		struct hda_cache_head *buffer;
		u32 key;

		buffer = snd_array_elem(&codec->cmd_cache.buf, i);
		key = buffer->key;
3365 3366
		if (!key)
			continue;
3367 3368 3369 3370
		if (!buffer->dirty)
			continue;
		buffer->dirty = 0;
		mutex_unlock(&codec->hash_mutex);
3371 3372
		snd_hda_codec_write(codec, get_cmd_cache_nid(key), 0,
				    get_cmd_cache_cmd(key), buffer->val);
3373
		mutex_lock(&codec->hash_mutex);
3374
	}
3375
	mutex_unlock(&codec->hash_mutex);
3376
}
3377
EXPORT_SYMBOL_GPL(snd_hda_codec_resume_cache);
3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393 3394

/**
 * snd_hda_sequence_write_cache - sequence writes with caching
 * @codec: the HDA codec
 * @seq: VERB array to send
 *
 * Send the commands sequentially from the given array.
 * Thte commands are recorded on cache for power-save and resume.
 * The array must be terminated with NID=0.
 */
void snd_hda_sequence_write_cache(struct hda_codec *codec,
				  const struct hda_verb *seq)
{
	for (; seq->nid; seq++)
		snd_hda_codec_write_cache(codec, seq->nid, 0, seq->verb,
					  seq->param);
}
3395
EXPORT_SYMBOL_GPL(snd_hda_sequence_write_cache);
3396

3397 3398 3399 3400 3401 3402 3403 3404 3405
/**
 * snd_hda_codec_flush_cache - Execute all pending (cached) amps / verbs
 * @codec: HD-audio codec
 */
void snd_hda_codec_flush_cache(struct hda_codec *codec)
{
	snd_hda_codec_resume_amp(codec);
	snd_hda_codec_resume_cache(codec);
}
3406
EXPORT_SYMBOL_GPL(snd_hda_codec_flush_cache);
3407

T
Takashi Iwai 已提交
3408 3409 3410 3411 3412 3413 3414 3415 3416 3417
/**
 * snd_hda_codec_set_power_to_all - Set the power state to all widgets
 * @codec: the HDA codec
 * @fg: function group (not used now)
 * @power_state: the power state to set (AC_PWRST_*)
 *
 * Set the given power state to all widgets that have the power control.
 * If the codec has power_filter set, it evaluates the power state and
 * filter out if it's unchanged as D3.
 */
3418
void snd_hda_codec_set_power_to_all(struct hda_codec *codec, hda_nid_t fg,
3419
				    unsigned int power_state)
3420
{
3421
	hda_nid_t nid;
3422

3423
	for_each_hda_codec_node(nid, codec) {
3424
		unsigned int wcaps = get_wcaps(codec, nid);
3425
		unsigned int state = power_state;
3426 3427
		if (!(wcaps & AC_WCAP_POWER))
			continue;
3428 3429 3430
		if (codec->power_filter) {
			state = codec->power_filter(codec, nid, power_state);
			if (state != power_state && power_state == AC_PWRST_D3)
3431
				continue;
3432
		}
3433
		snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_POWER_STATE,
3434
				    state);
3435
	}
3436
}
3437
EXPORT_SYMBOL_GPL(snd_hda_codec_set_power_to_all);
3438

3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449 3450 3451 3452 3453 3454 3455 3456 3457 3458 3459 3460 3461 3462 3463 3464
/*
 * wait until the state is reached, returns the current state
 */
static unsigned int hda_sync_power_state(struct hda_codec *codec,
					 hda_nid_t fg,
					 unsigned int power_state)
{
	unsigned long end_time = jiffies + msecs_to_jiffies(500);
	unsigned int state, actual_state;

	for (;;) {
		state = snd_hda_codec_read(codec, fg, 0,
					   AC_VERB_GET_POWER_STATE, 0);
		if (state & AC_PWRST_ERROR)
			break;
		actual_state = (state >> 4) & 0x0f;
		if (actual_state == power_state)
			break;
		if (time_after_eq(jiffies, end_time))
			break;
		/* wait until the codec reachs to the target state */
		msleep(1);
	}
	return state;
}

T
Takashi Iwai 已提交
3465 3466 3467 3468 3469 3470 3471 3472 3473
/**
 * snd_hda_codec_eapd_power_filter - A power filter callback for EAPD
 * @codec: the HDA codec
 * @nid: widget NID
 * @power_state: power state to evalue
 *
 * Don't power down the widget if it controls eapd and EAPD_BTLENABLE is set.
 * This can be used a codec power_filter callback.
 */
3474 3475 3476
unsigned int snd_hda_codec_eapd_power_filter(struct hda_codec *codec,
					     hda_nid_t nid,
					     unsigned int power_state)
3477
{
3478
	if (nid == codec->core.afg || nid == codec->core.mfg)
3479
		return power_state;
3480 3481 3482 3483 3484 3485 3486 3487 3488 3489
	if (power_state == AC_PWRST_D3 &&
	    get_wcaps_type(get_wcaps(codec, nid)) == AC_WID_PIN &&
	    (snd_hda_query_pin_caps(codec, nid) & AC_PINCAP_EAPD)) {
		int eapd = snd_hda_codec_read(codec, nid, 0,
					      AC_VERB_GET_EAPD_BTLENABLE, 0);
		if (eapd & 0x02)
			return AC_PWRST_D0;
	}
	return power_state;
}
3490
EXPORT_SYMBOL_GPL(snd_hda_codec_eapd_power_filter);
3491

3492
/*
3493
 * set power state of the codec, and return the power state
3494
 */
3495
static unsigned int hda_set_power_state(struct hda_codec *codec,
3496
					unsigned int power_state)
3497
{
3498
	hda_nid_t fg = codec->core.afg ? codec->core.afg : codec->core.mfg;
3499 3500
	int count;
	unsigned int state;
3501
	int flags = 0;
3502

3503
	/* this delay seems necessary to avoid click noise at power-down */
3504
	if (power_state == AC_PWRST_D3) {
3505
		if (codec->depop_delay < 0)
3506
			msleep(codec_has_epss(codec) ? 10 : 100);
3507 3508
		else if (codec->depop_delay > 0)
			msleep(codec->depop_delay);
3509
		flags = HDA_RW_NO_RESPONSE_FALLBACK;
3510
	}
3511 3512 3513

	/* repeat power states setting at most 10 times*/
	for (count = 0; count < 10; count++) {
3514 3515 3516 3517
		if (codec->patch_ops.set_power_state)
			codec->patch_ops.set_power_state(codec, fg,
							 power_state);
		else {
3518 3519 3520 3521 3522 3523 3524
			state = power_state;
			if (codec->power_filter)
				state = codec->power_filter(codec, fg, state);
			if (state == power_state || power_state != AC_PWRST_D3)
				snd_hda_codec_read(codec, fg, flags,
						   AC_VERB_SET_POWER_STATE,
						   state);
3525
			snd_hda_codec_set_power_to_all(codec, fg, power_state);
3526 3527
		}
		state = hda_sync_power_state(codec, fg, power_state);
3528 3529 3530
		if (!(state & AC_PWRST_ERROR))
			break;
	}
3531

3532
	return state;
3533
}
3534

3535 3536 3537 3538 3539
/* sync power states of all widgets;
 * this is called at the end of codec parsing
 */
static void sync_power_up_states(struct hda_codec *codec)
{
3540
	hda_nid_t nid;
3541

3542 3543
	/* don't care if no filter is used */
	if (!codec->power_filter)
3544 3545
		return;

3546
	for_each_hda_codec_node(nid, codec) {
3547
		unsigned int wcaps = get_wcaps(codec, nid);
3548
		unsigned int target;
3549 3550 3551 3552 3553
		if (!(wcaps & AC_WCAP_POWER))
			continue;
		target = codec->power_filter(codec, nid, AC_PWRST_D0);
		if (target == AC_PWRST_D0)
			continue;
3554
		if (!snd_hda_check_power_state(codec, nid, target))
3555 3556 3557 3558 3559
			snd_hda_codec_write(codec, nid, 0,
					    AC_VERB_SET_POWER_STATE, target);
	}
}

3560
#ifdef CONFIG_SND_HDA_RECONFIG
T
Takashi Iwai 已提交
3561 3562 3563 3564 3565 3566 3567 3568 3569 3570
/* execute additional init verbs */
static void hda_exec_init_verbs(struct hda_codec *codec)
{
	if (codec->init_verbs.list)
		snd_hda_sequence_write(codec, codec->init_verbs.list);
}
#else
static inline void hda_exec_init_verbs(struct hda_codec *codec) {}
#endif

3571
#ifdef CONFIG_PM
3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585 3586 3587 3588
/* update the power on/off account with the current jiffies */
static void update_power_acct(struct hda_codec *codec, bool on)
{
	unsigned long delta = jiffies - codec->power_jiffies;

	if (on)
		codec->power_on_acct += delta;
	else
		codec->power_off_acct += delta;
	codec->power_jiffies += delta;
}

void snd_hda_update_power_acct(struct hda_codec *codec)
{
	update_power_acct(codec, hda_codec_is_power_on(codec));
}

3589 3590
/*
 * call suspend and power-down; used both from PM and power-save
3591
 * this function returns the power state in the end
3592
 */
3593
static unsigned int hda_call_codec_suspend(struct hda_codec *codec)
3594
{
3595 3596
	unsigned int state;

3597
	atomic_inc(&codec->core.in_pm);
3598

3599
	if (codec->patch_ops.suspend)
3600
		codec->patch_ops.suspend(codec);
3601
	hda_cleanup_all_streams(codec);
3602
	state = hda_set_power_state(codec, AC_PWRST_D3);
3603
	update_power_acct(codec, true);
3604
	atomic_dec(&codec->core.in_pm);
3605
	return state;
3606 3607
}

3608 3609 3610 3611 3612 3613 3614 3615 3616 3617 3618
/* mark all entries of cmd and amp caches dirty */
static void hda_mark_cmd_cache_dirty(struct hda_codec *codec)
{
	int i;
	for (i = 0; i < codec->cmd_cache.buf.used; i++) {
		struct hda_cache_head *cmd;
		cmd = snd_array_elem(&codec->cmd_cache.buf, i);
		cmd->dirty = 1;
	}
	for (i = 0; i < codec->amp_cache.buf.used; i++) {
		struct hda_amp_info *amp;
3619
		amp = snd_array_elem(&codec->amp_cache.buf, i);
3620 3621 3622 3623
		amp->head.dirty = 1;
	}
}

3624 3625 3626 3627 3628
/*
 * kick up codec; used both from PM and power-save
 */
static void hda_call_codec_resume(struct hda_codec *codec)
{
3629
	atomic_inc(&codec->core.in_pm);
3630

3631 3632
	hda_mark_cmd_cache_dirty(codec);

3633 3634
	codec->power_jiffies = jiffies;

3635
	hda_set_power_state(codec, AC_PWRST_D0);
3636
	restore_shutup_pins(codec);
T
Takashi Iwai 已提交
3637
	hda_exec_init_verbs(codec);
3638
	snd_hda_jack_set_dirty_all(codec);
3639 3640 3641
	if (codec->patch_ops.resume)
		codec->patch_ops.resume(codec);
	else {
3642 3643
		if (codec->patch_ops.init)
			codec->patch_ops.init(codec);
3644 3645 3646
		snd_hda_codec_resume_amp(codec);
		snd_hda_codec_resume_cache(codec);
	}
3647 3648 3649

	if (codec->jackpoll_interval)
		hda_jackpoll_work(&codec->jackpoll_work.work);
3650
	else
3651
		snd_hda_jack_report_sync(codec);
3652
	atomic_dec(&codec->core.in_pm);
3653
}
3654

3655
static int hda_codec_runtime_suspend(struct device *dev)
3656 3657
{
	struct hda_codec *codec = dev_to_hda_codec(dev);
3658
	struct hda_pcm *pcm;
3659
	unsigned int state;
3660 3661

	cancel_delayed_work_sync(&codec->jackpoll_work);
3662 3663
	list_for_each_entry(pcm, &codec->pcm_list_head, list)
		snd_pcm_suspend_all(pcm->pcm);
3664
	state = hda_call_codec_suspend(codec);
3665 3666 3667
	if (codec_has_clkstop(codec) && codec_has_epss(codec) &&
	    (state & AC_PWRST_CLK_STOP_OK))
		snd_hdac_codec_link_down(&codec->core);
3668 3669 3670
	return 0;
}

3671
static int hda_codec_runtime_resume(struct device *dev)
3672
{
3673 3674
	struct hda_codec *codec = dev_to_hda_codec(dev);

3675
	snd_hdac_codec_link_up(&codec->core);
3676
	hda_call_codec_resume(codec);
3677
	pm_runtime_mark_last_busy(dev);
3678 3679
	return 0;
}
3680
#endif /* CONFIG_PM */
3681

3682 3683
/* referred in hda_bind.c */
const struct dev_pm_ops hda_codec_driver_pm = {
3684 3685 3686 3687
	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
				pm_runtime_force_resume)
	SET_RUNTIME_PM_OPS(hda_codec_runtime_suspend, hda_codec_runtime_resume,
			   NULL)
3688
};
3689

3690 3691 3692 3693 3694
/*
 * add standard channel maps if not specified
 */
static int add_std_chmaps(struct hda_codec *codec)
{
3695 3696
	struct hda_pcm *pcm;
	int str, err;
3697

3698
	list_for_each_entry(pcm, &codec->pcm_list_head, list) {
3699
		for (str = 0; str < 2; str++) {
3700
			struct hda_pcm_stream *hinfo = &pcm->stream[str];
3701
			struct snd_pcm_chmap *chmap;
3702
			const struct snd_pcm_chmap_elem *elem;
3703

3704
			if (pcm->own_chmap)
3705 3706 3707
				continue;
			if (!pcm || !hinfo->substreams)
				continue;
3708
			elem = hinfo->chmap ? hinfo->chmap : snd_pcm_std_chmaps;
3709
			err = snd_pcm_add_chmap_ctls(pcm->pcm, str, elem,
3710 3711 3712 3713 3714 3715 3716 3717 3718 3719
						     hinfo->channels_max,
						     0, &chmap);
			if (err < 0)
				return err;
			chmap->channel_mask = SND_PCM_CHMAP_MASK_2468;
		}
	}
	return 0;
}

3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732
/* default channel maps for 2.1 speakers;
 * since HD-audio supports only stereo, odd number channels are omitted
 */
const struct snd_pcm_chmap_elem snd_pcm_2_1_chmaps[] = {
	{ .channels = 2,
	  .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR } },
	{ .channels = 4,
	  .map = { SNDRV_CHMAP_FL, SNDRV_CHMAP_FR,
		   SNDRV_CHMAP_LFE, SNDRV_CHMAP_LFE } },
	{ }
};
EXPORT_SYMBOL_GPL(snd_pcm_2_1_chmaps);

3733 3734 3735
int snd_hda_codec_build_controls(struct hda_codec *codec)
{
	int err = 0;
T
Takashi Iwai 已提交
3736
	hda_exec_init_verbs(codec);
3737 3738 3739 3740 3741 3742 3743
	/* continue to initialize... */
	if (codec->patch_ops.init)
		err = codec->patch_ops.init(codec);
	if (!err && codec->patch_ops.build_controls)
		err = codec->patch_ops.build_controls(codec);
	if (err < 0)
		return err;
3744 3745 3746 3747 3748 3749

	/* we create chmaps here instead of build_pcms */
	err = add_std_chmaps(codec);
	if (err < 0)
		return err;

3750 3751 3752 3753
	if (codec->jackpoll_interval)
		hda_jackpoll_work(&codec->jackpoll_work.work);
	else
		snd_hda_jack_report_sync(codec); /* call at the last init point */
3754
	sync_power_up_states(codec);
L
Linus Torvalds 已提交
3755 3756 3757 3758 3759 3760
	return 0;
}

/*
 * stream formats
 */
T
Takashi Iwai 已提交
3761 3762 3763 3764 3765 3766
struct hda_rate_tbl {
	unsigned int hz;
	unsigned int alsa_bits;
	unsigned int hda_fmt;
};

3767 3768 3769 3770 3771
/* rate = base * mult / div */
#define HDA_RATE(base, mult, div) \
	(AC_FMT_BASE_##base##K | (((mult) - 1) << AC_FMT_MULT_SHIFT) | \
	 (((div) - 1) << AC_FMT_DIV_SHIFT))

T
Takashi Iwai 已提交
3772
static struct hda_rate_tbl rate_bits[] = {
L
Linus Torvalds 已提交
3773
	/* rate in Hz, ALSA rate bitmask, HDA format value */
3774 3775

	/* autodetected value used in snd_hda_query_supported_pcm */
3776 3777 3778 3779 3780 3781 3782 3783 3784 3785 3786
	{ 8000, SNDRV_PCM_RATE_8000, HDA_RATE(48, 1, 6) },
	{ 11025, SNDRV_PCM_RATE_11025, HDA_RATE(44, 1, 4) },
	{ 16000, SNDRV_PCM_RATE_16000, HDA_RATE(48, 1, 3) },
	{ 22050, SNDRV_PCM_RATE_22050, HDA_RATE(44, 1, 2) },
	{ 32000, SNDRV_PCM_RATE_32000, HDA_RATE(48, 2, 3) },
	{ 44100, SNDRV_PCM_RATE_44100, HDA_RATE(44, 1, 1) },
	{ 48000, SNDRV_PCM_RATE_48000, HDA_RATE(48, 1, 1) },
	{ 88200, SNDRV_PCM_RATE_88200, HDA_RATE(44, 2, 1) },
	{ 96000, SNDRV_PCM_RATE_96000, HDA_RATE(48, 2, 1) },
	{ 176400, SNDRV_PCM_RATE_176400, HDA_RATE(44, 4, 1) },
	{ 192000, SNDRV_PCM_RATE_192000, HDA_RATE(48, 4, 1) },
3787 3788 3789 3790
#define AC_PAR_PCM_RATE_BITS	11
	/* up to bits 10, 384kHZ isn't supported properly */

	/* not autodetected value */
3791
	{ 9600, SNDRV_PCM_RATE_KNOT, HDA_RATE(48, 1, 5) },
3792

T
Takashi Iwai 已提交
3793
	{ 0 } /* terminator */
L
Linus Torvalds 已提交
3794 3795 3796 3797
};

/**
 * snd_hda_calc_stream_format - calculate format bitset
3798
 * @codec: HD-audio codec
L
Linus Torvalds 已提交
3799 3800 3801 3802
 * @rate: the sample rate
 * @channels: the number of channels
 * @format: the PCM format (SNDRV_PCM_FORMAT_XXX)
 * @maxbps: the max. bps
3803
 * @spdif_ctls: HD-audio SPDIF status bits (0 if irrelevant)
L
Linus Torvalds 已提交
3804 3805 3806 3807 3808
 *
 * Calculate the format bitset from the given rate, channels and th PCM format.
 *
 * Return zero if invalid.
 */
3809 3810
unsigned int snd_hda_calc_stream_format(struct hda_codec *codec,
					unsigned int rate,
L
Linus Torvalds 已提交
3811 3812
					unsigned int channels,
					unsigned int format,
3813 3814
					unsigned int maxbps,
					unsigned short spdif_ctls)
L
Linus Torvalds 已提交
3815 3816 3817 3818
{
	int i;
	unsigned int val = 0;

T
Takashi Iwai 已提交
3819 3820 3821
	for (i = 0; rate_bits[i].hz; i++)
		if (rate_bits[i].hz == rate) {
			val = rate_bits[i].hda_fmt;
L
Linus Torvalds 已提交
3822 3823
			break;
		}
T
Takashi Iwai 已提交
3824
	if (!rate_bits[i].hz) {
3825
		codec_dbg(codec, "invalid rate %d\n", rate);
L
Linus Torvalds 已提交
3826 3827 3828 3829
		return 0;
	}

	if (channels == 0 || channels > 8) {
3830
		codec_dbg(codec, "invalid channels %d\n", channels);
L
Linus Torvalds 已提交
3831 3832 3833 3834 3835
		return 0;
	}
	val |= channels - 1;

	switch (snd_pcm_format_width(format)) {
3836
	case 8:
3837
		val |= AC_FMT_BITS_8;
3838 3839
		break;
	case 16:
3840
		val |= AC_FMT_BITS_16;
3841
		break;
L
Linus Torvalds 已提交
3842 3843 3844
	case 20:
	case 24:
	case 32:
3845
		if (maxbps >= 32 || format == SNDRV_PCM_FORMAT_FLOAT_LE)
3846
			val |= AC_FMT_BITS_32;
L
Linus Torvalds 已提交
3847
		else if (maxbps >= 24)
3848
			val |= AC_FMT_BITS_24;
L
Linus Torvalds 已提交
3849
		else
3850
			val |= AC_FMT_BITS_20;
L
Linus Torvalds 已提交
3851 3852
		break;
	default:
3853
		codec_dbg(codec, "invalid format width %d\n",
3854
			  snd_pcm_format_width(format));
L
Linus Torvalds 已提交
3855 3856 3857
		return 0;
	}

3858
	if (spdif_ctls & AC_DIG1_NONAUDIO)
3859
		val |= AC_FMT_TYPE_NON_PCM;
3860

L
Linus Torvalds 已提交
3861 3862
	return val;
}
3863
EXPORT_SYMBOL_GPL(snd_hda_calc_stream_format);
L
Linus Torvalds 已提交
3864

3865 3866
static unsigned int get_pcm_param(struct hda_codec *codec, hda_nid_t nid,
				  int dir)
3867 3868
{
	unsigned int val = 0;
3869
	if (nid != codec->core.afg &&
3870 3871 3872
	    (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD))
		val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
	if (!val || val == -1)
3873
		val = snd_hda_param_read(codec, codec->core.afg, AC_PAR_PCM);
3874 3875 3876 3877 3878 3879 3880
	if (!val || val == -1)
		return 0;
	return val;
}

static unsigned int query_pcm_param(struct hda_codec *codec, hda_nid_t nid)
{
3881
	return query_caps_hash(codec, nid, 0, HDA_HASH_PARPCM_KEY(nid),
3882 3883 3884
			       get_pcm_param);
}

3885 3886
static unsigned int get_stream_param(struct hda_codec *codec, hda_nid_t nid,
				     int dir)
3887 3888 3889
{
	unsigned int streams = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
	if (!streams || streams == -1)
3890
		streams = snd_hda_param_read(codec, codec->core.afg, AC_PAR_STREAM);
3891 3892 3893 3894 3895 3896 3897
	if (!streams || streams == -1)
		return 0;
	return streams;
}

static unsigned int query_stream_param(struct hda_codec *codec, hda_nid_t nid)
{
3898
	return query_caps_hash(codec, nid, 0, HDA_HASH_PARSTR_KEY(nid),
3899 3900 3901
			       get_stream_param);
}

L
Linus Torvalds 已提交
3902 3903 3904 3905 3906 3907 3908 3909 3910 3911 3912 3913 3914
/**
 * snd_hda_query_supported_pcm - query the supported PCM rates and formats
 * @codec: the HDA codec
 * @nid: NID to query
 * @ratesp: the pointer to store the detected rate bitflags
 * @formatsp: the pointer to store the detected formats
 * @bpsp: the pointer to store the detected format widths
 *
 * Queries the supported PCM rates and formats.  The NULL @ratesp, @formatsp
 * or @bsps argument is ignored.
 *
 * Returns 0 if successful, otherwise a negative error code.
 */
3915
int snd_hda_query_supported_pcm(struct hda_codec *codec, hda_nid_t nid,
L
Linus Torvalds 已提交
3916 3917
				u32 *ratesp, u64 *formatsp, unsigned int *bpsp)
{
3918
	unsigned int i, val, wcaps;
L
Linus Torvalds 已提交
3919

3920
	wcaps = get_wcaps(codec, nid);
3921
	val = query_pcm_param(codec, nid);
L
Linus Torvalds 已提交
3922 3923 3924

	if (ratesp) {
		u32 rates = 0;
3925
		for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++) {
L
Linus Torvalds 已提交
3926
			if (val & (1 << i))
T
Takashi Iwai 已提交
3927
				rates |= rate_bits[i].alsa_bits;
L
Linus Torvalds 已提交
3928
		}
3929
		if (rates == 0) {
3930 3931 3932 3933
			codec_err(codec,
				  "rates == 0 (nid=0x%x, val=0x%x, ovrd=%i)\n",
				  nid, val,
				  (wcaps & AC_WCAP_FORMAT_OVRD) ? 1 : 0);
3934 3935
			return -EIO;
		}
L
Linus Torvalds 已提交
3936 3937 3938 3939 3940
		*ratesp = rates;
	}

	if (formatsp || bpsp) {
		u64 formats = 0;
3941
		unsigned int streams, bps;
L
Linus Torvalds 已提交
3942

3943 3944
		streams = query_stream_param(codec, nid);
		if (!streams)
L
Linus Torvalds 已提交
3945 3946 3947 3948 3949 3950 3951 3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963 3964 3965
			return -EIO;

		bps = 0;
		if (streams & AC_SUPFMT_PCM) {
			if (val & AC_SUPPCM_BITS_8) {
				formats |= SNDRV_PCM_FMTBIT_U8;
				bps = 8;
			}
			if (val & AC_SUPPCM_BITS_16) {
				formats |= SNDRV_PCM_FMTBIT_S16_LE;
				bps = 16;
			}
			if (wcaps & AC_WCAP_DIGITAL) {
				if (val & AC_SUPPCM_BITS_32)
					formats |= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE;
				if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24))
					formats |= SNDRV_PCM_FMTBIT_S32_LE;
				if (val & AC_SUPPCM_BITS_24)
					bps = 24;
				else if (val & AC_SUPPCM_BITS_20)
					bps = 20;
T
Takashi Iwai 已提交
3966 3967
			} else if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24|
					  AC_SUPPCM_BITS_32)) {
L
Linus Torvalds 已提交
3968 3969 3970 3971 3972
				formats |= SNDRV_PCM_FMTBIT_S32_LE;
				if (val & AC_SUPPCM_BITS_32)
					bps = 32;
				else if (val & AC_SUPPCM_BITS_24)
					bps = 24;
3973 3974
				else if (val & AC_SUPPCM_BITS_20)
					bps = 20;
L
Linus Torvalds 已提交
3975 3976
			}
		}
3977
#if 0 /* FIXME: CS4206 doesn't work, which is the only codec supporting float */
3978
		if (streams & AC_SUPFMT_FLOAT32) {
L
Linus Torvalds 已提交
3979
			formats |= SNDRV_PCM_FMTBIT_FLOAT_LE;
3980 3981
			if (!bps)
				bps = 32;
3982
		}
3983
#endif
3984
		if (streams == AC_SUPFMT_AC3) {
T
Takashi Iwai 已提交
3985
			/* should be exclusive */
L
Linus Torvalds 已提交
3986 3987 3988 3989 3990 3991
			/* temporary hack: we have still no proper support
			 * for the direct AC3 stream...
			 */
			formats |= SNDRV_PCM_FMTBIT_U8;
			bps = 8;
		}
3992
		if (formats == 0) {
3993 3994 3995 3996 3997
			codec_err(codec,
				  "formats == 0 (nid=0x%x, val=0x%x, ovrd=%i, streams=0x%x)\n",
				  nid, val,
				  (wcaps & AC_WCAP_FORMAT_OVRD) ? 1 : 0,
				  streams);
3998 3999
			return -EIO;
		}
L
Linus Torvalds 已提交
4000 4001 4002 4003 4004 4005 4006 4007
		if (formatsp)
			*formatsp = formats;
		if (bpsp)
			*bpsp = bps;
	}

	return 0;
}
4008
EXPORT_SYMBOL_GPL(snd_hda_query_supported_pcm);
L
Linus Torvalds 已提交
4009 4010

/**
4011 4012 4013 4014 4015 4016
 * snd_hda_is_supported_format - Check the validity of the format
 * @codec: HD-audio codec
 * @nid: NID to check
 * @format: the HD-audio format value to check
 *
 * Check whether the given node supports the format value.
L
Linus Torvalds 已提交
4017 4018 4019 4020 4021 4022 4023 4024 4025
 *
 * Returns 1 if supported, 0 if not.
 */
int snd_hda_is_supported_format(struct hda_codec *codec, hda_nid_t nid,
				unsigned int format)
{
	int i;
	unsigned int val = 0, rate, stream;

4026 4027 4028
	val = query_pcm_param(codec, nid);
	if (!val)
		return 0;
L
Linus Torvalds 已提交
4029 4030

	rate = format & 0xff00;
4031
	for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++)
T
Takashi Iwai 已提交
4032
		if (rate_bits[i].hda_fmt == rate) {
L
Linus Torvalds 已提交
4033 4034 4035 4036
			if (val & (1 << i))
				break;
			return 0;
		}
4037
	if (i >= AC_PAR_PCM_RATE_BITS)
L
Linus Torvalds 已提交
4038 4039
		return 0;

4040 4041
	stream = query_stream_param(codec, nid);
	if (!stream)
L
Linus Torvalds 已提交
4042 4043 4044 4045 4046
		return 0;

	if (stream & AC_SUPFMT_PCM) {
		switch (format & 0xf0) {
		case 0x00:
T
Takashi Iwai 已提交
4047
			if (!(val & AC_SUPPCM_BITS_8))
L
Linus Torvalds 已提交
4048 4049 4050
				return 0;
			break;
		case 0x10:
T
Takashi Iwai 已提交
4051
			if (!(val & AC_SUPPCM_BITS_16))
L
Linus Torvalds 已提交
4052 4053 4054
				return 0;
			break;
		case 0x20:
T
Takashi Iwai 已提交
4055
			if (!(val & AC_SUPPCM_BITS_20))
L
Linus Torvalds 已提交
4056 4057 4058
				return 0;
			break;
		case 0x30:
T
Takashi Iwai 已提交
4059
			if (!(val & AC_SUPPCM_BITS_24))
L
Linus Torvalds 已提交
4060 4061 4062
				return 0;
			break;
		case 0x40:
T
Takashi Iwai 已提交
4063
			if (!(val & AC_SUPPCM_BITS_32))
L
Linus Torvalds 已提交
4064 4065 4066 4067 4068 4069 4070 4071 4072 4073 4074
				return 0;
			break;
		default:
			return 0;
		}
	} else {
		/* FIXME: check for float32 and AC3? */
	}

	return 1;
}
4075
EXPORT_SYMBOL_GPL(snd_hda_is_supported_format);
L
Linus Torvalds 已提交
4076 4077 4078 4079 4080 4081

/*
 * PCM stuff
 */
static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
				      struct hda_codec *codec,
4082
				      struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
4083 4084 4085 4086 4087 4088 4089 4090
{
	return 0;
}

static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
				   struct hda_codec *codec,
				   unsigned int stream_tag,
				   unsigned int format,
4091
				   struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
4092 4093 4094 4095 4096 4097 4098
{
	snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
	return 0;
}

static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
				   struct hda_codec *codec,
4099
				   struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
4100
{
4101
	snd_hda_codec_cleanup_stream(codec, hinfo->nid);
L
Linus Torvalds 已提交
4102 4103 4104
	return 0;
}

4105 4106
static int set_pcm_default_values(struct hda_codec *codec,
				  struct hda_pcm_stream *info)
L
Linus Torvalds 已提交
4107
{
4108 4109
	int err;

T
Takashi Iwai 已提交
4110 4111
	/* query support PCM information from the given NID */
	if (info->nid && (!info->rates || !info->formats)) {
4112
		err = snd_hda_query_supported_pcm(codec, info->nid,
T
Takashi Iwai 已提交
4113 4114 4115
				info->rates ? NULL : &info->rates,
				info->formats ? NULL : &info->formats,
				info->maxbps ? NULL : &info->maxbps);
4116 4117
		if (err < 0)
			return err;
L
Linus Torvalds 已提交
4118 4119 4120 4121 4122 4123
	}
	if (info->ops.open == NULL)
		info->ops.open = hda_pcm_default_open_close;
	if (info->ops.close == NULL)
		info->ops.close = hda_pcm_default_open_close;
	if (info->ops.prepare == NULL) {
4124 4125
		if (snd_BUG_ON(!info->nid))
			return -EINVAL;
L
Linus Torvalds 已提交
4126 4127 4128
		info->ops.prepare = hda_pcm_default_prepare;
	}
	if (info->ops.cleanup == NULL) {
4129 4130
		if (snd_BUG_ON(!info->nid))
			return -EINVAL;
L
Linus Torvalds 已提交
4131 4132 4133 4134 4135
		info->ops.cleanup = hda_pcm_default_cleanup;
	}
	return 0;
}

4136 4137 4138
/*
 * codec prepare/cleanup entries
 */
T
Takashi Iwai 已提交
4139 4140 4141 4142 4143 4144 4145 4146 4147 4148 4149
/**
 * snd_hda_codec_prepare - Prepare a stream
 * @codec: the HDA codec
 * @hinfo: PCM information
 * @stream: stream tag to assign
 * @format: format id to assign
 * @substream: PCM substream to assign
 *
 * Calls the prepare callback set by the codec with the given arguments.
 * Clean up the inactive streams when successful.
 */
4150 4151 4152 4153 4154 4155 4156
int snd_hda_codec_prepare(struct hda_codec *codec,
			  struct hda_pcm_stream *hinfo,
			  unsigned int stream,
			  unsigned int format,
			  struct snd_pcm_substream *substream)
{
	int ret;
4157
	mutex_lock(&codec->bus->prepare_mutex);
4158 4159 4160 4161 4162
	if (hinfo->ops.prepare)
		ret = hinfo->ops.prepare(hinfo, codec, stream, format,
					 substream);
	else
		ret = -ENODEV;
4163 4164
	if (ret >= 0)
		purify_inactive_streams(codec);
4165
	mutex_unlock(&codec->bus->prepare_mutex);
4166 4167
	return ret;
}
4168
EXPORT_SYMBOL_GPL(snd_hda_codec_prepare);
4169

T
Takashi Iwai 已提交
4170 4171 4172 4173 4174 4175 4176 4177
/**
 * snd_hda_codec_cleanup - Prepare a stream
 * @codec: the HDA codec
 * @hinfo: PCM information
 * @substream: PCM substream
 *
 * Calls the cleanup callback set by the codec with the given arguments.
 */
4178 4179 4180 4181
void snd_hda_codec_cleanup(struct hda_codec *codec,
			   struct hda_pcm_stream *hinfo,
			   struct snd_pcm_substream *substream)
{
4182
	mutex_lock(&codec->bus->prepare_mutex);
4183 4184
	if (hinfo->ops.cleanup)
		hinfo->ops.cleanup(hinfo, codec, substream);
4185
	mutex_unlock(&codec->bus->prepare_mutex);
4186
}
4187
EXPORT_SYMBOL_GPL(snd_hda_codec_cleanup);
4188

4189
/* global */
4190 4191 4192 4193
const char *snd_hda_pcm_type_name[HDA_PCM_NTYPES] = {
	"Audio", "SPDIF", "HDMI", "Modem"
};

T
Takashi Iwai 已提交
4194 4195 4196
/*
 * get the empty PCM device number to assign
 */
4197
static int get_empty_pcm_device(struct hda_bus *bus, unsigned int type)
T
Takashi Iwai 已提交
4198
{
4199
	/* audio device indices; not linear to keep compatibility */
4200 4201 4202
	/* assigned to static slots up to dev#10; if more needed, assign
	 * the later slot dynamically (when CONFIG_SND_DYNAMIC_MINORS=y)
	 */
4203 4204 4205
	static int audio_idx[HDA_PCM_NTYPES][5] = {
		[HDA_PCM_TYPE_AUDIO] = { 0, 2, 4, 5, -1 },
		[HDA_PCM_TYPE_SPDIF] = { 1, -1 },
4206
		[HDA_PCM_TYPE_HDMI]  = { 3, 7, 8, 9, -1 },
4207
		[HDA_PCM_TYPE_MODEM] = { 6, -1 },
T
Takashi Iwai 已提交
4208
	};
4209 4210 4211
	int i;

	if (type >= HDA_PCM_NTYPES) {
4212
		dev_err(bus->card->dev, "Invalid PCM type %d\n", type);
T
Takashi Iwai 已提交
4213 4214
		return -EINVAL;
	}
4215

4216 4217 4218 4219 4220
	for (i = 0; audio_idx[type][i] >= 0; i++) {
#ifndef CONFIG_SND_DYNAMIC_MINORS
		if (audio_idx[type][i] >= 8)
			break;
#endif
4221 4222
		if (!test_and_set_bit(audio_idx[type][i], bus->pcm_dev_bits))
			return audio_idx[type][i];
4223
	}
4224

4225
#ifdef CONFIG_SND_DYNAMIC_MINORS
4226 4227 4228 4229 4230
	/* non-fixed slots starting from 10 */
	for (i = 10; i < 32; i++) {
		if (!test_and_set_bit(i, bus->pcm_dev_bits))
			return i;
	}
4231
#endif
4232

4233
	dev_warn(bus->card->dev, "Too many %s devices\n",
4234
		snd_hda_pcm_type_name[type]);
4235
#ifndef CONFIG_SND_DYNAMIC_MINORS
4236 4237
	dev_warn(bus->card->dev,
		 "Consider building the kernel with CONFIG_SND_DYNAMIC_MINORS=y\n");
4238
#endif
4239
	return -EAGAIN;
T
Takashi Iwai 已提交
4240 4241
}

4242 4243
/* call build_pcms ops of the given codec and set up the default parameters */
int snd_hda_codec_parse_pcms(struct hda_codec *codec)
4244
{
4245
	struct hda_pcm *cpcm;
4246
	int err;
4247

4248
	if (!list_empty(&codec->pcm_list_head))
4249 4250 4251 4252 4253 4254 4255 4256
		return 0; /* already parsed */

	if (!codec->patch_ops.build_pcms)
		return 0;

	err = codec->patch_ops.build_pcms(codec);
	if (err < 0) {
		codec_err(codec, "cannot build PCMs for #%d (error %d)\n",
4257
			  codec->core.addr, err);
4258 4259 4260
		return err;
	}

4261
	list_for_each_entry(cpcm, &codec->pcm_list_head, list) {
4262 4263 4264 4265 4266 4267 4268
		int stream;

		for (stream = 0; stream < 2; stream++) {
			struct hda_pcm_stream *info = &cpcm->stream[stream];

			if (!info->substreams)
				continue;
4269
			err = set_pcm_default_values(codec, info);
4270 4271 4272 4273
			if (err < 0) {
				codec_warn(codec,
					   "fail to setup default for PCM %s\n",
					   cpcm->name);
4274
				return err;
4275
			}
4276 4277
		}
	}
4278 4279

	return 0;
4280 4281
}

T
Takashi Iwai 已提交
4282 4283 4284
/* assign all PCMs of the given codec */
int snd_hda_codec_build_pcms(struct hda_codec *codec)
{
4285
	struct hda_bus *bus = codec->bus;
4286
	struct hda_pcm *cpcm;
4287
	int dev, err;
T
Takashi Iwai 已提交
4288

4289 4290 4291 4292 4293 4294 4295
	if (snd_BUG_ON(!bus->ops.attach_pcm))
		return -EINVAL;

	err = snd_hda_codec_parse_pcms(codec);
	if (err < 0) {
		snd_hda_codec_reset(codec);
		return err;
T
Takashi Iwai 已提交
4296
	}
4297 4298

	/* attach a new PCM streams */
4299
	list_for_each_entry(cpcm, &codec->pcm_list_head, list) {
4300 4301
		if (cpcm->pcm)
			continue; /* already attached */
T
Takashi Iwai 已提交
4302
		if (!cpcm->stream[0].substreams && !cpcm->stream[1].substreams)
4303
			continue; /* no substreams assigned */
T
Takashi Iwai 已提交
4304

4305 4306 4307 4308 4309 4310 4311 4312
		dev = get_empty_pcm_device(bus, cpcm->pcm_type);
		if (dev < 0)
			continue; /* no fatal error */
		cpcm->device = dev;
		err =  bus->ops.attach_pcm(bus, codec, cpcm);
		if (err < 0) {
			codec_err(codec,
				  "cannot attach PCM stream %d for codec #%d\n",
4313
				  dev, codec->core.addr);
4314
			continue; /* no fatal error */
T
Takashi Iwai 已提交
4315 4316
		}
	}
4317

T
Takashi Iwai 已提交
4318 4319 4320
	return 0;
}

L
Linus Torvalds 已提交
4321 4322 4323
/**
 * snd_hda_add_new_ctls - create controls from the array
 * @codec: the HDA codec
4324
 * @knew: the array of struct snd_kcontrol_new
L
Linus Torvalds 已提交
4325 4326 4327 4328 4329 4330
 *
 * This helper function creates and add new controls in the given array.
 * The array must be terminated with an empty entry as terminator.
 *
 * Returns 0 if successful, or a negative error code.
 */
4331 4332
int snd_hda_add_new_ctls(struct hda_codec *codec,
			 const struct snd_kcontrol_new *knew)
L
Linus Torvalds 已提交
4333
{
4334
	int err;
L
Linus Torvalds 已提交
4335 4336

	for (; knew->name; knew++) {
4337
		struct snd_kcontrol *kctl;
4338
		int addr = 0, idx = 0;
4339 4340
		if (knew->iface == -1)	/* skip this codec private value */
			continue;
4341
		for (;;) {
4342
			kctl = snd_ctl_new1(knew, codec);
T
Takashi Iwai 已提交
4343
			if (!kctl)
4344
				return -ENOMEM;
4345 4346 4347 4348
			if (addr > 0)
				kctl->id.device = addr;
			if (idx > 0)
				kctl->id.index = idx;
4349
			err = snd_hda_ctl_add(codec, 0, kctl);
4350 4351 4352 4353 4354 4355
			if (!err)
				break;
			/* try first with another device index corresponding to
			 * the codec addr; if it still fails (or it's the
			 * primary codec), then try another control index
			 */
4356 4357
			if (!addr && codec->core.addr)
				addr = codec->core.addr;
4358 4359
			else if (!idx && !knew->index) {
				idx = find_empty_mixer_ctl_idx(codec,
4360
							       knew->name, 0);
4361 4362 4363
				if (idx <= 0)
					return err;
			} else
4364 4365
				return err;
		}
L
Linus Torvalds 已提交
4366 4367 4368
	}
	return 0;
}
4369
EXPORT_SYMBOL_GPL(snd_hda_add_new_ctls);
L
Linus Torvalds 已提交
4370

4371
#ifdef CONFIG_PM
4372
static void codec_set_power_save(struct hda_codec *codec, int delay)
4373
{
4374 4375 4376 4377 4378 4379 4380 4381 4382 4383 4384 4385
	struct device *dev = hda_codec_dev(codec);

	if (delay > 0) {
		pm_runtime_set_autosuspend_delay(dev, delay);
		pm_runtime_use_autosuspend(dev);
		pm_runtime_allow(dev);
		if (!pm_runtime_suspended(dev))
			pm_runtime_mark_last_busy(dev);
	} else {
		pm_runtime_dont_use_autosuspend(dev);
		pm_runtime_forbid(dev);
	}
4386
}
4387 4388 4389 4390 4391 4392 4393 4394 4395 4396 4397 4398

/**
 * snd_hda_set_power_save - reprogram autosuspend for the given delay
 * @bus: HD-audio bus
 * @delay: autosuspend delay in msec, 0 = off
 *
 * Synchronize the runtime PM autosuspend state from the power_save option.
 */
void snd_hda_set_power_save(struct hda_bus *bus, int delay)
{
	struct hda_codec *c;

4399
	list_for_each_codec(c, bus)
4400 4401 4402
		codec_set_power_save(c, delay);
}
EXPORT_SYMBOL_GPL(snd_hda_set_power_save);
4403

4404 4405 4406 4407 4408 4409 4410 4411 4412 4413 4414 4415
/**
 * snd_hda_check_amp_list_power - Check the amp list and update the power
 * @codec: HD-audio codec
 * @check: the object containing an AMP list and the status
 * @nid: NID to check / update
 *
 * Check whether the given NID is in the amp list.  If it's in the list,
 * check the current AMP status, and update the the power-status according
 * to the mute status.
 *
 * This function is supposed to be set or called from the check_power_status
 * patch ops.
4416
 */
4417 4418 4419 4420
int snd_hda_check_amp_list_power(struct hda_codec *codec,
				 struct hda_loopback_check *check,
				 hda_nid_t nid)
{
4421
	const struct hda_amp_list *p;
4422 4423 4424 4425 4426 4427 4428 4429 4430 4431 4432 4433 4434 4435 4436 4437 4438 4439 4440 4441 4442 4443 4444 4445 4446 4447 4448 4449 4450 4451
	int ch, v;

	if (!check->amplist)
		return 0;
	for (p = check->amplist; p->nid; p++) {
		if (p->nid == nid)
			break;
	}
	if (!p->nid)
		return 0; /* nothing changed */

	for (p = check->amplist; p->nid; p++) {
		for (ch = 0; ch < 2; ch++) {
			v = snd_hda_codec_amp_read(codec, p->nid, ch, p->dir,
						   p->idx);
			if (!(v & HDA_AMP_MUTE) && v > 0) {
				if (!check->power_on) {
					check->power_on = 1;
					snd_hda_power_up(codec);
				}
				return 1;
			}
		}
	}
	if (check->power_on) {
		check->power_on = 0;
		snd_hda_power_down(codec);
	}
	return 0;
}
4452
EXPORT_SYMBOL_GPL(snd_hda_check_amp_list_power);
4453
#endif
L
Linus Torvalds 已提交
4454 4455 4456 4457

/*
 * input MUX helper
 */
4458 4459 4460

/**
 * snd_hda_input_mux_info_info - Info callback helper for the input-mux enum
4461 4462
 * @imux: imux helper object
 * @uinfo: pointer to get/store the data
4463
 */
T
Takashi Iwai 已提交
4464 4465
int snd_hda_input_mux_info(const struct hda_input_mux *imux,
			   struct snd_ctl_elem_info *uinfo)
L
Linus Torvalds 已提交
4466 4467 4468 4469 4470 4471
{
	unsigned int index;

	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
	uinfo->count = 1;
	uinfo->value.enumerated.items = imux->num_items;
4472 4473
	if (!imux->num_items)
		return 0;
L
Linus Torvalds 已提交
4474 4475 4476 4477 4478 4479
	index = uinfo->value.enumerated.item;
	if (index >= imux->num_items)
		index = imux->num_items - 1;
	strcpy(uinfo->value.enumerated.name, imux->items[index].label);
	return 0;
}
4480
EXPORT_SYMBOL_GPL(snd_hda_input_mux_info);
L
Linus Torvalds 已提交
4481

4482 4483
/**
 * snd_hda_input_mux_info_put - Put callback helper for the input-mux enum
4484 4485 4486 4487 4488
 * @codec: the HDA codec
 * @imux: imux helper object
 * @ucontrol: pointer to get/store the data
 * @nid: input mux NID
 * @cur_val: pointer to get/store the current imux value
4489
 */
T
Takashi Iwai 已提交
4490 4491 4492 4493
int snd_hda_input_mux_put(struct hda_codec *codec,
			  const struct hda_input_mux *imux,
			  struct snd_ctl_elem_value *ucontrol,
			  hda_nid_t nid,
L
Linus Torvalds 已提交
4494 4495 4496 4497
			  unsigned int *cur_val)
{
	unsigned int idx;

4498 4499
	if (!imux->num_items)
		return 0;
L
Linus Torvalds 已提交
4500 4501 4502
	idx = ucontrol->value.enumerated.item[0];
	if (idx >= imux->num_items)
		idx = imux->num_items - 1;
4503
	if (*cur_val == idx)
L
Linus Torvalds 已提交
4504
		return 0;
4505 4506
	snd_hda_codec_write_cache(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
				  imux->items[idx].index);
L
Linus Torvalds 已提交
4507 4508 4509
	*cur_val = idx;
	return 1;
}
4510
EXPORT_SYMBOL_GPL(snd_hda_input_mux_put);
L
Linus Torvalds 已提交
4511 4512


4513 4514 4515 4516 4517 4518 4519
/**
 * snd_hda_enum_helper_info - Helper for simple enum ctls
 * @kcontrol: ctl element
 * @uinfo: pointer to get/store the data
 * @num_items: number of enum items
 * @texts: enum item string array
 *
4520 4521 4522 4523 4524 4525 4526 4527 4528 4529 4530 4531 4532 4533 4534 4535
 * process kcontrol info callback of a simple string enum array
 * when @num_items is 0 or @texts is NULL, assume a boolean enum array
 */
int snd_hda_enum_helper_info(struct snd_kcontrol *kcontrol,
			     struct snd_ctl_elem_info *uinfo,
			     int num_items, const char * const *texts)
{
	static const char * const texts_default[] = {
		"Disabled", "Enabled"
	};

	if (!texts || !num_items) {
		num_items = 2;
		texts = texts_default;
	}

T
Takashi Iwai 已提交
4536
	return snd_ctl_enum_info(uinfo, 1, num_items, texts);
4537
}
4538
EXPORT_SYMBOL_GPL(snd_hda_enum_helper_info);
4539

L
Linus Torvalds 已提交
4540 4541 4542 4543
/*
 * Multi-channel / digital-out PCM helper functions
 */

4544 4545 4546 4547
/* setup SPDIF output stream */
static void setup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid,
				 unsigned int stream_tag, unsigned int format)
{
4548 4549 4550 4551 4552 4553 4554 4555 4556 4557 4558 4559 4560 4561
	struct hda_spdif_out *spdif;
	unsigned int curr_fmt;
	bool reset;

	spdif = snd_hda_spdif_out_of_nid(codec, nid);
	curr_fmt = snd_hda_codec_read(codec, nid, 0,
				      AC_VERB_GET_STREAM_FORMAT, 0);
	reset = codec->spdif_status_reset &&
		(spdif->ctls & AC_DIG1_ENABLE) &&
		curr_fmt != format;

	/* turn off SPDIF if needed; otherwise the IEC958 bits won't be
	   updated */
	if (reset)
4562
		set_dig_out_convert(codec, nid,
4563
				    spdif->ctls & ~AC_DIG1_ENABLE & 0xff,
4564
				    -1);
4565
	snd_hda_codec_setup_stream(codec, nid, stream_tag, 0, format);
4566
	if (codec->slave_dig_outs) {
4567
		const hda_nid_t *d;
4568 4569 4570 4571
		for (d = codec->slave_dig_outs; *d; d++)
			snd_hda_codec_setup_stream(codec, *d, stream_tag, 0,
						   format);
	}
4572
	/* turn on again (if needed) */
4573
	if (reset)
4574
		set_dig_out_convert(codec, nid,
4575
				    spdif->ctls & 0xff, -1);
4576
}
4577

4578 4579 4580 4581
static void cleanup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid)
{
	snd_hda_codec_cleanup_stream(codec, nid);
	if (codec->slave_dig_outs) {
4582
		const hda_nid_t *d;
4583 4584
		for (d = codec->slave_dig_outs; *d; d++)
			snd_hda_codec_cleanup_stream(codec, *d);
4585
	}
4586 4587
}

4588 4589
/**
 * snd_hda_multi_out_dig_open - open the digital out in the exclusive mode
4590 4591
 * @codec: the HDA codec
 * @mout: hda_multi_out object
L
Linus Torvalds 已提交
4592
 */
T
Takashi Iwai 已提交
4593 4594
int snd_hda_multi_out_dig_open(struct hda_codec *codec,
			       struct hda_multi_out *mout)
L
Linus Torvalds 已提交
4595
{
4596
	mutex_lock(&codec->spdif_mutex);
4597 4598
	if (mout->dig_out_used == HDA_DIG_ANALOG_DUP)
		/* already opened as analog dup; reset it once */
4599
		cleanup_dig_out_stream(codec, mout->dig_out_nid);
L
Linus Torvalds 已提交
4600
	mout->dig_out_used = HDA_DIG_EXCLUSIVE;
4601
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
4602 4603
	return 0;
}
4604
EXPORT_SYMBOL_GPL(snd_hda_multi_out_dig_open);
L
Linus Torvalds 已提交
4605

4606 4607
/**
 * snd_hda_multi_out_dig_prepare - prepare the digital out stream
4608 4609 4610 4611 4612
 * @codec: the HDA codec
 * @mout: hda_multi_out object
 * @stream_tag: stream tag to assign
 * @format: format id to assign
 * @substream: PCM substream to assign
4613
 */
4614 4615 4616 4617 4618 4619 4620 4621 4622 4623 4624
int snd_hda_multi_out_dig_prepare(struct hda_codec *codec,
				  struct hda_multi_out *mout,
				  unsigned int stream_tag,
				  unsigned int format,
				  struct snd_pcm_substream *substream)
{
	mutex_lock(&codec->spdif_mutex);
	setup_dig_out_stream(codec, mout->dig_out_nid, stream_tag, format);
	mutex_unlock(&codec->spdif_mutex);
	return 0;
}
4625
EXPORT_SYMBOL_GPL(snd_hda_multi_out_dig_prepare);
4626

4627 4628
/**
 * snd_hda_multi_out_dig_cleanup - clean-up the digital out stream
4629 4630
 * @codec: the HDA codec
 * @mout: hda_multi_out object
4631
 */
4632 4633 4634 4635 4636 4637 4638 4639
int snd_hda_multi_out_dig_cleanup(struct hda_codec *codec,
				  struct hda_multi_out *mout)
{
	mutex_lock(&codec->spdif_mutex);
	cleanup_dig_out_stream(codec, mout->dig_out_nid);
	mutex_unlock(&codec->spdif_mutex);
	return 0;
}
4640
EXPORT_SYMBOL_GPL(snd_hda_multi_out_dig_cleanup);
4641

4642 4643
/**
 * snd_hda_multi_out_dig_close - release the digital out stream
4644 4645
 * @codec: the HDA codec
 * @mout: hda_multi_out object
L
Linus Torvalds 已提交
4646
 */
T
Takashi Iwai 已提交
4647 4648
int snd_hda_multi_out_dig_close(struct hda_codec *codec,
				struct hda_multi_out *mout)
L
Linus Torvalds 已提交
4649
{
4650
	mutex_lock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
4651
	mout->dig_out_used = 0;
4652
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
4653 4654
	return 0;
}
4655
EXPORT_SYMBOL_GPL(snd_hda_multi_out_dig_close);
L
Linus Torvalds 已提交
4656

4657 4658
/**
 * snd_hda_multi_out_analog_open - open analog outputs
4659 4660 4661 4662
 * @codec: the HDA codec
 * @mout: hda_multi_out object
 * @substream: PCM substream to assign
 * @hinfo: PCM information to assign
4663 4664 4665 4666
 *
 * Open analog outputs and set up the hw-constraints.
 * If the digital outputs can be opened as slave, open the digital
 * outputs, too.
L
Linus Torvalds 已提交
4667
 */
T
Takashi Iwai 已提交
4668 4669
int snd_hda_multi_out_analog_open(struct hda_codec *codec,
				  struct hda_multi_out *mout,
4670 4671 4672 4673 4674 4675 4676 4677 4678 4679 4680 4681 4682 4683 4684 4685 4686 4687 4688 4689 4690 4691 4692
				  struct snd_pcm_substream *substream,
				  struct hda_pcm_stream *hinfo)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	runtime->hw.channels_max = mout->max_channels;
	if (mout->dig_out_nid) {
		if (!mout->analog_rates) {
			mout->analog_rates = hinfo->rates;
			mout->analog_formats = hinfo->formats;
			mout->analog_maxbps = hinfo->maxbps;
		} else {
			runtime->hw.rates = mout->analog_rates;
			runtime->hw.formats = mout->analog_formats;
			hinfo->maxbps = mout->analog_maxbps;
		}
		if (!mout->spdif_rates) {
			snd_hda_query_supported_pcm(codec, mout->dig_out_nid,
						    &mout->spdif_rates,
						    &mout->spdif_formats,
						    &mout->spdif_maxbps);
		}
		mutex_lock(&codec->spdif_mutex);
		if (mout->share_spdif) {
4693 4694 4695 4696 4697 4698 4699 4700 4701 4702
			if ((runtime->hw.rates & mout->spdif_rates) &&
			    (runtime->hw.formats & mout->spdif_formats)) {
				runtime->hw.rates &= mout->spdif_rates;
				runtime->hw.formats &= mout->spdif_formats;
				if (mout->spdif_maxbps < hinfo->maxbps)
					hinfo->maxbps = mout->spdif_maxbps;
			} else {
				mout->share_spdif = 0;
				/* FIXME: need notify? */
			}
4703
		}
4704
		mutex_unlock(&codec->spdif_mutex);
4705
	}
L
Linus Torvalds 已提交
4706 4707 4708
	return snd_pcm_hw_constraint_step(substream->runtime, 0,
					  SNDRV_PCM_HW_PARAM_CHANNELS, 2);
}
4709
EXPORT_SYMBOL_GPL(snd_hda_multi_out_analog_open);
L
Linus Torvalds 已提交
4710

4711 4712
/**
 * snd_hda_multi_out_analog_prepare - Preapre the analog outputs.
4713 4714 4715 4716 4717
 * @codec: the HDA codec
 * @mout: hda_multi_out object
 * @stream_tag: stream tag to assign
 * @format: format id to assign
 * @substream: PCM substream to assign
4718 4719 4720
 *
 * Set up the i/o for analog out.
 * When the digital out is available, copy the front out to digital out, too.
L
Linus Torvalds 已提交
4721
 */
T
Takashi Iwai 已提交
4722 4723
int snd_hda_multi_out_analog_prepare(struct hda_codec *codec,
				     struct hda_multi_out *mout,
L
Linus Torvalds 已提交
4724 4725
				     unsigned int stream_tag,
				     unsigned int format,
4726
				     struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
4727
{
4728
	const hda_nid_t *nids = mout->dac_nids;
L
Linus Torvalds 已提交
4729
	int chs = substream->runtime->channels;
4730
	struct hda_spdif_out *spdif;
L
Linus Torvalds 已提交
4731 4732
	int i;

4733
	mutex_lock(&codec->spdif_mutex);
4734
	spdif = snd_hda_spdif_out_of_nid(codec, mout->dig_out_nid);
4735 4736
	if (mout->dig_out_nid && mout->share_spdif &&
	    mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
L
Linus Torvalds 已提交
4737
		if (chs == 2 &&
T
Takashi Iwai 已提交
4738 4739
		    snd_hda_is_supported_format(codec, mout->dig_out_nid,
						format) &&
4740
		    !(spdif->status & IEC958_AES0_NONAUDIO)) {
L
Linus Torvalds 已提交
4741
			mout->dig_out_used = HDA_DIG_ANALOG_DUP;
4742 4743
			setup_dig_out_stream(codec, mout->dig_out_nid,
					     stream_tag, format);
L
Linus Torvalds 已提交
4744 4745
		} else {
			mout->dig_out_used = 0;
4746
			cleanup_dig_out_stream(codec, mout->dig_out_nid);
L
Linus Torvalds 已提交
4747 4748
		}
	}
4749
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
4750 4751

	/* front */
T
Takashi Iwai 已提交
4752 4753
	snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag,
				   0, format);
4754 4755
	if (!mout->no_share_stream &&
	    mout->hp_nid && mout->hp_nid != nids[HDA_FRONT])
L
Linus Torvalds 已提交
4756
		/* headphone out will just decode front left/right (stereo) */
T
Takashi Iwai 已提交
4757 4758
		snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag,
					   0, format);
4759
	/* extra outputs copied from front */
4760 4761 4762 4763 4764
	for (i = 0; i < ARRAY_SIZE(mout->hp_out_nid); i++)
		if (!mout->no_share_stream && mout->hp_out_nid[i])
			snd_hda_codec_setup_stream(codec,
						   mout->hp_out_nid[i],
						   stream_tag, 0, format);
4765

L
Linus Torvalds 已提交
4766 4767
	/* surrounds */
	for (i = 1; i < mout->num_dacs; i++) {
4768
		if (chs >= (i + 1) * 2) /* independent out */
T
Takashi Iwai 已提交
4769 4770
			snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
						   i * 2, format);
4771
		else if (!mout->no_share_stream) /* copy front */
T
Takashi Iwai 已提交
4772 4773
			snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
						   0, format);
L
Linus Torvalds 已提交
4774
	}
4775 4776 4777 4778 4779 4780 4781 4782 4783 4784 4785 4786 4787 4788

	/* extra surrounds */
	for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++) {
		int ch = 0;
		if (!mout->extra_out_nid[i])
			break;
		if (chs >= (i + 1) * 2)
			ch = i * 2;
		else if (!mout->no_share_stream)
			break;
		snd_hda_codec_setup_stream(codec, mout->extra_out_nid[i],
					   stream_tag, ch, format);
	}

L
Linus Torvalds 已提交
4789 4790
	return 0;
}
4791
EXPORT_SYMBOL_GPL(snd_hda_multi_out_analog_prepare);
L
Linus Torvalds 已提交
4792

4793 4794
/**
 * snd_hda_multi_out_analog_cleanup - clean up the setting for analog out
4795 4796
 * @codec: the HDA codec
 * @mout: hda_multi_out object
L
Linus Torvalds 已提交
4797
 */
T
Takashi Iwai 已提交
4798 4799
int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec,
				     struct hda_multi_out *mout)
L
Linus Torvalds 已提交
4800
{
4801
	const hda_nid_t *nids = mout->dac_nids;
L
Linus Torvalds 已提交
4802 4803 4804
	int i;

	for (i = 0; i < mout->num_dacs; i++)
4805
		snd_hda_codec_cleanup_stream(codec, nids[i]);
L
Linus Torvalds 已提交
4806
	if (mout->hp_nid)
4807
		snd_hda_codec_cleanup_stream(codec, mout->hp_nid);
4808 4809 4810 4811
	for (i = 0; i < ARRAY_SIZE(mout->hp_out_nid); i++)
		if (mout->hp_out_nid[i])
			snd_hda_codec_cleanup_stream(codec,
						     mout->hp_out_nid[i]);
4812 4813
	for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
		if (mout->extra_out_nid[i])
4814 4815
			snd_hda_codec_cleanup_stream(codec,
						     mout->extra_out_nid[i]);
4816
	mutex_lock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
4817
	if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
4818
		cleanup_dig_out_stream(codec, mout->dig_out_nid);
L
Linus Torvalds 已提交
4819 4820
		mout->dig_out_used = 0;
	}
4821
	mutex_unlock(&codec->spdif_mutex);
L
Linus Torvalds 已提交
4822 4823
	return 0;
}
4824
EXPORT_SYMBOL_GPL(snd_hda_multi_out_analog_cleanup);
L
Linus Torvalds 已提交
4825

4826 4827
/**
 * snd_hda_get_default_vref - Get the default (mic) VREF pin bits
4828 4829
 * @codec: the HDA codec
 * @pin: referred pin NID
4830 4831 4832 4833 4834 4835 4836 4837 4838 4839 4840 4841 4842 4843 4844 4845 4846 4847 4848 4849 4850 4851 4852
 *
 * Guess the suitable VREF pin bits to be set as the pin-control value.
 * Note: the function doesn't set the AC_PINCTL_IN_EN bit.
 */
unsigned int snd_hda_get_default_vref(struct hda_codec *codec, hda_nid_t pin)
{
	unsigned int pincap;
	unsigned int oldval;
	oldval = snd_hda_codec_read(codec, pin, 0,
				    AC_VERB_GET_PIN_WIDGET_CONTROL, 0);
	pincap = snd_hda_query_pin_caps(codec, pin);
	pincap = (pincap & AC_PINCAP_VREF) >> AC_PINCAP_VREF_SHIFT;
	/* Exception: if the default pin setup is vref50, we give it priority */
	if ((pincap & AC_PINCAP_VREF_80) && oldval != PIN_VREF50)
		return AC_PINCTL_VREF_80;
	else if (pincap & AC_PINCAP_VREF_50)
		return AC_PINCTL_VREF_50;
	else if (pincap & AC_PINCAP_VREF_100)
		return AC_PINCTL_VREF_100;
	else if (pincap & AC_PINCAP_VREF_GRD)
		return AC_PINCTL_VREF_GRD;
	return AC_PINCTL_VREF_HIZ;
}
4853
EXPORT_SYMBOL_GPL(snd_hda_get_default_vref);
4854

4855 4856 4857 4858 4859 4860
/**
 * snd_hda_correct_pin_ctl - correct the pin ctl value for matching with the pin cap
 * @codec: the HDA codec
 * @pin: referred pin NID
 * @val: pin ctl value to audit
 */
4861 4862 4863 4864 4865 4866 4867 4868 4869 4870 4871 4872 4873 4874 4875 4876 4877 4878 4879 4880 4881 4882 4883 4884 4885 4886 4887 4888 4889 4890 4891 4892 4893 4894 4895 4896 4897 4898 4899 4900 4901 4902 4903 4904 4905 4906 4907 4908
unsigned int snd_hda_correct_pin_ctl(struct hda_codec *codec,
				     hda_nid_t pin, unsigned int val)
{
	static unsigned int cap_lists[][2] = {
		{ AC_PINCTL_VREF_100, AC_PINCAP_VREF_100 },
		{ AC_PINCTL_VREF_80, AC_PINCAP_VREF_80 },
		{ AC_PINCTL_VREF_50, AC_PINCAP_VREF_50 },
		{ AC_PINCTL_VREF_GRD, AC_PINCAP_VREF_GRD },
	};
	unsigned int cap;

	if (!val)
		return 0;
	cap = snd_hda_query_pin_caps(codec, pin);
	if (!cap)
		return val; /* don't know what to do... */

	if (val & AC_PINCTL_OUT_EN) {
		if (!(cap & AC_PINCAP_OUT))
			val &= ~(AC_PINCTL_OUT_EN | AC_PINCTL_HP_EN);
		else if ((val & AC_PINCTL_HP_EN) && !(cap & AC_PINCAP_HP_DRV))
			val &= ~AC_PINCTL_HP_EN;
	}

	if (val & AC_PINCTL_IN_EN) {
		if (!(cap & AC_PINCAP_IN))
			val &= ~(AC_PINCTL_IN_EN | AC_PINCTL_VREFEN);
		else {
			unsigned int vcap, vref;
			int i;
			vcap = (cap & AC_PINCAP_VREF) >> AC_PINCAP_VREF_SHIFT;
			vref = val & AC_PINCTL_VREFEN;
			for (i = 0; i < ARRAY_SIZE(cap_lists); i++) {
				if (vref == cap_lists[i][0] &&
				    !(vcap & cap_lists[i][1])) {
					if (i == ARRAY_SIZE(cap_lists) - 1)
						vref = AC_PINCTL_VREF_HIZ;
					else
						vref = cap_lists[i + 1][0];
				}
			}
			val &= ~AC_PINCTL_VREFEN;
			val |= vref;
		}
	}

	return val;
}
4909
EXPORT_SYMBOL_GPL(snd_hda_correct_pin_ctl);
4910

4911 4912 4913 4914 4915 4916 4917 4918 4919 4920 4921 4922 4923
/**
 * _snd_hda_pin_ctl - Helper to set pin ctl value
 * @codec: the HDA codec
 * @pin: referred pin NID
 * @val: pin control value to set
 * @cached: access over codec pinctl cache or direct write
 *
 * This function is a helper to set a pin ctl value more safely.
 * It corrects the pin ctl value via snd_hda_correct_pin_ctl(), stores the
 * value in pin target array via snd_hda_codec_set_pin_target(), then
 * actually writes the value via either snd_hda_codec_update_cache() or
 * snd_hda_codec_write() depending on @cached flag.
 */
4924 4925 4926
int _snd_hda_set_pin_ctl(struct hda_codec *codec, hda_nid_t pin,
			 unsigned int val, bool cached)
{
4927
	val = snd_hda_correct_pin_ctl(codec, pin, val);
4928
	snd_hda_codec_set_pin_target(codec, pin, val);
4929 4930 4931 4932 4933 4934 4935
	if (cached)
		return snd_hda_codec_update_cache(codec, pin, 0,
				AC_VERB_SET_PIN_WIDGET_CONTROL, val);
	else
		return snd_hda_codec_write(codec, pin, 0,
					   AC_VERB_SET_PIN_WIDGET_CONTROL, val);
}
4936
EXPORT_SYMBOL_GPL(_snd_hda_set_pin_ctl);
4937

4938 4939
/**
 * snd_hda_add_imux_item - Add an item to input_mux
4940 4941 4942 4943 4944
 * @codec: the HDA codec
 * @imux: imux helper object
 * @label: the name of imux item to assign
 * @index: index number of imux item to assign
 * @type_idx: pointer to store the resultant label index
4945 4946 4947 4948 4949
 *
 * When the same label is used already in the existing items, the number
 * suffix is appended to the label.  This label index number is stored
 * to type_idx when non-NULL pointer is given.
 */
4950 4951
int snd_hda_add_imux_item(struct hda_codec *codec,
			  struct hda_input_mux *imux, const char *label,
4952 4953 4954 4955
			  int index, int *type_idx)
{
	int i, label_idx = 0;
	if (imux->num_items >= HDA_MAX_NUM_INPUTS) {
4956
		codec_err(codec, "hda_codec: Too many imux items!\n");
4957 4958 4959 4960 4961
		return -EINVAL;
	}
	for (i = 0; i < imux->num_items; i++) {
		if (!strncmp(label, imux->items[i].label, strlen(label)))
			label_idx++;
4962
	}
4963 4964 4965 4966 4967 4968
	if (type_idx)
		*type_idx = label_idx;
	if (label_idx > 0)
		snprintf(imux->items[imux->num_items].label,
			 sizeof(imux->items[imux->num_items].label),
			 "%s %d", label, label_idx);
4969
	else
4970 4971 4972 4973 4974
		strlcpy(imux->items[imux->num_items].label, label,
			sizeof(imux->items[imux->num_items].label));
	imux->items[imux->num_items].index = index;
	imux->num_items++;
	return 0;
4975
}
4976
EXPORT_SYMBOL_GPL(snd_hda_add_imux_item);
4977

L
Linus Torvalds 已提交
4978
/**
4979 4980
 * snd_hda_bus_reset - Reset the bus
 * @bus: HD-audio bus
L
Linus Torvalds 已提交
4981
 */
4982
void snd_hda_bus_reset(struct hda_bus *bus)
L
Linus Torvalds 已提交
4983
{
T
Takashi Iwai 已提交
4984
	struct hda_codec *codec;
L
Linus Torvalds 已提交
4985

4986
	list_for_each_codec(codec, bus) {
4987
		/* FIXME: maybe a better way needed for forced reset */
4988
		cancel_delayed_work_sync(&codec->jackpoll_work);
4989
#ifdef CONFIG_PM
4990
		if (hda_codec_is_power_on(codec)) {
4991
			hda_call_codec_suspend(codec);
4992
			hda_call_codec_resume(codec);
4993 4994
		}
#endif
L
Linus Torvalds 已提交
4995 4996
	}
}
4997
EXPORT_SYMBOL_GPL(snd_hda_bus_reset);
T
Takashi Iwai 已提交
4998 4999 5000 5001 5002

/*
 * generic arrays
 */

5003 5004 5005
/**
 * snd_array_new - get a new element from the given array
 * @array: the array object
5006
 *
5007 5008 5009 5010
 * Get a new element from the given array.  If it exceeds the
 * pre-allocated array size, re-allocate the array.
 *
 * Returns NULL if allocation failed.
T
Takashi Iwai 已提交
5011 5012 5013
 */
void *snd_array_new(struct snd_array *array)
{
5014 5015
	if (snd_BUG_ON(!array->elem_size))
		return NULL;
T
Takashi Iwai 已提交
5016 5017
	if (array->used >= array->alloced) {
		int num = array->alloced + array->alloc_align;
5018
		int size = (num + 1) * array->elem_size;
5019 5020 5021
		void *nlist;
		if (snd_BUG_ON(num >= 4096))
			return NULL;
5022
		nlist = krealloc(array->list, size, GFP_KERNEL | __GFP_ZERO);
T
Takashi Iwai 已提交
5023 5024 5025 5026 5027
		if (!nlist)
			return NULL;
		array->list = nlist;
		array->alloced = num;
	}
5028
	return snd_array_elem(array, array->used++);
T
Takashi Iwai 已提交
5029
}
5030
EXPORT_SYMBOL_GPL(snd_array_new);
T
Takashi Iwai 已提交
5031

5032 5033 5034 5035
/**
 * snd_array_free - free the given array elements
 * @array: the array object
 */
T
Takashi Iwai 已提交
5036 5037 5038 5039 5040 5041 5042
void snd_array_free(struct snd_array *array)
{
	kfree(array->list);
	array->used = 0;
	array->alloced = 0;
	array->list = NULL;
}
5043
EXPORT_SYMBOL_GPL(snd_array_free);
5044

5045 5046 5047 5048 5049 5050 5051 5052
/**
 * snd_print_pcm_bits - Print the supported PCM fmt bits to the string buffer
 * @pcm: PCM caps bits
 * @buf: the string buffer to write
 * @buflen: the max buffer length
 *
 * used by hda_proc.c and hda_eld.c
 */
5053 5054 5055 5056 5057 5058 5059 5060 5061 5062 5063
void snd_print_pcm_bits(int pcm, char *buf, int buflen)
{
	static unsigned int bits[] = { 8, 16, 20, 24, 32 };
	int i, j;

	for (i = 0, j = 0; i < ARRAY_SIZE(bits); i++)
		if (pcm & (AC_SUPPCM_BITS_8 << i))
			j += snprintf(buf + j, buflen - j,  " %d", bits[i]);

	buf[j] = '\0'; /* necessary when j == 0 */
}
5064
EXPORT_SYMBOL_GPL(snd_print_pcm_bits);
5065 5066 5067

MODULE_DESCRIPTION("HDA codec core");
MODULE_LICENSE("GPL");