hda_controller.c 30.6 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 35 36
#define CREATE_TRACE_POINTS
#include "hda_intel_trace.h"

37
/* DSP lock helpers */
38 39 40
#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))
41

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

	s = snd_hdac_stream_assign(azx_bus(chip), substream);
	if (!s)
		return NULL;
	return stream_to_azx_dev(s);
52 53 54 55 56
}

/* release the assigned stream */
static inline void azx_release_device(struct azx_dev *azx_dev)
{
57
	snd_hdac_stream_release(azx_stream(azx_dev));
58 59
}

60 61 62 63 64 65 66
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];
}

67 68 69 70
static u64 azx_adjust_codec_delay(struct snd_pcm_substream *substream,
				u64 nsec)
{
	struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
71
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93
	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);
94
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
95 96 97 98 99
	struct azx *chip = apcm->chip;
	struct azx_dev *azx_dev = get_azx_dev(substream);

	mutex_lock(&chip->open_mutex);
	azx_release_device(azx_dev);
100 101
	if (hinfo->ops.close)
		hinfo->ops.close(hinfo, apcm->codec, substream);
102 103
	snd_hda_power_down(apcm->codec);
	mutex_unlock(&chip->open_mutex);
104
	snd_hda_codec_pcm_put(apcm->info);
105 106 107 108 109 110 111 112
	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 已提交
113
	struct azx_dev *azx_dev = get_azx_dev(substream);
114 115
	int ret;

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

T
Takashi Iwai 已提交
122 123 124
	azx_dev->core.bufsize = 0;
	azx_dev->core.period_bytes = 0;
	azx_dev->core.format_val = 0;
125 126 127
	ret = chip->ops->substream_alloc_pages(chip, substream,
					  params_buffer_bytes(hw_params));
unlock:
T
Takashi Iwai 已提交
128
	dsp_unlock(azx_dev);
129 130 131 132 133 134 135 136
	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;
137
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
138 139 140 141
	int err;

	/* reset BDL address */
	dsp_lock(azx_dev);
142 143
	if (!dsp_is_locked(azx_dev))
		snd_hdac_stream_cleanup(azx_stream(azx_dev));
144 145 146 147

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

	err = chip->ops->substream_free_pages(chip, substream);
148
	azx_stream(azx_dev)->prepared = 0;
149 150 151 152 153 154 155 156 157
	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);
158
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
159
	struct snd_pcm_runtime *runtime = substream->runtime;
160
	unsigned int format_val, stream_tag;
161 162 163 164 165 166 167 168 169 170 171
	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;
	}

172
	snd_hdac_stream_reset(azx_stream(azx_dev));
173
	format_val = snd_hdac_calc_stream_format(runtime->rate,
174 175 176 177 178 179 180 181 182 183 184 185
						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;
	}

186 187 188
	err = snd_hdac_stream_set_params(azx_stream(azx_dev), format_val);
	if (err < 0)
		goto unlock;
189

190
	snd_hdac_stream_setup(azx_stream(azx_dev));
191

192
	stream_tag = azx_dev->core.stream_tag;
193 194 195 196 197
	/* 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,
198
				     azx_dev->core.format_val, substream);
199 200 201

 unlock:
	if (!err)
202
		azx_stream(azx_dev)->prepared = 1;
203 204 205 206 207 208 209 210
	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;
211
	struct hdac_bus *bus = azx_bus(chip);
212 213
	struct azx_dev *azx_dev;
	struct snd_pcm_substream *s;
214 215 216 217
	struct hdac_stream *hstr;
	bool start;
	int sbits = 0;
	int sync_reg;
218 219

	azx_dev = get_azx_dev(substream);
220 221
	trace_azx_pcm_trigger(chip, azx_dev, cmd);

222 223 224 225 226
	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;
227

228
	if (dsp_is_locked(azx_dev) || !hstr->prepared)
229 230 231 232 233 234
		return -EPIPE;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
	case SNDRV_PCM_TRIGGER_RESUME:
235
		start = true;
236 237 238 239
		break;
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
	case SNDRV_PCM_TRIGGER_SUSPEND:
	case SNDRV_PCM_TRIGGER_STOP:
240
		start = false;
241 242 243 244 245 246 247 248 249
		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);
250
		sbits |= 1 << azx_dev->core.index;
251 252 253
		snd_pcm_trigger_done(s, substream);
	}

254
	spin_lock(&bus->reg_lock);
255 256

	/* first, set SYNC bits of corresponding streams */
257
	snd_hdac_stream_sync_trigger(hstr, true, sbits, sync_reg);
258 259 260 261 262 263

	snd_pcm_group_for_each_entry(s, substream) {
		if (s->pcm->card != substream->pcm->card)
			continue;
		azx_dev = get_azx_dev(s);
		if (start) {
264 265
			azx_dev->insufficient = 1;
			snd_hdac_stream_start(azx_stream(azx_dev), true);
266
		} else {
267
			snd_hdac_stream_stop(azx_stream(azx_dev));
268 269
		}
	}
270
	spin_unlock(&bus->reg_lock);
271 272 273

	snd_hdac_stream_sync(hstr, start, sbits);

274
	spin_lock(&bus->reg_lock);
275
	/* reset SYNC bits */
276 277 278
	snd_hdac_stream_sync_trigger(hstr, false, sbits, sync_reg);
	if (start)
		snd_hdac_stream_timecounter_init(hstr, sbits);
279
	spin_unlock(&bus->reg_lock);
280 281 282
	return 0;
}

283
unsigned int azx_get_pos_lpib(struct azx *chip, struct azx_dev *azx_dev)
284
{
285
	return snd_hdac_stream_get_pos_lpib(azx_stream(azx_dev));
286 287
}
EXPORT_SYMBOL_GPL(azx_get_pos_lpib);
288

289 290
unsigned int azx_get_pos_posbuf(struct azx *chip, struct azx_dev *azx_dev)
{
291
	return snd_hdac_stream_get_pos_posbuf(azx_stream(azx_dev));
292
}
293
EXPORT_SYMBOL_GPL(azx_get_pos_posbuf);
294 295

unsigned int azx_get_position(struct azx *chip,
296
			      struct azx_dev *azx_dev)
297
{
298
	struct snd_pcm_substream *substream = azx_dev->core.substream;
299 300 301 302
	unsigned int pos;
	int stream = substream->stream;
	int delay = 0;

303 304 305 306
	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);
307

308
	if (pos >= azx_dev->core.bufsize)
309 310 311
		pos = 0;

	if (substream->runtime) {
312
		struct azx_pcm *apcm = snd_pcm_substream_chip(substream);
313
		struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
314 315 316

		if (chip->get_delay[stream])
			delay += chip->get_delay[stream](chip, azx_dev, pos);
317 318 319 320 321 322
		if (hinfo->ops.get_delay)
			delay += hinfo->ops.get_delay(hinfo, apcm->codec,
						      substream);
		substream->runtime->delay = delay;
	}

323
	trace_azx_get_position(chip, azx_dev, pos, delay);
324 325 326 327 328 329 330 331 332 333
	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,
334
			       azx_get_position(chip, azx_dev));
335 336
}

337 338 339 340
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)
341 342 343 344
{
	struct azx_dev *azx_dev = get_azx_dev(substream);
	u64 nsec;

345 346
	if ((substream->runtime->hw.info & SNDRV_PCM_INFO_HAS_LINK_ATIME) &&
		(audio_tstamp_config->type_requested == SNDRV_PCM_AUDIO_TSTAMP_TYPE_LINK)) {
347

348 349
		snd_pcm_gettime(substream->runtime, system_ts);

350
		nsec = timecounter_read(&azx_dev->core.tc);
351 352 353 354 355 356 357 358 359 360 361 362
		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;
363 364 365 366 367 368 369 370 371 372 373 374 375

	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 |
376 377
				 SNDRV_PCM_INFO_HAS_WALL_CLOCK | /* legacy */
				 SNDRV_PCM_INFO_HAS_LINK_ATIME |
378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395
				 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);
396
	struct hda_pcm_stream *hinfo = to_hda_pcm_stream(substream);
397 398 399 400 401 402
	struct azx *chip = apcm->chip;
	struct azx_dev *azx_dev;
	struct snd_pcm_runtime *runtime = substream->runtime;
	int err;
	int buff_step;

403
	snd_hda_codec_pcm_get(apcm->info);
404 405 406
	mutex_lock(&chip->open_mutex);
	azx_dev = azx_assign_device(chip, substream);
	if (azx_dev == NULL) {
407 408
		err = -EBUSY;
		goto unlock;
409
	}
410
	runtime->private_data = azx_dev;
411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
	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);
443
	snd_hda_power_up(apcm->codec);
444 445 446 447
	if (hinfo->ops.open)
		err = hinfo->ops.open(hinfo, apcm->codec, substream);
	else
		err = -ENODEV;
448 449
	if (err < 0) {
		azx_release_device(azx_dev);
450
		goto powerdown;
451 452 453 454 455 456 457 458
	}
	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);
459 460 461 462
		if (hinfo->ops.close)
			hinfo->ops.close(hinfo, apcm->codec, substream);
		err = -EINVAL;
		goto powerdown;
463 464
	}

465
	/* disable LINK_ATIME timestamps for capture streams
466
	   until we figure out how to handle digital inputs */
467 468 469 470
	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;
	}
471 472 473 474

	snd_pcm_set_sync(substream);
	mutex_unlock(&chip->open_mutex);
	return 0;
475 476 477 478 479

 powerdown:
	snd_hda_power_down(apcm->codec);
 unlock:
	mutex_unlock(&chip->open_mutex);
480
	snd_hda_codec_pcm_put(apcm->info);
481
	return err;
482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
}

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,
503
	.get_time_info =  azx_get_time_info,
504 505 506 507 508 509 510 511 512
	.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);
513
		apcm->info->pcm = NULL;
514 515 516 517 518 519
		kfree(apcm);
	}
}

#define MAX_PREALLOC_SIZE	(32 * 1024 * 1024)

520 521
int snd_hda_attach_pcm_stream(struct hda_bus *_bus, struct hda_codec *codec,
			      struct hda_pcm *cpcm)
522
{
523 524
	struct hdac_bus *bus = &_bus->core;
	struct azx *chip = bus_to_azx(bus);
525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550
	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;
551
	apcm->info = cpcm;
552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571
	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;
}

572 573 574 575 576 577 578 579 580 581 582 583 584
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 */
585
static int azx_rirb_get_response(struct hdac_bus *bus, unsigned int addr,
586
				 unsigned int *res)
587
{
588 589
	struct azx *chip = bus_to_azx(bus);
	struct hda_bus *hbus = &chip->bus;
590 591 592 593 594 595 596 597
	unsigned long timeout;
	unsigned long loopcounter;
	int do_poll = 0;

 again:
	timeout = jiffies + msecs_to_jiffies(1000);

	for (loopcounter = 0;; loopcounter++) {
598 599 600 601
		spin_lock_irq(&bus->reg_lock);
		if (chip->polling_mode || do_poll)
			snd_hdac_bus_update_rirb(bus);
		if (!bus->rirb.cmds[addr]) {
602 603
			if (!do_poll)
				chip->poll_count = 0;
604
			if (res)
605 606
				*res = bus->rirb.res[addr]; /* the last value */
			spin_unlock_irq(&bus->reg_lock);
607
			return 0;
608
		}
609
		spin_unlock_irq(&bus->reg_lock);
610 611
		if (time_after(jiffies, timeout))
			break;
612
		if (hbus->needs_damn_long_delay || loopcounter > 3000)
613 614 615 616 617 618 619
			msleep(2); /* temporary workaround */
		else {
			udelay(10);
			cond_resched();
		}
	}

620
	if (hbus->no_response_fallback)
621
		return -EIO;
622 623 624 625

	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",
626
			bus->last_cmd[addr]);
627 628 629 630 631 632 633 634 635
		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",
636
			 bus->last_cmd[addr]);
637 638 639 640 641 642 643
		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",
644 645
			 bus->last_cmd[addr]);
		if (chip->ops->disable_msi_reset_irq &&
646 647
		    chip->ops->disable_msi_reset_irq(chip) < 0)
			return -EIO;
648 649 650 651 652 653 654 655
		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.
		 */
656
		return -EIO;
657 658 659 660 661
	}

	/* a fatal communication error; need either to reset or to fallback
	 * to the single_cmd mode
	 */
662 663
	if (hbus->allow_bus_reset && !hbus->response_reset && !hbus->in_reset) {
		hbus->response_reset = 1;
664
		return -EAGAIN; /* give a chance to retry */
665 666 667 668
	}

	dev_err(chip->card->dev,
		"azx_get_response timeout, switching to single_cmd mode: last cmd=0x%08x\n",
669
		bus->last_cmd[addr]);
670
	chip->single_cmd = 1;
671 672
	hbus->response_reset = 0;
	snd_hdac_bus_stop_cmd_io(bus);
673
	return -EIO;
674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692
}

/*
 * 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 已提交
693
		if (azx_readw(chip, IRS) & AZX_IRS_VALID) {
694
			/* reuse rirb.res as the response return value */
695
			azx_bus(chip)->rirb.res[addr] = azx_readl(chip, IR);
696 697 698 699 700 701 702
			return 0;
		}
		udelay(1);
	}
	if (printk_ratelimit())
		dev_dbg(chip->card->dev, "get_response timeout: IRS=0x%x\n",
			azx_readw(chip, IRS));
703
	azx_bus(chip)->rirb.res[addr] = -1;
704 705 706 707
	return -EIO;
}

/* send a command */
708
static int azx_single_send_cmd(struct hdac_bus *bus, u32 val)
709
{
710
	struct azx *chip = bus_to_azx(bus);
711 712 713
	unsigned int addr = azx_command_addr(val);
	int timeout = 50;

714
	bus->last_cmd[azx_command_addr(val)] = val;
715 716
	while (timeout--) {
		/* check ICB busy bit */
T
Takashi Iwai 已提交
717
		if (!((azx_readw(chip, IRS) & AZX_IRS_BUSY))) {
718 719
			/* Clear IRV valid bit */
			azx_writew(chip, IRS, azx_readw(chip, IRS) |
T
Takashi Iwai 已提交
720
				   AZX_IRS_VALID);
721 722
			azx_writel(chip, IC, val);
			azx_writew(chip, IRS, azx_readw(chip, IRS) |
T
Takashi Iwai 已提交
723
				   AZX_IRS_BUSY);
724 725 726 727 728 729 730 731 732 733 734 735
			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 */
736
static int azx_single_get_response(struct hdac_bus *bus, unsigned int addr,
737
				   unsigned int *res)
738
{
739
	if (res)
740
		*res = bus->rirb.res[addr];
741
	return 0;
742 743 744 745 746 747 748 749 750 751
}

/*
 * 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 */
752
static int azx_send_cmd(struct hdac_bus *bus, unsigned int val)
753
{
754
	struct azx *chip = bus_to_azx(bus);
755 756 757 758 759 760

	if (chip->disabled)
		return 0;
	if (chip->single_cmd)
		return azx_single_send_cmd(bus, val);
	else
761
		return snd_hdac_bus_send_cmd(bus, val);
762 763 764
}

/* get a response */
765
static int azx_get_response(struct hdac_bus *bus, unsigned int addr,
766
			    unsigned int *res)
767
{
768 769
	struct azx *chip = bus_to_azx(bus);

770 771 772
	if (chip->disabled)
		return 0;
	if (chip->single_cmd)
773
		return azx_single_get_response(bus, addr, res);
774
	else
775
		return azx_rirb_get_response(bus, addr, res);
776 777
}

778 779 780 781 782
static const struct hdac_bus_ops bus_core_ops = {
	.command = azx_send_cmd,
	.get_response = azx_get_response,
};

783 784 785 786 787 788 789 790 791
#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)
{
792 793 794 795 796 797 798 799
	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;
800 801
}

802 803 804
int snd_hda_codec_load_dsp_prepare(struct hda_codec *codec, unsigned int format,
				   unsigned int byte_size,
				   struct snd_dma_buffer *bufp)
805
{
806
	struct hdac_bus *bus = &codec->bus->core;
807
	struct azx *chip = bus_to_azx(bus);
808
	struct azx_dev *azx_dev;
809 810
	struct hdac_stream *hstr;
	bool saved = false;
811 812 813
	int err;

	azx_dev = azx_get_dsp_loader_dev(chip);
814
	hstr = azx_stream(azx_dev);
815
	spin_lock_irq(&bus->reg_lock);
816 817 818
	if (hstr->opened) {
		chip->saved_azx_dev = *azx_dev;
		saved = true;
819
	}
820
	spin_unlock_irq(&bus->reg_lock);
821

822 823
	err = snd_hdac_dsp_prepare(hstr, format, byte_size, bufp);
	if (err < 0) {
824
		spin_lock_irq(&bus->reg_lock);
825 826
		if (saved)
			*azx_dev = chip->saved_azx_dev;
827
		spin_unlock_irq(&bus->reg_lock);
828 829
		return err;
	}
830

831
	hstr->prepared = 0;
832 833
	return err;
}
834
EXPORT_SYMBOL_GPL(snd_hda_codec_load_dsp_prepare);
835

836
void snd_hda_codec_load_dsp_trigger(struct hda_codec *codec, bool start)
837
{
838
	struct hdac_bus *bus = &codec->bus->core;
839
	struct azx *chip = bus_to_azx(bus);
840 841
	struct azx_dev *azx_dev = azx_get_dsp_loader_dev(chip);

842
	snd_hdac_dsp_trigger(azx_stream(azx_dev), start);
843
}
844
EXPORT_SYMBOL_GPL(snd_hda_codec_load_dsp_trigger);
845

846 847
void snd_hda_codec_load_dsp_cleanup(struct hda_codec *codec,
				    struct snd_dma_buffer *dmab)
848
{
849
	struct hdac_bus *bus = &codec->bus->core;
850
	struct azx *chip = bus_to_azx(bus);
851
	struct azx_dev *azx_dev = azx_get_dsp_loader_dev(chip);
852
	struct hdac_stream *hstr = azx_stream(azx_dev);
853

854
	if (!dmab->area || !hstr->locked)
855 856
		return;

857
	snd_hdac_dsp_cleanup(hstr, dmab);
858
	spin_lock_irq(&bus->reg_lock);
859
	if (hstr->opened)
860
		*azx_dev = chip->saved_azx_dev;
861
	hstr->locked = false;
862
	spin_unlock_irq(&bus->reg_lock);
863
}
864
EXPORT_SYMBOL_GPL(snd_hda_codec_load_dsp_cleanup);
865 866
#endif /* CONFIG_SND_HDA_DSP_LOADER */

867 868 869
/*
 * reset and start the controller registers
 */
870
void azx_init_chip(struct azx *chip, bool full_reset)
871
{
872 873 874 875 876
	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);
	}
877 878 879
}
EXPORT_SYMBOL_GPL(azx_init_chip);

880 881 882 883 884 885 886 887 888 889
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);

890 891
void azx_stop_chip(struct azx *chip)
{
892
	snd_hdac_bus_stop_chip(azx_bus(chip));
893
}
894
EXPORT_SYMBOL_GPL(azx_stop_chip);
895

896 897 898
/*
 * interrupt handler
 */
899 900
static void stream_update(struct hdac_bus *bus, struct hdac_stream *s)
{
901
	struct azx *chip = bus_to_azx(bus);
902 903 904 905 906
	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)) {
907 908 909
		spin_unlock(&bus->reg_lock);
		snd_pcm_period_elapsed(azx_stream(azx_dev)->substream);
		spin_lock(&bus->reg_lock);
910 911 912
	}
}

913 914 915
irqreturn_t azx_interrupt(int irq, void *dev_id)
{
	struct azx *chip = dev_id;
916
	struct hdac_bus *bus = azx_bus(chip);
917 918
	u32 status;

919
#ifdef CONFIG_PM
920
	if (azx_has_pm_runtime(chip))
921
		if (!pm_runtime_active(chip->card->dev))
922 923 924
			return IRQ_NONE;
#endif

925
	spin_lock(&bus->reg_lock);
926 927

	if (chip->disabled) {
928
		spin_unlock(&bus->reg_lock);
929 930 931 932 933
		return IRQ_NONE;
	}

	status = azx_readl(chip, INTSTS);
	if (status == 0 || status == 0xffffffff) {
934
		spin_unlock(&bus->reg_lock);
935 936 937
		return IRQ_NONE;
	}

938
	snd_hdac_bus_handle_stream_irq(bus, status, stream_update);
939 940 941 942 943 944 945

	/* 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);
946
			snd_hdac_bus_update_rirb(bus);
947 948 949 950
		}
		azx_writeb(chip, RIRBSTS, RIRB_INT_MASK);
	}

951
	spin_unlock(&bus->reg_lock);
952 953 954 955 956

	return IRQ_HANDLED;
}
EXPORT_SYMBOL_GPL(azx_interrupt);

957 958 959 960 961 962 963 964 965 966 967
/*
 * 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;
968
	struct hdac_bus *bus = azx_bus(chip);
969
	int err;
970
	unsigned int res = -1;
971

972
	mutex_lock(&bus->cmd_mutex);
973
	chip->probing = 1;
974 975
	azx_send_cmd(bus, cmd);
	err = azx_get_response(bus, addr, &res);
976
	chip->probing = 0;
977
	mutex_unlock(&bus->cmd_mutex);
978
	if (err < 0 || res == -1)
979 980 981 982 983
		return -EIO;
	dev_dbg(chip->card->dev, "codec #%d probed OK\n", addr);
	return 0;
}

984
void snd_hda_bus_reset(struct hda_bus *bus)
985
{
986
	struct azx *chip = bus_to_azx(&bus->core);
987 988 989

	bus->in_reset = 1;
	azx_stop_chip(chip);
990
	azx_init_chip(chip, true);
991
	if (bus->core.chip_init)
992
		snd_hda_bus_reset_codecs(bus);
993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016
	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;
}

1017
/* HD-audio bus initialization */
1018 1019
int azx_bus_init(struct azx *chip, const char *model,
		 const struct hdac_io_ops *io_ops)
1020
{
1021
	struct hda_bus *bus = &chip->bus;
1022
	int err;
1023

1024 1025
	err = snd_hdac_bus_init(&bus->core, chip->card->dev, &bus_core_ops,
				io_ops);
1026 1027 1028
	if (err < 0)
		return err;

1029 1030
	bus->card = chip->card;
	mutex_init(&bus->prepare_mutex);
1031 1032
	bus->pci = chip->pci;
	bus->modelname = model;
1033 1034 1035 1036 1037 1038
	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];
1039 1040
	if (chip->driver_caps & AZX_DCAPS_CORBRP_SELF_CLEAR)
		bus->core.corbrp_self_clear = true;
1041

1042 1043
	if (chip->driver_caps & AZX_DCAPS_RIRB_DELAY) {
		dev_dbg(chip->card->dev, "Enable delay in RIRB handling\n");
1044
		bus->needs_damn_long_delay = 1;
1045 1046
	}

1047 1048 1049 1050 1051 1052
	/* 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");
1053
		bus->core.sync_write = 1;
1054 1055 1056 1057 1058
		bus->allow_bus_reset = 1;
	}

	return 0;
}
1059
EXPORT_SYMBOL_GPL(azx_bus_init);
1060 1061 1062 1063

/* Probe codecs */
int azx_probe_codecs(struct azx *chip, unsigned int max_slots)
{
1064
	struct hdac_bus *bus = azx_bus(chip);
1065 1066
	int c, codecs, err;

1067 1068 1069 1070 1071 1072
	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++) {
1073
		if ((bus->codec_mask & (1 << c)) & chip->codec_probe_mask) {
1074 1075 1076 1077 1078 1079
			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);
1080
				bus->codec_mask &= ~(1 << c);
1081 1082 1083 1084 1085 1086 1087 1088
				/* 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);
1089
				azx_init_chip(chip, true);
1090 1091 1092 1093 1094 1095
			}
		}
	}

	/* Then create codec instances */
	for (c = 0; c < max_slots; c++) {
1096
		if ((bus->codec_mask & (1 << c)) & chip->codec_probe_mask) {
1097
			struct hda_codec *codec;
1098
			err = snd_hda_codec_new(&chip->bus, chip->card, c, &codec);
1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111
			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;
}
1112
EXPORT_SYMBOL_GPL(azx_probe_codecs);
1113 1114 1115 1116 1117

/* configure each codec instance */
int azx_codec_configure(struct azx *chip)
{
	struct hda_codec *codec;
1118
	list_for_each_codec(codec, &chip->bus) {
1119 1120 1121 1122 1123 1124
		snd_hda_codec_configure(codec);
	}
	return 0;
}
EXPORT_SYMBOL_GPL(azx_codec_configure);

1125
static int stream_direction(struct azx *chip, unsigned char index)
1126
{
1127 1128 1129 1130
	if (index >= chip->capture_index_offset &&
	    index < chip->capture_index_offset + chip->capture_streams)
		return SNDRV_PCM_STREAM_CAPTURE;
	return SNDRV_PCM_STREAM_PLAYBACK;
1131 1132
}

1133
/* initialize SD streams */
1134
int azx_init_streams(struct azx *chip)
1135 1136
{
	int i;
1137
	int stream_tags[2] = { 0, 0 };
1138 1139 1140 1141 1142 1143

	/* initialize each stream (aka device)
	 * assign the starting bdl address to each stream (device)
	 * and initialize
	 */
	for (i = 0; i < chip->num_streams; i++) {
1144 1145 1146 1147 1148
		struct azx_dev *azx_dev = kzalloc(sizeof(*azx_dev), GFP_KERNEL);
		int dir, tag;

		if (!azx_dev)
			return -ENOMEM;
1149

1150
		dir = stream_direction(chip, i);
1151 1152 1153 1154 1155 1156 1157
		/* 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)
1158
			tag = ++stream_tags[dir];
1159
		else
1160 1161 1162
			tag = i + 1;
		snd_hdac_stream_init(azx_bus(chip), azx_stream(azx_dev),
				     i, dir, tag);
1163 1164 1165 1166
	}

	return 0;
}
1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180
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);