hda_controller.c 31.2 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/*
 *
 *  Implementation of primary alsa driver code base for Intel HD Audio.
 *
 *  Copyright(c) 2004 Intel Corporation. All rights reserved.
 *
 *  Copyright (c) 2004 Takashi Iwai <tiwai@suse.de>
 *                     PeiSen Hou <pshou@realtek.com.tw>
 *
 *  This program is free software; you can redistribute it and/or modify it
 *  under the terms of the GNU General Public License as published by the Free
 *  Software Foundation; either version 2 of the License, or (at your option)
 *  any later version.
 *
 *  This program 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.
 *
 *
 */

#include <linux/clocksource.h>
#include <linux/delay.h>
25
#include <linux/interrupt.h>
26 27
#include <linux/kernel.h>
#include <linux/module.h>
28
#include <linux/pm_runtime.h>
29 30 31 32 33
#include <linux/slab.h>
#include <sound/core.h>
#include <sound/initval.h>
#include "hda_controller.h"

34
/* DSP lock helpers */
35 36 37
#define dsp_lock(dev)		snd_hdac_dsp_lock(azx_stream(dev))
#define dsp_unlock(dev)		snd_hdac_dsp_unlock(azx_stream(dev))
#define dsp_is_locked(dev)	snd_hdac_stream_is_locked(azx_stream(dev))
38

39 40 41 42
/* assign a stream for the PCM */
static inline struct azx_dev *
azx_assign_device(struct azx *chip, struct snd_pcm_substream *substream)
{
43 44 45 46 47 48
	struct hdac_stream *s;

	s = snd_hdac_stream_assign(azx_bus(chip), substream);
	if (!s)
		return NULL;
	return stream_to_azx_dev(s);
49 50 51 52 53
}

/* release the assigned stream */
static inline void azx_release_device(struct azx_dev *azx_dev)
{
54
	snd_hdac_stream_release(azx_stream(azx_dev));
55 56
}

57 58 59 60 61 62 63
static inline struct hda_pcm_stream *
to_hda_pcm_stream(struct snd_pcm_substream *substream)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
	return &apcm->info->stream[substream->stream];
}

64 65 66 67
static u64 azx_adjust_codec_delay(struct snd_pcm_substream *substream,
				u64 nsec)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
68
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90
	u64 codec_frames, codec_nsecs;

	if (!hinfo->ops.get_delay)
		return nsec;

	codec_frames = hinfo->ops.get_delay(hinfo, apcm->codec, substream);
	codec_nsecs = div_u64(codec_frames * 1000000000LL,
			      substream->runtime->rate);

	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
		return nsec + codec_nsecs;

	return (nsec > codec_nsecs) ? nsec - codec_nsecs : 0;
}

/*
 * PCM ops
 */

static int azx_pcm_close(struct snd_pcm_substream *substream)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
91
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
92 93 94 95 96
	struct azx *chip = apcm->chip;
	struct azx_dev *azx_dev = get_azx_dev(substream);

	mutex_lock(&chip->open_mutex);
	azx_release_device(azx_dev);
97 98
	if (hinfo->ops.close)
		hinfo->ops.close(hinfo, apcm->codec, substream);
99 100
	snd_hda_power_down(apcm->codec);
	mutex_unlock(&chip->open_mutex);
101
	snd_hda_codec_pcm_put(apcm->info);
102 103 104 105 106 107 108 109
	return 0;
}

static int azx_pcm_hw_params(struct snd_pcm_substream *substream,
			     struct snd_pcm_hw_params *hw_params)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
	struct azx *chip = apcm->chip;
T
Takashi Iwai 已提交
110
	struct azx_dev *azx_dev = get_azx_dev(substream);
111 112
	int ret;

T
Takashi Iwai 已提交
113 114
	dsp_lock(azx_dev);
	if (dsp_is_locked(azx_dev)) {
115 116 117 118
		ret = -EBUSY;
		goto unlock;
	}

T
Takashi Iwai 已提交
119 120 121
	azx_dev->core.bufsize = 0;
	azx_dev->core.period_bytes = 0;
	azx_dev->core.format_val = 0;
122 123 124
	ret = chip->ops->substream_alloc_pages(chip, substream,
					  params_buffer_bytes(hw_params));
unlock:
T
Takashi Iwai 已提交
125
	dsp_unlock(azx_dev);
126 127 128 129 130 131 132 133
	return ret;
}

static int azx_pcm_hw_free(struct snd_pcm_substream *substream)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
	struct azx_dev *azx_dev = get_azx_dev(substream);
	struct azx *chip = apcm->chip;
134
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
135 136 137 138
	int err;

	/* reset BDL address */
	dsp_lock(azx_dev);
139 140
	if (!dsp_is_locked(azx_dev))
		snd_hdac_stream_cleanup(azx_stream(azx_dev));
141 142 143 144 145 146 147 148 149 150 151 152 153 154

	snd_hda_codec_cleanup(apcm->codec, hinfo, substream);

	err = chip->ops->substream_free_pages(chip, substream);
	azx_dev->prepared = 0;
	dsp_unlock(azx_dev);
	return err;
}

static int azx_pcm_prepare(struct snd_pcm_substream *substream)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
	struct azx *chip = apcm->chip;
	struct azx_dev *azx_dev = get_azx_dev(substream);
155
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
156 157 158 159 160 161 162 163 164 165 166 167 168
	struct snd_pcm_runtime *runtime = substream->runtime;
	unsigned int bufsize, period_bytes, format_val, stream_tag;
	int err;
	struct hda_spdif_out *spdif =
		snd_hda_spdif_out_of_nid(apcm->codec, hinfo->nid);
	unsigned short ctls = spdif ? spdif->ctls : 0;

	dsp_lock(azx_dev);
	if (dsp_is_locked(azx_dev)) {
		err = -EBUSY;
		goto unlock;
	}

169
	snd_hdac_stream_reset(azx_stream(azx_dev));
170
	format_val = snd_hdac_calc_stream_format(runtime->rate,
171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188
						runtime->channels,
						runtime->format,
						hinfo->maxbps,
						ctls);
	if (!format_val) {
		dev_err(chip->card->dev,
			"invalid format_val, rate=%d, ch=%d, format=%d\n",
			runtime->rate, runtime->channels, runtime->format);
		err = -EINVAL;
		goto unlock;
	}

	bufsize = snd_pcm_lib_buffer_bytes(substream);
	period_bytes = snd_pcm_lib_period_bytes(substream);

	dev_dbg(chip->card->dev, "azx_pcm_prepare: bufsize=0x%x, format=0x%x\n",
		bufsize, format_val);

189 190 191 192 193 194 195 196
	if (bufsize != azx_dev->core.bufsize ||
	    period_bytes != azx_dev->core.period_bytes ||
	    format_val != azx_dev->core.format_val ||
	    runtime->no_period_wakeup != azx_dev->core.no_period_wakeup) {
		azx_dev->core.bufsize = bufsize;
		azx_dev->core.period_bytes = period_bytes;
		azx_dev->core.format_val = format_val;
		azx_dev->core.no_period_wakeup = runtime->no_period_wakeup;
197
		err = snd_hdac_stream_setup_periods(azx_stream(azx_dev));
198 199 200 201
		if (err < 0)
			goto unlock;
	}

202
	snd_hdac_stream_setup(azx_stream(azx_dev));
203

204
	stream_tag = azx_dev->core.stream_tag;
205 206 207 208 209
	/* CA-IBG chips need the playback stream starting from 1 */
	if ((chip->driver_caps & AZX_DCAPS_CTX_WORKAROUND) &&
	    stream_tag > chip->capture_streams)
		stream_tag -= chip->capture_streams;
	err = snd_hda_codec_prepare(apcm->codec, hinfo, stream_tag,
210
				     azx_dev->core.format_val, substream);
211 212 213 214 215 216 217 218 219 220 221 222

 unlock:
	if (!err)
		azx_dev->prepared = 1;
	dsp_unlock(azx_dev);
	return err;
}

static int azx_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
	struct azx *chip = apcm->chip;
223
	struct hdac_bus *bus = azx_bus(chip);
224 225
	struct azx_dev *azx_dev;
	struct snd_pcm_substream *s;
226 227 228 229
	struct hdac_stream *hstr;
	bool start;
	int sbits = 0;
	int sync_reg;
230 231

	azx_dev = get_azx_dev(substream);
232 233 234 235 236
	hstr = azx_stream(azx_dev);
	if (chip->driver_caps & AZX_DCAPS_OLD_SSYNC)
		sync_reg = AZX_REG_OLD_SSYNC;
	else
		sync_reg = AZX_REG_SSYNC;
237 238 239 240 241 242 243 244

	if (dsp_is_locked(azx_dev) || !azx_dev->prepared)
		return -EPIPE;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
	case SNDRV_PCM_TRIGGER_RESUME:
245
		start = true;
246 247 248 249
		break;
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
	case SNDRV_PCM_TRIGGER_SUSPEND:
	case SNDRV_PCM_TRIGGER_STOP:
250
		start = false;
251 252 253 254 255 256 257 258 259
		break;
	default:
		return -EINVAL;
	}

	snd_pcm_group_for_each_entry(s, substream) {
		if (s->pcm->card != substream->pcm->card)
			continue;
		azx_dev = get_azx_dev(s);
260
		sbits |= 1 << azx_dev->core.index;
261 262 263
		snd_pcm_trigger_done(s, substream);
	}

264
	spin_lock(&bus->reg_lock);
265 266

	/* first, set SYNC bits of corresponding streams */
267
	snd_hdac_stream_sync_trigger(hstr, true, sbits, sync_reg);
268 269 270 271 272 273

	snd_pcm_group_for_each_entry(s, substream) {
		if (s->pcm->card != substream->pcm->card)
			continue;
		azx_dev = get_azx_dev(s);
		if (start) {
274 275
			azx_dev->insufficient = 1;
			snd_hdac_stream_start(azx_stream(azx_dev), true);
276
		} else {
277
			snd_hdac_stream_stop(azx_stream(azx_dev));
278 279
		}
	}
280
	spin_unlock(&bus->reg_lock);
281 282 283

	snd_hdac_stream_sync(hstr, start, sbits);

284
	spin_lock(&bus->reg_lock);
285
	/* reset SYNC bits */
286 287 288
	snd_hdac_stream_sync_trigger(hstr, false, sbits, sync_reg);
	if (start)
		snd_hdac_stream_timecounter_init(hstr, sbits);
289
	spin_unlock(&bus->reg_lock);
290 291 292
	return 0;
}

293
unsigned int azx_get_pos_lpib(struct azx *chip, struct azx_dev *azx_dev)
294
{
295
	return snd_hdac_stream_get_pos_lpib(azx_stream(azx_dev));
296 297
}
EXPORT_SYMBOL_GPL(azx_get_pos_lpib);
298

299 300
unsigned int azx_get_pos_posbuf(struct azx *chip, struct azx_dev *azx_dev)
{
301
	return snd_hdac_stream_get_pos_posbuf(azx_stream(azx_dev));
302
}
303
EXPORT_SYMBOL_GPL(azx_get_pos_posbuf);
304 305

unsigned int azx_get_position(struct azx *chip,
306
			      struct azx_dev *azx_dev)
307
{
308
	struct snd_pcm_substream *substream = azx_dev->core.substream;
309 310 311 312
	unsigned int pos;
	int stream = substream->stream;
	int delay = 0;

313 314 315 316
	if (chip->get_position[stream])
		pos = chip->get_position[stream](chip, azx_dev);
	else /* use the position buffer as default */
		pos = azx_get_pos_posbuf(chip, azx_dev);
317

318
	if (pos >= azx_dev->core.bufsize)
319 320 321
		pos = 0;

	if (substream->runtime) {
322
		struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
323
		struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
324 325 326

		if (chip->get_delay[stream])
			delay += chip->get_delay[stream](chip, azx_dev, pos);
327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342
		if (hinfo->ops.get_delay)
			delay += hinfo->ops.get_delay(hinfo, apcm->codec,
						      substream);
		substream->runtime->delay = delay;
	}

	return pos;
}
EXPORT_SYMBOL_GPL(azx_get_position);

static snd_pcm_uframes_t azx_pcm_pointer(struct snd_pcm_substream *substream)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
	struct azx *chip = apcm->chip;
	struct azx_dev *azx_dev = get_azx_dev(substream);
	return bytes_to_frames(substream->runtime,
343
			       azx_get_position(chip, azx_dev));
344 345
}

346 347 348 349
static int azx_get_time_info(struct snd_pcm_substream *substream,
			struct timespec *system_ts, struct timespec *audio_ts,
			struct snd_pcm_audio_tstamp_config *audio_tstamp_config,
			struct snd_pcm_audio_tstamp_report *audio_tstamp_report)
350 351 352 353
{
	struct azx_dev *azx_dev = get_azx_dev(substream);
	u64 nsec;

354 355
	if ((substream->runtime->hw.info & SNDRV_PCM_INFO_HAS_LINK_ATIME) &&
		(audio_tstamp_config->type_requested == SNDRV_PCM_AUDIO_TSTAMP_TYPE_LINK)) {
356

357 358
		snd_pcm_gettime(substream->runtime, system_ts);

359
		nsec = timecounter_read(&azx_dev->core.tc);
360 361 362 363 364 365 366 367 368 369 370 371
		nsec = div_u64(nsec, 3); /* can be optimized */
		if (audio_tstamp_config->report_delay)
			nsec = azx_adjust_codec_delay(substream, nsec);

		*audio_ts = ns_to_timespec(nsec);

		audio_tstamp_report->actual_type = SNDRV_PCM_AUDIO_TSTAMP_TYPE_LINK;
		audio_tstamp_report->accuracy_report = 1; /* rest of structure is valid */
		audio_tstamp_report->accuracy = 42; /* 24 MHz WallClock == 42ns resolution */

	} else
		audio_tstamp_report->actual_type = SNDRV_PCM_AUDIO_TSTAMP_TYPE_DEFAULT;
372 373 374 375 376 377 378 379 380 381 382 383 384

	return 0;
}

static struct snd_pcm_hardware azx_pcm_hw = {
	.info =			(SNDRV_PCM_INFO_MMAP |
				 SNDRV_PCM_INFO_INTERLEAVED |
				 SNDRV_PCM_INFO_BLOCK_TRANSFER |
				 SNDRV_PCM_INFO_MMAP_VALID |
				 /* No full-resume yet implemented */
				 /* SNDRV_PCM_INFO_RESUME |*/
				 SNDRV_PCM_INFO_PAUSE |
				 SNDRV_PCM_INFO_SYNC_START |
385 386
				 SNDRV_PCM_INFO_HAS_WALL_CLOCK | /* legacy */
				 SNDRV_PCM_INFO_HAS_LINK_ATIME |
387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404
				 SNDRV_PCM_INFO_NO_PERIOD_WAKEUP),
	.formats =		SNDRV_PCM_FMTBIT_S16_LE,
	.rates =		SNDRV_PCM_RATE_48000,
	.rate_min =		48000,
	.rate_max =		48000,
	.channels_min =		2,
	.channels_max =		2,
	.buffer_bytes_max =	AZX_MAX_BUF_SIZE,
	.period_bytes_min =	128,
	.period_bytes_max =	AZX_MAX_BUF_SIZE / 2,
	.periods_min =		2,
	.periods_max =		AZX_MAX_FRAG,
	.fifo_size =		0,
};

static int azx_pcm_open(struct snd_pcm_substream *substream)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
405
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
406 407 408 409 410 411
	struct azx *chip = apcm->chip;
	struct azx_dev *azx_dev;
	struct snd_pcm_runtime *runtime = substream->runtime;
	int err;
	int buff_step;

412
	snd_hda_codec_pcm_get(apcm->info);
413 414 415
	mutex_lock(&chip->open_mutex);
	azx_dev = azx_assign_device(chip, substream);
	if (azx_dev == NULL) {
416 417
		err = -EBUSY;
		goto unlock;
418
	}
419
	runtime->private_data = azx_dev;
420 421 422 423 424 425 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
	runtime->hw = azx_pcm_hw;
	runtime->hw.channels_min = hinfo->channels_min;
	runtime->hw.channels_max = hinfo->channels_max;
	runtime->hw.formats = hinfo->formats;
	runtime->hw.rates = hinfo->rates;
	snd_pcm_limit_hw_rates(runtime);
	snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);

	/* avoid wrap-around with wall-clock */
	snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_TIME,
				     20,
				     178000000);

	if (chip->align_buffer_size)
		/* constrain buffer sizes to be multiple of 128
		   bytes. This is more efficient in terms of memory
		   access but isn't required by the HDA spec and
		   prevents users from specifying exact period/buffer
		   sizes. For example for 44.1kHz, a period size set
		   to 20ms will be rounded to 19.59ms. */
		buff_step = 128;
	else
		/* Don't enforce steps on buffer sizes, still need to
		   be multiple of 4 bytes (HDA spec). Tested on Intel
		   HDA controllers, may not work on all devices where
		   option needs to be disabled */
		buff_step = 4;

	snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
				   buff_step);
	snd_pcm_hw_constraint_step(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES,
				   buff_step);
452
	snd_hda_power_up(apcm->codec);
453 454 455 456
	if (hinfo->ops.open)
		err = hinfo->ops.open(hinfo, apcm->codec, substream);
	else
		err = -ENODEV;
457 458
	if (err < 0) {
		azx_release_device(azx_dev);
459
		goto powerdown;
460 461 462 463 464 465 466 467
	}
	snd_pcm_limit_hw_rates(runtime);
	/* sanity check */
	if (snd_BUG_ON(!runtime->hw.channels_min) ||
	    snd_BUG_ON(!runtime->hw.channels_max) ||
	    snd_BUG_ON(!runtime->hw.formats) ||
	    snd_BUG_ON(!runtime->hw.rates)) {
		azx_release_device(azx_dev);
468 469 470 471
		if (hinfo->ops.close)
			hinfo->ops.close(hinfo, apcm->codec, substream);
		err = -EINVAL;
		goto powerdown;
472 473
	}

474
	/* disable LINK_ATIME timestamps for capture streams
475
	   until we figure out how to handle digital inputs */
476 477 478 479
	if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
		runtime->hw.info &= ~SNDRV_PCM_INFO_HAS_WALL_CLOCK; /* legacy */
		runtime->hw.info &= ~SNDRV_PCM_INFO_HAS_LINK_ATIME;
	}
480 481 482 483

	snd_pcm_set_sync(substream);
	mutex_unlock(&chip->open_mutex);
	return 0;
484 485 486 487 488

 powerdown:
	snd_hda_power_down(apcm->codec);
 unlock:
	mutex_unlock(&chip->open_mutex);
489
	snd_hda_codec_pcm_put(apcm->info);
490
	return err;
491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511
}

static int azx_pcm_mmap(struct snd_pcm_substream *substream,
			struct vm_area_struct *area)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
	struct azx *chip = apcm->chip;
	if (chip->ops->pcm_mmap_prepare)
		chip->ops->pcm_mmap_prepare(substream, area);
	return snd_pcm_lib_default_mmap(substream, area);
}

static struct snd_pcm_ops azx_pcm_ops = {
	.open = azx_pcm_open,
	.close = azx_pcm_close,
	.ioctl = snd_pcm_lib_ioctl,
	.hw_params = azx_pcm_hw_params,
	.hw_free = azx_pcm_hw_free,
	.prepare = azx_pcm_prepare,
	.trigger = azx_pcm_trigger,
	.pointer = azx_pcm_pointer,
512
	.get_time_info =  azx_get_time_info,
513 514 515 516 517 518 519 520 521
	.mmap = azx_pcm_mmap,
	.page = snd_pcm_sgbuf_ops_page,
};

static void azx_pcm_free(struct snd_pcm *pcm)
{
	struct azx_pcm *apcm = pcm->private_data;
	if (apcm) {
		list_del(&apcm->list);
522
		apcm->info->pcm = NULL;
523 524 525 526 527 528
		kfree(apcm);
	}
}

#define MAX_PREALLOC_SIZE	(32 * 1024 * 1024)

529
static int azx_attach_pcm_stream(struct hda_bus *_bus, struct hda_codec *codec,
530
				 struct hda_pcm *cpcm)
531
{
532 533
	struct hdac_bus *bus = &_bus->core;
	struct azx *chip = bus_to_azx(bus);
534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559
	struct snd_pcm *pcm;
	struct azx_pcm *apcm;
	int pcm_dev = cpcm->device;
	unsigned int size;
	int s, err;

	list_for_each_entry(apcm, &chip->pcm_list, list) {
		if (apcm->pcm->device == pcm_dev) {
			dev_err(chip->card->dev, "PCM %d already exists\n",
				pcm_dev);
			return -EBUSY;
		}
	}
	err = snd_pcm_new(chip->card, cpcm->name, pcm_dev,
			  cpcm->stream[SNDRV_PCM_STREAM_PLAYBACK].substreams,
			  cpcm->stream[SNDRV_PCM_STREAM_CAPTURE].substreams,
			  &pcm);
	if (err < 0)
		return err;
	strlcpy(pcm->name, cpcm->name, sizeof(pcm->name));
	apcm = kzalloc(sizeof(*apcm), GFP_KERNEL);
	if (apcm == NULL)
		return -ENOMEM;
	apcm->chip = chip;
	apcm->pcm = pcm;
	apcm->codec = codec;
560
	apcm->info = cpcm;
561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580
	pcm->private_data = apcm;
	pcm->private_free = azx_pcm_free;
	if (cpcm->pcm_type == HDA_PCM_TYPE_MODEM)
		pcm->dev_class = SNDRV_PCM_CLASS_MODEM;
	list_add_tail(&apcm->list, &chip->pcm_list);
	cpcm->pcm = pcm;
	for (s = 0; s < 2; s++) {
		if (cpcm->stream[s].substreams)
			snd_pcm_set_ops(pcm, s, &azx_pcm_ops);
	}
	/* buffer pre-allocation */
	size = CONFIG_SND_HDA_PREALLOC_SIZE * 1024;
	if (size > MAX_PREALLOC_SIZE)
		size = MAX_PREALLOC_SIZE;
	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV_SG,
					      chip->card->dev,
					      size, MAX_PREALLOC_SIZE);
	return 0;
}

581 582 583 584 585 586 587 588 589 590 591 592 593
static unsigned int azx_command_addr(u32 cmd)
{
	unsigned int addr = cmd >> 28;

	if (addr >= AZX_MAX_CODECS) {
		snd_BUG();
		addr = 0;
	}

	return addr;
}

/* receive a response */
594
static int azx_rirb_get_response(struct hdac_bus *bus, unsigned int addr,
595
				 unsigned int *res)
596
{
597 598
	struct azx *chip = bus_to_azx(bus);
	struct hda_bus *hbus = &chip->bus;
599 600 601 602 603 604 605 606
	unsigned long timeout;
	unsigned long loopcounter;
	int do_poll = 0;

 again:
	timeout = jiffies + msecs_to_jiffies(1000);

	for (loopcounter = 0;; loopcounter++) {
607 608 609 610
		spin_lock_irq(&bus->reg_lock);
		if (chip->polling_mode || do_poll)
			snd_hdac_bus_update_rirb(bus);
		if (!bus->rirb.cmds[addr]) {
611 612
			if (!do_poll)
				chip->poll_count = 0;
613
			if (res)
614 615
				*res = bus->rirb.res[addr]; /* the last value */
			spin_unlock_irq(&bus->reg_lock);
616
			return 0;
617
		}
618
		spin_unlock_irq(&bus->reg_lock);
619 620
		if (time_after(jiffies, timeout))
			break;
621
		if (hbus->needs_damn_long_delay || loopcounter > 3000)
622 623 624 625 626 627 628
			msleep(2); /* temporary workaround */
		else {
			udelay(10);
			cond_resched();
		}
	}

629
	if (hbus->no_response_fallback)
630
		return -EIO;
631 632 633 634

	if (!chip->polling_mode && chip->poll_count < 2) {
		dev_dbg(chip->card->dev,
			"azx_get_response timeout, polling the codec once: last cmd=0x%08x\n",
635
			bus->last_cmd[addr]);
636 637 638 639 640 641 642 643 644
		do_poll = 1;
		chip->poll_count++;
		goto again;
	}


	if (!chip->polling_mode) {
		dev_warn(chip->card->dev,
			 "azx_get_response timeout, switching to polling mode: last cmd=0x%08x\n",
645
			 bus->last_cmd[addr]);
646 647 648 649 650 651 652
		chip->polling_mode = 1;
		goto again;
	}

	if (chip->msi) {
		dev_warn(chip->card->dev,
			 "No response from codec, disabling MSI: last cmd=0x%08x\n",
653 654
			 bus->last_cmd[addr]);
		if (chip->ops->disable_msi_reset_irq &&
655 656
		    chip->ops->disable_msi_reset_irq(chip) < 0)
			return -EIO;
657 658 659 660 661 662 663 664
		goto again;
	}

	if (chip->probing) {
		/* If this critical timeout happens during the codec probing
		 * phase, this is likely an access to a non-existing codec
		 * slot.  Better to return an error and reset the system.
		 */
665
		return -EIO;
666 667 668 669 670
	}

	/* a fatal communication error; need either to reset or to fallback
	 * to the single_cmd mode
	 */
671 672
	if (hbus->allow_bus_reset && !hbus->response_reset && !hbus->in_reset) {
		hbus->response_reset = 1;
673
		return -EAGAIN; /* give a chance to retry */
674 675 676 677
	}

	dev_err(chip->card->dev,
		"azx_get_response timeout, switching to single_cmd mode: last cmd=0x%08x\n",
678
		bus->last_cmd[addr]);
679
	chip->single_cmd = 1;
680 681
	hbus->response_reset = 0;
	snd_hdac_bus_stop_cmd_io(bus);
682
	return -EIO;
683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701
}

/*
 * Use the single immediate command instead of CORB/RIRB for simplicity
 *
 * Note: according to Intel, this is not preferred use.  The command was
 *       intended for the BIOS only, and may get confused with unsolicited
 *       responses.  So, we shouldn't use it for normal operation from the
 *       driver.
 *       I left the codes, however, for debugging/testing purposes.
 */

/* receive a response */
static int azx_single_wait_for_response(struct azx *chip, unsigned int addr)
{
	int timeout = 50;

	while (timeout--) {
		/* check IRV busy bit */
T
Takashi Iwai 已提交
702
		if (azx_readw(chip, IRS) & AZX_IRS_VALID) {
703
			/* reuse rirb.res as the response return value */
704
			azx_bus(chip)->rirb.res[addr] = azx_readl(chip, IR);
705 706 707 708 709 710 711
			return 0;
		}
		udelay(1);
	}
	if (printk_ratelimit())
		dev_dbg(chip->card->dev, "get_response timeout: IRS=0x%x\n",
			azx_readw(chip, IRS));
712
	azx_bus(chip)->rirb.res[addr] = -1;
713 714 715 716
	return -EIO;
}

/* send a command */
717
static int azx_single_send_cmd(struct hdac_bus *bus, u32 val)
718
{
719
	struct azx *chip = bus_to_azx(bus);
720 721 722
	unsigned int addr = azx_command_addr(val);
	int timeout = 50;

723
	bus->last_cmd[azx_command_addr(val)] = val;
724 725
	while (timeout--) {
		/* check ICB busy bit */
T
Takashi Iwai 已提交
726
		if (!((azx_readw(chip, IRS) & AZX_IRS_BUSY))) {
727 728
			/* Clear IRV valid bit */
			azx_writew(chip, IRS, azx_readw(chip, IRS) |
T
Takashi Iwai 已提交
729
				   AZX_IRS_VALID);
730 731
			azx_writel(chip, IC, val);
			azx_writew(chip, IRS, azx_readw(chip, IRS) |
T
Takashi Iwai 已提交
732
				   AZX_IRS_BUSY);
733 734 735 736 737 738 739 740 741 742 743 744
			return azx_single_wait_for_response(chip, addr);
		}
		udelay(1);
	}
	if (printk_ratelimit())
		dev_dbg(chip->card->dev,
			"send_cmd timeout: IRS=0x%x, val=0x%x\n",
			azx_readw(chip, IRS), val);
	return -EIO;
}

/* receive a response */
745
static int azx_single_get_response(struct hdac_bus *bus, unsigned int addr,
746
				   unsigned int *res)
747
{
748
	if (res)
749
		*res = bus->rirb.res[addr];
750
	return 0;
751 752 753 754 755 756 757 758 759 760
}

/*
 * The below are the main callbacks from hda_codec.
 *
 * They are just the skeleton to call sub-callbacks according to the
 * current setting of chip->single_cmd.
 */

/* send a command */
761
static int azx_send_cmd(struct hdac_bus *bus, unsigned int val)
762
{
763
	struct azx *chip = bus_to_azx(bus);
764 765 766 767 768 769

	if (chip->disabled)
		return 0;
	if (chip->single_cmd)
		return azx_single_send_cmd(bus, val);
	else
770
		return snd_hdac_bus_send_cmd(bus, val);
771 772 773
}

/* get a response */
774
static int azx_get_response(struct hdac_bus *bus, unsigned int addr,
775
			    unsigned int *res)
776
{
777 778
	struct azx *chip = bus_to_azx(bus);

779 780 781
	if (chip->disabled)
		return 0;
	if (chip->single_cmd)
782
		return azx_single_get_response(bus, addr, res);
783
	else
784
		return azx_rirb_get_response(bus, addr, res);
785 786
}

787 788 789 790 791
static const struct hdac_bus_ops bus_core_ops = {
	.command = azx_send_cmd,
	.get_response = azx_get_response,
};

792 793 794 795 796 797 798 799 800
#ifdef CONFIG_SND_HDA_DSP_LOADER
/*
 * DSP loading code (e.g. for CA0132)
 */

/* use the first stream for loading DSP */
static struct azx_dev *
azx_get_dsp_loader_dev(struct azx *chip)
{
801 802 803 804 805 806 807 808
	struct hdac_bus *bus = azx_bus(chip);
	struct hdac_stream *s;

	list_for_each_entry(s, &bus->stream_list, list)
		if (s->index == chip->playback_index_offset)
			return stream_to_azx_dev(s);

	return NULL;
809 810
}

811
static int azx_load_dsp_prepare(struct hda_bus *_bus, unsigned int format,
812 813
				unsigned int byte_size,
				struct snd_dma_buffer *bufp)
814
{
815 816
	struct hdac_bus *bus = &_bus->core;
	struct azx *chip = bus_to_azx(bus);
817
	struct azx_dev *azx_dev;
818 819
	struct hdac_stream *hstr;
	bool saved = false;
820 821 822
	int err;

	azx_dev = azx_get_dsp_loader_dev(chip);
823
	hstr = azx_stream(azx_dev);
824
	spin_lock_irq(&bus->reg_lock);
825 826 827
	if (hstr->opened) {
		chip->saved_azx_dev = *azx_dev;
		saved = true;
828
	}
829
	spin_unlock_irq(&bus->reg_lock);
830

831 832
	err = snd_hdac_dsp_prepare(hstr, format, byte_size, bufp);
	if (err < 0) {
833
		spin_lock_irq(&bus->reg_lock);
834 835
		if (saved)
			*azx_dev = chip->saved_azx_dev;
836
		spin_unlock_irq(&bus->reg_lock);
837 838
		return err;
	}
839

840
	azx_dev->prepared = 0;
841 842 843
	return err;
}

844
static void azx_load_dsp_trigger(struct hda_bus *_bus, bool start)
845
{
846 847
	struct hdac_bus *bus = &_bus->core;
	struct azx *chip = bus_to_azx(bus);
848 849
	struct azx_dev *azx_dev = azx_get_dsp_loader_dev(chip);

850
	snd_hdac_dsp_trigger(azx_stream(azx_dev), start);
851 852
}

853
static void azx_load_dsp_cleanup(struct hda_bus *_bus,
854
				 struct snd_dma_buffer *dmab)
855
{
856 857
	struct hdac_bus *bus = &_bus->core;
	struct azx *chip = bus_to_azx(bus);
858
	struct azx_dev *azx_dev = azx_get_dsp_loader_dev(chip);
859
	struct hdac_stream *hstr = azx_stream(azx_dev);
860

861
	if (!dmab->area || !azx_dev->core.locked)
862 863
		return;

864
	snd_hdac_dsp_cleanup(hstr, dmab);
865
	spin_lock_irq(&bus->reg_lock);
866
	if (hstr->opened)
867
		*azx_dev = chip->saved_azx_dev;
868
	hstr->locked = false;
869
	spin_unlock_irq(&bus->reg_lock);
870 871 872
}
#endif /* CONFIG_SND_HDA_DSP_LOADER */

873 874 875
/*
 * reset and start the controller registers
 */
876
void azx_init_chip(struct azx *chip, bool full_reset)
877
{
878 879 880 881 882
	if (snd_hdac_bus_init_chip(azx_bus(chip), full_reset)) {
		/* correct RINTCNT for CXT */
		if (chip->driver_caps & AZX_DCAPS_CTX_WORKAROUND)
			azx_writew(chip, RINTCNT, 0xc0);
	}
883 884 885
}
EXPORT_SYMBOL_GPL(azx_init_chip);

886 887 888 889 890 891 892 893 894 895
void azx_stop_all_streams(struct azx *chip)
{
	struct hdac_bus *bus = azx_bus(chip);
	struct hdac_stream *s;

	list_for_each_entry(s, &bus->stream_list, list)
		snd_hdac_stream_stop(s);
}
EXPORT_SYMBOL_GPL(azx_stop_all_streams);

896 897
void azx_stop_chip(struct azx *chip)
{
898
	snd_hdac_bus_stop_chip(azx_bus(chip));
899
}
900
EXPORT_SYMBOL_GPL(azx_stop_chip);
901

902 903 904
/*
 * interrupt handler
 */
905 906
static void stream_update(struct hdac_bus *bus, struct hdac_stream *s)
{
907
	struct azx *chip = bus_to_azx(bus);
908 909 910 911 912
	struct azx_dev *azx_dev = stream_to_azx_dev(s);

	/* check whether this IRQ is really acceptable */
	if (!chip->ops->position_check ||
	    chip->ops->position_check(chip, azx_dev)) {
913 914 915
		spin_unlock(&bus->reg_lock);
		snd_pcm_period_elapsed(azx_stream(azx_dev)->substream);
		spin_lock(&bus->reg_lock);
916 917 918
	}
}

919 920 921
irqreturn_t azx_interrupt(int irq, void *dev_id)
{
	struct azx *chip = dev_id;
922
	struct hdac_bus *bus = azx_bus(chip);
923 924
	u32 status;

925
#ifdef CONFIG_PM
926
	if (azx_has_pm_runtime(chip))
927
		if (!pm_runtime_active(chip->card->dev))
928 929 930
			return IRQ_NONE;
#endif

931
	spin_lock(&bus->reg_lock);
932 933

	if (chip->disabled) {
934
		spin_unlock(&bus->reg_lock);
935 936 937 938 939
		return IRQ_NONE;
	}

	status = azx_readl(chip, INTSTS);
	if (status == 0 || status == 0xffffffff) {
940
		spin_unlock(&bus->reg_lock);
941 942 943
		return IRQ_NONE;
	}

944
	snd_hdac_bus_handle_stream_irq(bus, status, stream_update);
945 946 947 948 949 950 951

	/* clear rirb int */
	status = azx_readb(chip, RIRBSTS);
	if (status & RIRB_INT_MASK) {
		if (status & RIRB_INT_RESPONSE) {
			if (chip->driver_caps & AZX_DCAPS_RIRB_PRE_DELAY)
				udelay(80);
952
			snd_hdac_bus_update_rirb(bus);
953 954 955 956
		}
		azx_writeb(chip, RIRBSTS, RIRB_INT_MASK);
	}

957
	spin_unlock(&bus->reg_lock);
958 959 960 961 962

	return IRQ_HANDLED;
}
EXPORT_SYMBOL_GPL(azx_interrupt);

963 964 965 966 967 968 969 970 971 972 973
/*
 * Codec initerface
 */

/*
 * Probe the given codec address
 */
static int probe_codec(struct azx *chip, int addr)
{
	unsigned int cmd = (addr << 28) | (AC_NODE_ROOT << 20) |
		(AC_VERB_PARAMETERS << 8) | AC_PAR_VENDOR_ID;
974
	struct hdac_bus *bus = azx_bus(chip);
975
	int err;
976
	unsigned int res = -1;
977

978
	mutex_lock(&bus->cmd_mutex);
979
	chip->probing = 1;
980 981
	azx_send_cmd(bus, cmd);
	err = azx_get_response(bus, addr, &res);
982
	chip->probing = 0;
983
	mutex_unlock(&bus->cmd_mutex);
984
	if (err < 0 || res == -1)
985 986 987 988 989 990 991
		return -EIO;
	dev_dbg(chip->card->dev, "codec #%d probed OK\n", addr);
	return 0;
}

static void azx_bus_reset(struct hda_bus *bus)
{
992
	struct azx *chip = bus_to_azx(&bus->core);
993 994 995

	bus->in_reset = 1;
	azx_stop_chip(chip);
996
	azx_init_chip(chip, true);
997 998
	if (bus->core.chip_init)
		snd_hda_bus_reset(bus);
999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022
	bus->in_reset = 0;
}

static int get_jackpoll_interval(struct azx *chip)
{
	int i;
	unsigned int j;

	if (!chip->jackpoll_ms)
		return 0;

	i = chip->jackpoll_ms[chip->dev_index];
	if (i == 0)
		return 0;
	if (i < 50 || i > 60000)
		j = 0;
	else
		j = msecs_to_jiffies(i);
	if (j == 0)
		dev_warn(chip->card->dev,
			 "jackpoll_ms value out of range: %d\n", i);
	return j;
}

1023 1024 1025 1026 1027 1028 1029 1030 1031 1032
static struct hda_bus_ops bus_ops = {
	.attach_pcm = azx_attach_pcm_stream,
	.bus_reset = azx_bus_reset,
#ifdef CONFIG_SND_HDA_DSP_LOADER
	.load_dsp_prepare = azx_load_dsp_prepare,
	.load_dsp_trigger = azx_load_dsp_trigger,
	.load_dsp_cleanup = azx_load_dsp_cleanup,
#endif
};

1033
/* HD-audio bus initialization */
1034 1035
int azx_bus_init(struct azx *chip, const char *model,
		 const struct hdac_io_ops *io_ops)
1036
{
1037
	struct hda_bus *bus = &chip->bus;
1038
	int err;
1039

1040 1041
	err = snd_hdac_bus_init(&bus->core, chip->card->dev, &bus_core_ops,
				io_ops);
1042 1043 1044
	if (err < 0)
		return err;

1045 1046
	bus->card = chip->card;
	mutex_init(&bus->prepare_mutex);
1047 1048 1049
	bus->pci = chip->pci;
	bus->modelname = model;
	bus->ops = bus_ops;
1050 1051 1052 1053 1054 1055
	bus->core.snoop = azx_snoop(chip);
	if (chip->get_position[0] != azx_get_pos_lpib ||
	    chip->get_position[1] != azx_get_pos_lpib)
		bus->core.use_posbuf = true;
	if (chip->bdl_pos_adj)
		bus->core.bdl_pos_adj = chip->bdl_pos_adj[chip->dev_index];
1056 1057
	if (chip->driver_caps & AZX_DCAPS_CORBRP_SELF_CLEAR)
		bus->core.corbrp_self_clear = true;
1058

1059 1060
	if (chip->driver_caps & AZX_DCAPS_RIRB_DELAY) {
		dev_dbg(chip->card->dev, "Enable delay in RIRB handling\n");
1061
		bus->needs_damn_long_delay = 1;
1062 1063
	}

1064 1065 1066 1067 1068 1069
	/* AMD chipsets often cause the communication stalls upon certain
	 * sequence like the pin-detection.  It seems that forcing the synced
	 * access works around the stall.  Grrr...
	 */
	if (chip->driver_caps & AZX_DCAPS_SYNC_WRITE) {
		dev_dbg(chip->card->dev, "Enable sync_write for stable communication\n");
1070
		bus->core.sync_write = 1;
1071 1072 1073 1074 1075
		bus->allow_bus_reset = 1;
	}

	return 0;
}
1076
EXPORT_SYMBOL_GPL(azx_bus_init);
1077 1078 1079 1080

/* Probe codecs */
int azx_probe_codecs(struct azx *chip, unsigned int max_slots)
{
1081
	struct hdac_bus *bus = azx_bus(chip);
1082 1083
	int c, codecs, err;

1084 1085 1086 1087 1088 1089
	codecs = 0;
	if (!max_slots)
		max_slots = AZX_DEFAULT_CODECS;

	/* First try to probe all given codec slots */
	for (c = 0; c < max_slots; c++) {
1090
		if ((bus->codec_mask & (1 << c)) & chip->codec_probe_mask) {
1091 1092 1093 1094 1095 1096
			if (probe_codec(chip, c) < 0) {
				/* Some BIOSen give you wrong codec addresses
				 * that don't exist
				 */
				dev_warn(chip->card->dev,
					 "Codec #%d probe error; disabling it...\n", c);
1097
				bus->codec_mask &= ~(1 << c);
1098 1099 1100 1101 1102 1103 1104 1105
				/* More badly, accessing to a non-existing
				 * codec often screws up the controller chip,
				 * and disturbs the further communications.
				 * Thus if an error occurs during probing,
				 * better to reset the controller chip to
				 * get back to the sanity state.
				 */
				azx_stop_chip(chip);
1106
				azx_init_chip(chip, true);
1107 1108 1109 1110 1111 1112
			}
		}
	}

	/* Then create codec instances */
	for (c = 0; c < max_slots; c++) {
1113
		if ((bus->codec_mask & (1 << c)) & chip->codec_probe_mask) {
1114
			struct hda_codec *codec;
1115
			err = snd_hda_codec_new(&chip->bus, chip->card, c, &codec);
1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128
			if (err < 0)
				continue;
			codec->jackpoll_interval = get_jackpoll_interval(chip);
			codec->beep_mode = chip->beep_mode;
			codecs++;
		}
	}
	if (!codecs) {
		dev_err(chip->card->dev, "no codecs initialized\n");
		return -ENXIO;
	}
	return 0;
}
1129
EXPORT_SYMBOL_GPL(azx_probe_codecs);
1130 1131 1132 1133 1134

/* configure each codec instance */
int azx_codec_configure(struct azx *chip)
{
	struct hda_codec *codec;
1135
	list_for_each_codec(codec, &chip->bus) {
1136 1137 1138 1139 1140 1141
		snd_hda_codec_configure(codec);
	}
	return 0;
}
EXPORT_SYMBOL_GPL(azx_codec_configure);

1142
static int stream_direction(struct azx *chip, unsigned char index)
1143
{
1144 1145 1146 1147
	if (index >= chip->capture_index_offset &&
	    index < chip->capture_index_offset + chip->capture_streams)
		return SNDRV_PCM_STREAM_CAPTURE;
	return SNDRV_PCM_STREAM_PLAYBACK;
1148 1149
}

1150
/* initialize SD streams */
1151
int azx_init_streams(struct azx *chip)
1152 1153
{
	int i;
1154
	int stream_tags[2] = { 0, 0 };
1155 1156 1157 1158 1159 1160

	/* initialize each stream (aka device)
	 * assign the starting bdl address to each stream (device)
	 * and initialize
	 */
	for (i = 0; i < chip->num_streams; i++) {
1161 1162 1163 1164 1165
		struct azx_dev *azx_dev = kzalloc(sizeof(*azx_dev), GFP_KERNEL);
		int dir, tag;

		if (!azx_dev)
			return -ENOMEM;
1166

1167
		dir = stream_direction(chip, i);
1168 1169 1170 1171 1172 1173 1174
		/* stream tag must be unique throughout
		 * the stream direction group,
		 * valid values 1...15
		 * use separate stream tag if the flag
		 * AZX_DCAPS_SEPARATE_STREAM_TAG is used
		 */
		if (chip->driver_caps & AZX_DCAPS_SEPARATE_STREAM_TAG)
1175
			tag = ++stream_tags[dir];
1176
		else
1177 1178 1179
			tag = i + 1;
		snd_hdac_stream_init(azx_bus(chip), azx_stream(azx_dev),
				     i, dir, tag);
1180 1181 1182 1183
	}

	return 0;
}
1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197
EXPORT_SYMBOL_GPL(azx_init_streams);

void azx_free_streams(struct azx *chip)
{
	struct hdac_bus *bus = azx_bus(chip);
	struct hdac_stream *s;

	while (!list_empty(&bus->stream_list)) {
		s = list_first_entry(&bus->stream_list, struct hdac_stream, list);
		list_del(&s->list);
		kfree(stream_to_azx_dev(s));
	}
}
EXPORT_SYMBOL_GPL(azx_free_streams);