pcm_lib.c 58.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 *  Digital Audio (PCM) abstract layer
3
 *  Copyright (c) by Jaroslav Kysela <perex@perex.cz>
L
Linus Torvalds 已提交
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
 *                   Abramo Bagnara <abramo@alsa-project.org>
 *
 *
 *   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.
 *
 *   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
 *
 */

#include <linux/slab.h>
#include <linux/time.h>
25
#include <linux/math64.h>
L
Linus Torvalds 已提交
26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41
#include <sound/core.h>
#include <sound/control.h>
#include <sound/info.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/timer.h>

/*
 * fill ring buffer with silence
 * runtime->silence_start: starting pointer to silence area
 * runtime->silence_filled: size filled with silence
 * runtime->silence_threshold: threshold from application
 * runtime->silence_size: maximal size from application
 *
 * when runtime->silence_size >= runtime->boundary - fill processed area with silence immediately
 */
T
Takashi Iwai 已提交
42
void snd_pcm_playback_silence(struct snd_pcm_substream *substream, snd_pcm_uframes_t new_hw_ptr)
L
Linus Torvalds 已提交
43
{
T
Takashi Iwai 已提交
44
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
45 46 47 48 49 50 51 52 53 54 55 56 57 58
	snd_pcm_uframes_t frames, ofs, transfer;

	if (runtime->silence_size < runtime->boundary) {
		snd_pcm_sframes_t noise_dist, n;
		if (runtime->silence_start != runtime->control->appl_ptr) {
			n = runtime->control->appl_ptr - runtime->silence_start;
			if (n < 0)
				n += runtime->boundary;
			if ((snd_pcm_uframes_t)n < runtime->silence_filled)
				runtime->silence_filled -= n;
			else
				runtime->silence_filled = 0;
			runtime->silence_start = runtime->control->appl_ptr;
		}
T
Takashi Iwai 已提交
59
		if (runtime->silence_filled >= runtime->buffer_size)
L
Linus Torvalds 已提交
60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81
			return;
		noise_dist = snd_pcm_playback_hw_avail(runtime) + runtime->silence_filled;
		if (noise_dist >= (snd_pcm_sframes_t) runtime->silence_threshold)
			return;
		frames = runtime->silence_threshold - noise_dist;
		if (frames > runtime->silence_size)
			frames = runtime->silence_size;
	} else {
		if (new_hw_ptr == ULONG_MAX) {	/* initialization */
			snd_pcm_sframes_t avail = snd_pcm_playback_hw_avail(runtime);
			runtime->silence_filled = avail > 0 ? avail : 0;
			runtime->silence_start = (runtime->status->hw_ptr +
						  runtime->silence_filled) %
						 runtime->boundary;
		} else {
			ofs = runtime->status->hw_ptr;
			frames = new_hw_ptr - ofs;
			if ((snd_pcm_sframes_t)frames < 0)
				frames += runtime->boundary;
			runtime->silence_filled -= frames;
			if ((snd_pcm_sframes_t)runtime->silence_filled < 0) {
				runtime->silence_filled = 0;
82
				runtime->silence_start = new_hw_ptr;
L
Linus Torvalds 已提交
83
			} else {
84
				runtime->silence_start = ofs;
L
Linus Torvalds 已提交
85 86 87 88
			}
		}
		frames = runtime->buffer_size - runtime->silence_filled;
	}
89 90
	if (snd_BUG_ON(frames > runtime->buffer_size))
		return;
L
Linus Torvalds 已提交
91 92
	if (frames == 0)
		return;
93
	ofs = runtime->silence_start % runtime->buffer_size;
L
Linus Torvalds 已提交
94 95 96 97 98 99 100
	while (frames > 0) {
		transfer = ofs + frames > runtime->buffer_size ? runtime->buffer_size - ofs : frames;
		if (runtime->access == SNDRV_PCM_ACCESS_RW_INTERLEAVED ||
		    runtime->access == SNDRV_PCM_ACCESS_MMAP_INTERLEAVED) {
			if (substream->ops->silence) {
				int err;
				err = substream->ops->silence(substream, -1, ofs, transfer);
101
				snd_BUG_ON(err < 0);
L
Linus Torvalds 已提交
102 103 104 105 106 107 108 109 110 111 112
			} else {
				char *hwbuf = runtime->dma_area + frames_to_bytes(runtime, ofs);
				snd_pcm_format_set_silence(runtime->format, hwbuf, transfer * runtime->channels);
			}
		} else {
			unsigned int c;
			unsigned int channels = runtime->channels;
			if (substream->ops->silence) {
				for (c = 0; c < channels; ++c) {
					int err;
					err = substream->ops->silence(substream, c, ofs, transfer);
113
					snd_BUG_ON(err < 0);
L
Linus Torvalds 已提交
114 115 116 117 118 119 120 121 122 123 124 125 126 127 128
				}
			} else {
				size_t dma_csize = runtime->dma_bytes / channels;
				for (c = 0; c < channels; ++c) {
					char *hwbuf = runtime->dma_area + (c * dma_csize) + samples_to_bytes(runtime, ofs);
					snd_pcm_format_set_silence(runtime->format, hwbuf, transfer);
				}
			}
		}
		runtime->silence_filled += transfer;
		frames -= transfer;
		ofs = 0;
	}
}

129 130 131 132 133 134 135 136 137 138
static void pcm_debug_name(struct snd_pcm_substream *substream,
			   char *name, size_t len)
{
	snprintf(name, len, "pcmC%dD%d%c:%d",
		 substream->pcm->card->number,
		 substream->pcm->device,
		 substream->stream ? 'c' : 'p',
		 substream->number);
}

139 140 141 142 143
#define XRUN_DEBUG_BASIC	(1<<0)
#define XRUN_DEBUG_STACK	(1<<1)	/* dump also stack */
#define XRUN_DEBUG_JIFFIESCHECK	(1<<2)	/* do jiffies check */
#define XRUN_DEBUG_PERIODUPDATE	(1<<3)	/* full period update info */
#define XRUN_DEBUG_HWPTRUPDATE	(1<<4)	/* full hwptr update info */
144 145
#define XRUN_DEBUG_LOG		(1<<5)	/* show last 10 positions on err */
#define XRUN_DEBUG_LOGONCE	(1<<6)	/* do above only once */
146

T
Takashi Iwai 已提交
147
#ifdef CONFIG_SND_PCM_XRUN_DEBUG
148

149 150
#define xrun_debug(substream, mask) \
			((substream)->pstr->xrun_debug & (mask))
151 152 153
#else
#define xrun_debug(substream, mask)	0
#endif
T
Takashi Iwai 已提交
154

155 156 157
#define dump_stack_on_xrun(substream) do {			\
		if (xrun_debug(substream, XRUN_DEBUG_STACK))	\
			dump_stack();				\
T
Takashi Iwai 已提交
158 159
	} while (0)

T
Takashi Iwai 已提交
160
static void xrun(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
161
{
162 163 164 165
	struct snd_pcm_runtime *runtime = substream->runtime;

	if (runtime->tstamp_mode == SNDRV_PCM_TSTAMP_ENABLE)
		snd_pcm_gettime(runtime, (struct timespec *)&runtime->status->tstamp);
L
Linus Torvalds 已提交
166
	snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN);
167
	if (xrun_debug(substream, XRUN_DEBUG_BASIC)) {
168 169 170
		char name[16];
		pcm_debug_name(substream, name, sizeof(name));
		snd_printd(KERN_DEBUG "XRUN: %s\n", name);
T
Takashi Iwai 已提交
171
		dump_stack_on_xrun(substream);
L
Linus Torvalds 已提交
172 173 174
	}
}

175
#ifdef CONFIG_SND_PCM_XRUN_DEBUG
176 177 178
#define hw_ptr_error(substream, fmt, args...)				\
	do {								\
		if (xrun_debug(substream, XRUN_DEBUG_BASIC)) {		\
179
			xrun_log_show(substream);			\
180 181 182 183 184 185 186 187 188 189 190
			if (printk_ratelimit()) {			\
				snd_printd("PCM: " fmt, ##args);	\
			}						\
			dump_stack_on_xrun(substream);			\
		}							\
	} while (0)

#define XRUN_LOG_CNT	10

struct hwptr_log_entry {
	unsigned long jiffies;
L
Linus Torvalds 已提交
191
	snd_pcm_uframes_t pos;
192 193 194 195 196
	snd_pcm_uframes_t period_size;
	snd_pcm_uframes_t buffer_size;
	snd_pcm_uframes_t old_hw_ptr;
	snd_pcm_uframes_t hw_ptr_base;
};
L
Linus Torvalds 已提交
197

198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218
struct snd_pcm_hwptr_log {
	unsigned int idx;
	unsigned int hit: 1;
	struct hwptr_log_entry entries[XRUN_LOG_CNT];
};

static void xrun_log(struct snd_pcm_substream *substream,
		     snd_pcm_uframes_t pos)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct snd_pcm_hwptr_log *log = runtime->hwptr_log;
	struct hwptr_log_entry *entry;

	if (log == NULL) {
		log = kzalloc(sizeof(*log), GFP_ATOMIC);
		if (log == NULL)
			return;
		runtime->hwptr_log = log;
	} else {
		if (xrun_debug(substream, XRUN_DEBUG_LOGONCE) && log->hit)
			return;
219
	}
220 221 222 223 224 225 226 227
	entry = &log->entries[log->idx];
	entry->jiffies = jiffies;
	entry->pos = pos;
	entry->period_size = runtime->period_size;
	entry->buffer_size = runtime->buffer_size;;
	entry->old_hw_ptr = runtime->status->hw_ptr;
	entry->hw_ptr_base = runtime->hw_ptr_base;
	log->idx = (log->idx + 1) % XRUN_LOG_CNT;
L
Linus Torvalds 已提交
228 229
}

230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246
static void xrun_log_show(struct snd_pcm_substream *substream)
{
	struct snd_pcm_hwptr_log *log = substream->runtime->hwptr_log;
	struct hwptr_log_entry *entry;
	char name[16];
	unsigned int idx;
	int cnt;

	if (log == NULL)
		return;
	if (xrun_debug(substream, XRUN_DEBUG_LOGONCE) && log->hit)
		return;
	pcm_debug_name(substream, name, sizeof(name));
	for (cnt = 0, idx = log->idx; cnt < XRUN_LOG_CNT; cnt++) {
		entry = &log->entries[idx];
		if (entry->period_size == 0)
			break;
247 248
		snd_printd("hwptr log: %s: j=%lu, pos=%ld/%ld/%ld, "
			   "hwptr=%ld/%ld\n",
249 250 251 252
			   name, entry->jiffies, (unsigned long)entry->pos,
			   (unsigned long)entry->period_size,
			   (unsigned long)entry->buffer_size,
			   (unsigned long)entry->old_hw_ptr,
253
			   (unsigned long)entry->hw_ptr_base);
254 255 256 257 258 259 260 261 262 263 264 265 266 267
		idx++;
		idx %= XRUN_LOG_CNT;
	}
	log->hit = 1;
}

#else /* ! CONFIG_SND_PCM_XRUN_DEBUG */

#define hw_ptr_error(substream, fmt, args...) do { } while (0)
#define xrun_log(substream, pos)	do { } while (0)
#define xrun_log_show(substream)	do { } while (0)

#endif

268 269
int snd_pcm_update_state(struct snd_pcm_substream *substream,
			 struct snd_pcm_runtime *runtime)
L
Linus Torvalds 已提交
270 271 272 273 274 275 276 277 278
{
	snd_pcm_uframes_t avail;

	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
		avail = snd_pcm_playback_avail(runtime);
	else
		avail = snd_pcm_capture_avail(runtime);
	if (avail > runtime->avail_max)
		runtime->avail_max = avail;
279 280
	if (runtime->status->state == SNDRV_PCM_STATE_DRAINING) {
		if (avail >= runtime->buffer_size) {
L
Linus Torvalds 已提交
281
			snd_pcm_drain_done(substream);
282 283 284 285
			return -EPIPE;
		}
	} else {
		if (avail >= runtime->stop_threshold) {
L
Linus Torvalds 已提交
286
			xrun(substream);
287 288
			return -EPIPE;
		}
L
Linus Torvalds 已提交
289
	}
290 291
	if (avail >= runtime->control->avail_min)
		wake_up(runtime->twake ? &runtime->tsleep : &runtime->sleep);
L
Linus Torvalds 已提交
292 293 294
	return 0;
}

295 296
static int snd_pcm_update_hw_ptr0(struct snd_pcm_substream *substream,
				  unsigned int in_interrupt)
L
Linus Torvalds 已提交
297
{
T
Takashi Iwai 已提交
298
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
299
	snd_pcm_uframes_t pos;
300
	snd_pcm_uframes_t old_hw_ptr, new_hw_ptr, hw_base;
301 302
	snd_pcm_sframes_t hdelta, delta;
	unsigned long jdelta;
L
Linus Torvalds 已提交
303

304
	old_hw_ptr = runtime->status->hw_ptr;
305
	pos = substream->ops->pointer(substream);
L
Linus Torvalds 已提交
306 307 308 309
	if (pos == SNDRV_PCM_POS_XRUN) {
		xrun(substream);
		return -EPIPE;
	}
310 311 312 313 314 315 316 317 318 319 320
	if (pos >= runtime->buffer_size) {
		if (printk_ratelimit()) {
			char name[16];
			pcm_debug_name(substream, name, sizeof(name));
			xrun_log_show(substream);
			snd_printd(KERN_ERR  "BUG: %s, pos = %ld, "
				   "buffer size = %ld, period size = %ld\n",
				   name, pos, runtime->buffer_size,
				   runtime->period_size);
		}
		pos = 0;
321
	}
322 323 324
	pos -= pos % runtime->min_align;
	if (xrun_debug(substream, XRUN_DEBUG_LOG))
		xrun_log(substream, pos);
T
Takashi Iwai 已提交
325 326
	hw_base = runtime->hw_ptr_base;
	new_hw_ptr = hw_base + pos;
327 328 329
	if (in_interrupt) {
		/* we know that one period was processed */
		/* delta = "expected next hw_ptr" for in_interrupt != 0 */
330
		delta = runtime->hw_ptr_interrupt + runtime->period_size;
331
		if (delta > new_hw_ptr) {
T
Takashi Iwai 已提交
332
			hw_base += runtime->buffer_size;
T
Takashi Iwai 已提交
333
			if (hw_base >= runtime->boundary)
T
Takashi Iwai 已提交
334 335
				hw_base = 0;
			new_hw_ptr = hw_base + pos;
336
			goto __delta;
L
Linus Torvalds 已提交
337 338
		}
	}
339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365
	/* new_hw_ptr might be lower than old_hw_ptr in case when */
	/* pointer crosses the end of the ring buffer */
	if (new_hw_ptr < old_hw_ptr) {
		hw_base += runtime->buffer_size;
		if (hw_base >= runtime->boundary)
			hw_base = 0;
		new_hw_ptr = hw_base + pos;
	}
      __delta:
	delta = (new_hw_ptr - old_hw_ptr) % runtime->boundary;
	if (xrun_debug(substream, in_interrupt ?
			XRUN_DEBUG_PERIODUPDATE : XRUN_DEBUG_HWPTRUPDATE)) {
		char name[16];
		pcm_debug_name(substream, name, sizeof(name));
		snd_printd("%s_update: %s: pos=%u/%u/%u, "
			   "hwptr=%ld/%ld/%ld/%ld\n",
			   in_interrupt ? "period" : "hwptr",
			   name,
			   (unsigned int)pos,
			   (unsigned int)runtime->period_size,
			   (unsigned int)runtime->buffer_size,
			   (unsigned long)delta,
			   (unsigned long)old_hw_ptr,
			   (unsigned long)new_hw_ptr,
			   (unsigned long)runtime->hw_ptr_base);
	}
	/* something must be really wrong */
366
	if (delta >= runtime->buffer_size + runtime->period_size) {
367 368 369 370 371 372 373 374 375
		hw_ptr_error(substream,
			       "Unexpected hw_pointer value %s"
			       "(stream=%i, pos=%ld, new_hw_ptr=%ld, "
			       "old_hw_ptr=%ld)\n",
				     in_interrupt ? "[Q] " : "[P]",
				     substream->stream, (long)pos,
				     (long)new_hw_ptr, (long)old_hw_ptr);
		return 0;
	}
376 377

	/* Do jiffies check only in xrun_debug mode */
378
	if (!xrun_debug(substream, XRUN_DEBUG_JIFFIESCHECK))
379 380
		goto no_jiffies_check;

381 382 383 384 385 386
	/* Skip the jiffies check for hardwares with BATCH flag.
	 * Such hardware usually just increases the position at each IRQ,
	 * thus it can't give any strange position.
	 */
	if (runtime->hw.info & SNDRV_PCM_INFO_BATCH)
		goto no_jiffies_check;
387
	hdelta = delta;
388 389 390
	if (hdelta < runtime->delay)
		goto no_jiffies_check;
	hdelta -= runtime->delay;
391 392 393 394 395
	jdelta = jiffies - runtime->hw_ptr_jiffies;
	if (((hdelta * HZ) / runtime->rate) > jdelta + HZ/100) {
		delta = jdelta /
			(((runtime->period_size * HZ) / runtime->rate)
								+ HZ/100);
396 397
		/* move new_hw_ptr according jiffies not pos variable */
		new_hw_ptr = old_hw_ptr;
398
		hw_base = delta;
399 400 401 402 403 404 405 406 407
		/* use loop to avoid checks for delta overflows */
		/* the delta value is small or zero in most cases */
		while (delta > 0) {
			new_hw_ptr += runtime->period_size;
			if (new_hw_ptr >= runtime->boundary)
				new_hw_ptr -= runtime->boundary;
			delta--;
		}
		/* align hw_base to buffer_size */
408
		hw_ptr_error(substream,
409
			     "hw_ptr skipping! %s"
410
			     "(pos=%ld, delta=%ld, period=%ld, "
411 412
			     "jdelta=%lu/%lu/%lu, hw_ptr=%ld/%ld)\n",
			     in_interrupt ? "[Q] " : "",
413 414
			     (long)pos, (long)hdelta,
			     (long)runtime->period_size, jdelta,
415
			     ((hdelta * HZ) / runtime->rate), hw_base,
416 417
			     (unsigned long)old_hw_ptr,
			     (unsigned long)new_hw_ptr);
418 419 420
		/* reset values to proper state */
		delta = 0;
		hw_base = new_hw_ptr - (new_hw_ptr % runtime->buffer_size);
421
	}
422
 no_jiffies_check:
423
	if (delta > runtime->period_size + runtime->period_size / 2) {
T
Takashi Iwai 已提交
424
		hw_ptr_error(substream,
425 426 427 428
			     "Lost interrupts? %s"
			     "(stream=%i, delta=%ld, new_hw_ptr=%ld, "
			     "old_hw_ptr=%ld)\n",
			     in_interrupt ? "[Q] " : "",
T
Takashi Iwai 已提交
429
			     substream->stream, (long)delta,
430 431
			     (long)new_hw_ptr,
			     (long)old_hw_ptr);
T
Takashi Iwai 已提交
432
	}
433 434 435

	if (runtime->status->hw_ptr == new_hw_ptr)
		return 0;
436

L
Linus Torvalds 已提交
437 438 439 440
	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
	    runtime->silence_size > 0)
		snd_pcm_playback_silence(substream, new_hw_ptr);

441
	if (in_interrupt) {
442 443 444 445 446 447 448
		delta = new_hw_ptr - runtime->hw_ptr_interrupt;
		if (delta < 0)
			delta += runtime->boundary;
		delta -= (snd_pcm_uframes_t)delta % runtime->period_size;
		runtime->hw_ptr_interrupt += delta;
		if (runtime->hw_ptr_interrupt >= runtime->boundary)
			runtime->hw_ptr_interrupt -= runtime->boundary;
449
	}
T
Takashi Iwai 已提交
450
	runtime->hw_ptr_base = hw_base;
L
Linus Torvalds 已提交
451
	runtime->status->hw_ptr = new_hw_ptr;
452
	runtime->hw_ptr_jiffies = jiffies;
453 454
	if (runtime->tstamp_mode == SNDRV_PCM_TSTAMP_ENABLE)
		snd_pcm_gettime(runtime, (struct timespec *)&runtime->status->tstamp);
L
Linus Torvalds 已提交
455

456
	return snd_pcm_update_state(substream, runtime);
L
Linus Torvalds 已提交
457 458 459
}

/* CAUTION: call it with irq disabled */
T
Takashi Iwai 已提交
460
int snd_pcm_update_hw_ptr(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
461
{
462
	return snd_pcm_update_hw_ptr0(substream, 0);
L
Linus Torvalds 已提交
463 464 465 466 467 468 469 470 471 472
}

/**
 * snd_pcm_set_ops - set the PCM operators
 * @pcm: the pcm instance
 * @direction: stream direction, SNDRV_PCM_STREAM_XXX
 * @ops: the operator table
 *
 * Sets the given PCM operators to the pcm instance.
 */
T
Takashi Iwai 已提交
473
void snd_pcm_set_ops(struct snd_pcm *pcm, int direction, struct snd_pcm_ops *ops)
L
Linus Torvalds 已提交
474
{
T
Takashi Iwai 已提交
475 476
	struct snd_pcm_str *stream = &pcm->streams[direction];
	struct snd_pcm_substream *substream;
L
Linus Torvalds 已提交
477 478 479 480 481
	
	for (substream = stream->substream; substream != NULL; substream = substream->next)
		substream->ops = ops;
}

482
EXPORT_SYMBOL(snd_pcm_set_ops);
L
Linus Torvalds 已提交
483 484 485 486 487 488 489

/**
 * snd_pcm_sync - set the PCM sync id
 * @substream: the pcm substream
 *
 * Sets the PCM sync identifier for the card.
 */
T
Takashi Iwai 已提交
490
void snd_pcm_set_sync(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
491
{
T
Takashi Iwai 已提交
492
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
493 494 495 496 497 498 499
	
	runtime->sync.id32[0] = substream->pcm->card->number;
	runtime->sync.id32[1] = -1;
	runtime->sync.id32[2] = -1;
	runtime->sync.id32[3] = -1;
}

500 501
EXPORT_SYMBOL(snd_pcm_set_sync);

L
Linus Torvalds 已提交
502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 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
/*
 *  Standard ioctl routine
 */

static inline unsigned int div32(unsigned int a, unsigned int b, 
				 unsigned int *r)
{
	if (b == 0) {
		*r = 0;
		return UINT_MAX;
	}
	*r = a % b;
	return a / b;
}

static inline unsigned int div_down(unsigned int a, unsigned int b)
{
	if (b == 0)
		return UINT_MAX;
	return a / b;
}

static inline unsigned int div_up(unsigned int a, unsigned int b)
{
	unsigned int r;
	unsigned int q;
	if (b == 0)
		return UINT_MAX;
	q = div32(a, b, &r);
	if (r)
		++q;
	return q;
}

static inline unsigned int mul(unsigned int a, unsigned int b)
{
	if (a == 0)
		return 0;
	if (div_down(UINT_MAX, a) < b)
		return UINT_MAX;
	return a * b;
}

static inline unsigned int muldiv32(unsigned int a, unsigned int b,
				    unsigned int c, unsigned int *r)
{
	u_int64_t n = (u_int64_t) a * b;
	if (c == 0) {
550
		snd_BUG_ON(!n);
L
Linus Torvalds 已提交
551 552 553
		*r = 0;
		return UINT_MAX;
	}
554
	n = div_u64_rem(n, c, r);
L
Linus Torvalds 已提交
555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
	if (n >= UINT_MAX) {
		*r = 0;
		return UINT_MAX;
	}
	return n;
}

/**
 * snd_interval_refine - refine the interval value of configurator
 * @i: the interval value to refine
 * @v: the interval value to refer to
 *
 * Refines the interval value with the reference value.
 * The interval is changed to the range satisfying both intervals.
 * The interval status (min, max, integer, etc.) are evaluated.
 *
 * Returns non-zero if the value is changed, zero if not changed.
 */
T
Takashi Iwai 已提交
573
int snd_interval_refine(struct snd_interval *i, const struct snd_interval *v)
L
Linus Torvalds 已提交
574 575
{
	int changed = 0;
576 577
	if (snd_BUG_ON(snd_interval_empty(i)))
		return -EINVAL;
L
Linus Torvalds 已提交
578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615
	if (i->min < v->min) {
		i->min = v->min;
		i->openmin = v->openmin;
		changed = 1;
	} else if (i->min == v->min && !i->openmin && v->openmin) {
		i->openmin = 1;
		changed = 1;
	}
	if (i->max > v->max) {
		i->max = v->max;
		i->openmax = v->openmax;
		changed = 1;
	} else if (i->max == v->max && !i->openmax && v->openmax) {
		i->openmax = 1;
		changed = 1;
	}
	if (!i->integer && v->integer) {
		i->integer = 1;
		changed = 1;
	}
	if (i->integer) {
		if (i->openmin) {
			i->min++;
			i->openmin = 0;
		}
		if (i->openmax) {
			i->max--;
			i->openmax = 0;
		}
	} else if (!i->openmin && !i->openmax && i->min == i->max)
		i->integer = 1;
	if (snd_interval_checkempty(i)) {
		snd_interval_none(i);
		return -EINVAL;
	}
	return changed;
}

616 617
EXPORT_SYMBOL(snd_interval_refine);

T
Takashi Iwai 已提交
618
static int snd_interval_refine_first(struct snd_interval *i)
L
Linus Torvalds 已提交
619
{
620 621
	if (snd_BUG_ON(snd_interval_empty(i)))
		return -EINVAL;
L
Linus Torvalds 已提交
622 623 624 625 626 627 628 629 630
	if (snd_interval_single(i))
		return 0;
	i->max = i->min;
	i->openmax = i->openmin;
	if (i->openmax)
		i->max++;
	return 1;
}

T
Takashi Iwai 已提交
631
static int snd_interval_refine_last(struct snd_interval *i)
L
Linus Torvalds 已提交
632
{
633 634
	if (snd_BUG_ON(snd_interval_empty(i)))
		return -EINVAL;
L
Linus Torvalds 已提交
635 636 637 638 639 640 641 642 643
	if (snd_interval_single(i))
		return 0;
	i->min = i->max;
	i->openmin = i->openmax;
	if (i->openmin)
		i->min--;
	return 1;
}

T
Takashi Iwai 已提交
644
void snd_interval_mul(const struct snd_interval *a, const struct snd_interval *b, struct snd_interval *c)
L
Linus Torvalds 已提交
645 646 647 648 649 650 651 652 653 654 655 656 657 658 659
{
	if (a->empty || b->empty) {
		snd_interval_none(c);
		return;
	}
	c->empty = 0;
	c->min = mul(a->min, b->min);
	c->openmin = (a->openmin || b->openmin);
	c->max = mul(a->max,  b->max);
	c->openmax = (a->openmax || b->openmax);
	c->integer = (a->integer && b->integer);
}

/**
 * snd_interval_div - refine the interval value with division
T
Takashi Iwai 已提交
660 661 662
 * @a: dividend
 * @b: divisor
 * @c: quotient
L
Linus Torvalds 已提交
663 664 665 666 667
 *
 * c = a / b
 *
 * Returns non-zero if the value is changed, zero if not changed.
 */
T
Takashi Iwai 已提交
668
void snd_interval_div(const struct snd_interval *a, const struct snd_interval *b, struct snd_interval *c)
L
Linus Torvalds 已提交
669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693
{
	unsigned int r;
	if (a->empty || b->empty) {
		snd_interval_none(c);
		return;
	}
	c->empty = 0;
	c->min = div32(a->min, b->max, &r);
	c->openmin = (r || a->openmin || b->openmax);
	if (b->min > 0) {
		c->max = div32(a->max, b->min, &r);
		if (r) {
			c->max++;
			c->openmax = 1;
		} else
			c->openmax = (a->openmax || b->openmin);
	} else {
		c->max = UINT_MAX;
		c->openmax = 0;
	}
	c->integer = 0;
}

/**
 * snd_interval_muldivk - refine the interval value
T
Takashi Iwai 已提交
694 695 696 697 698
 * @a: dividend 1
 * @b: dividend 2
 * @k: divisor (as integer)
 * @c: result
  *
L
Linus Torvalds 已提交
699 700 701 702
 * c = a * b / k
 *
 * Returns non-zero if the value is changed, zero if not changed.
 */
T
Takashi Iwai 已提交
703 704
void snd_interval_muldivk(const struct snd_interval *a, const struct snd_interval *b,
		      unsigned int k, struct snd_interval *c)
L
Linus Torvalds 已提交
705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724
{
	unsigned int r;
	if (a->empty || b->empty) {
		snd_interval_none(c);
		return;
	}
	c->empty = 0;
	c->min = muldiv32(a->min, b->min, k, &r);
	c->openmin = (r || a->openmin || b->openmin);
	c->max = muldiv32(a->max, b->max, k, &r);
	if (r) {
		c->max++;
		c->openmax = 1;
	} else
		c->openmax = (a->openmax || b->openmax);
	c->integer = 0;
}

/**
 * snd_interval_mulkdiv - refine the interval value
T
Takashi Iwai 已提交
725 726 727 728
 * @a: dividend 1
 * @k: dividend 2 (as integer)
 * @b: divisor
 * @c: result
L
Linus Torvalds 已提交
729 730 731 732 733
 *
 * c = a * k / b
 *
 * Returns non-zero if the value is changed, zero if not changed.
 */
T
Takashi Iwai 已提交
734 735
void snd_interval_mulkdiv(const struct snd_interval *a, unsigned int k,
		      const struct snd_interval *b, struct snd_interval *c)
L
Linus Torvalds 已提交
736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763
{
	unsigned int r;
	if (a->empty || b->empty) {
		snd_interval_none(c);
		return;
	}
	c->empty = 0;
	c->min = muldiv32(a->min, k, b->max, &r);
	c->openmin = (r || a->openmin || b->openmax);
	if (b->min > 0) {
		c->max = muldiv32(a->max, k, b->min, &r);
		if (r) {
			c->max++;
			c->openmax = 1;
		} else
			c->openmax = (a->openmax || b->openmin);
	} else {
		c->max = UINT_MAX;
		c->openmax = 0;
	}
	c->integer = 0;
}

/* ---- */


/**
 * snd_interval_ratnum - refine the interval value
T
Takashi Iwai 已提交
764 765 766 767 768
 * @i: interval to refine
 * @rats_count: number of ratnum_t 
 * @rats: ratnum_t array
 * @nump: pointer to store the resultant numerator
 * @denp: pointer to store the resultant denominator
L
Linus Torvalds 已提交
769 770 771
 *
 * Returns non-zero if the value is changed, zero if not changed.
 */
T
Takashi Iwai 已提交
772 773 774
int snd_interval_ratnum(struct snd_interval *i,
			unsigned int rats_count, struct snd_ratnum *rats,
			unsigned int *nump, unsigned int *denp)
L
Linus Torvalds 已提交
775
{
776 777
	unsigned int best_num, best_den;
	int best_diff;
L
Linus Torvalds 已提交
778
	unsigned int k;
T
Takashi Iwai 已提交
779
	struct snd_interval t;
L
Linus Torvalds 已提交
780
	int err;
781 782
	unsigned int result_num, result_den;
	int result_diff;
L
Linus Torvalds 已提交
783 784 785 786 787 788 789 790 791

	best_num = best_den = best_diff = 0;
	for (k = 0; k < rats_count; ++k) {
		unsigned int num = rats[k].num;
		unsigned int den;
		unsigned int q = i->min;
		int diff;
		if (q == 0)
			q = 1;
792
		den = div_up(num, q);
L
Linus Torvalds 已提交
793 794 795 796 797 798 799 800 801 802 803
		if (den < rats[k].den_min)
			continue;
		if (den > rats[k].den_max)
			den = rats[k].den_max;
		else {
			unsigned int r;
			r = (den - rats[k].den_min) % rats[k].den_step;
			if (r != 0)
				den -= r;
		}
		diff = num - q * den;
804 805
		if (diff < 0)
			diff = -diff;
L
Linus Torvalds 已提交
806 807 808 809 810 811 812 813 814 815 816 817 818 819
		if (best_num == 0 ||
		    diff * best_den < best_diff * den) {
			best_diff = diff;
			best_den = den;
			best_num = num;
		}
	}
	if (best_den == 0) {
		i->empty = 1;
		return -EINVAL;
	}
	t.min = div_down(best_num, best_den);
	t.openmin = !!(best_num % best_den);
	
820 821 822
	result_num = best_num;
	result_diff = best_diff;
	result_den = best_den;
L
Linus Torvalds 已提交
823 824 825 826 827 828 829 830 831 832
	best_num = best_den = best_diff = 0;
	for (k = 0; k < rats_count; ++k) {
		unsigned int num = rats[k].num;
		unsigned int den;
		unsigned int q = i->max;
		int diff;
		if (q == 0) {
			i->empty = 1;
			return -EINVAL;
		}
833
		den = div_down(num, q);
L
Linus Torvalds 已提交
834 835 836 837 838 839 840 841 842 843 844
		if (den > rats[k].den_max)
			continue;
		if (den < rats[k].den_min)
			den = rats[k].den_min;
		else {
			unsigned int r;
			r = (den - rats[k].den_min) % rats[k].den_step;
			if (r != 0)
				den += rats[k].den_step - r;
		}
		diff = q * den - num;
845 846
		if (diff < 0)
			diff = -diff;
L
Linus Torvalds 已提交
847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865
		if (best_num == 0 ||
		    diff * best_den < best_diff * den) {
			best_diff = diff;
			best_den = den;
			best_num = num;
		}
	}
	if (best_den == 0) {
		i->empty = 1;
		return -EINVAL;
	}
	t.max = div_up(best_num, best_den);
	t.openmax = !!(best_num % best_den);
	t.integer = 0;
	err = snd_interval_refine(i, &t);
	if (err < 0)
		return err;

	if (snd_interval_single(i)) {
866 867 868 869
		if (best_diff * result_den < result_diff * best_den) {
			result_num = best_num;
			result_den = best_den;
		}
L
Linus Torvalds 已提交
870
		if (nump)
871
			*nump = result_num;
L
Linus Torvalds 已提交
872
		if (denp)
873
			*denp = result_den;
L
Linus Torvalds 已提交
874 875 876 877
	}
	return err;
}

878 879
EXPORT_SYMBOL(snd_interval_ratnum);

L
Linus Torvalds 已提交
880 881
/**
 * snd_interval_ratden - refine the interval value
T
Takashi Iwai 已提交
882
 * @i: interval to refine
T
Takashi Iwai 已提交
883 884
 * @rats_count: number of struct ratden
 * @rats: struct ratden array
T
Takashi Iwai 已提交
885 886
 * @nump: pointer to store the resultant numerator
 * @denp: pointer to store the resultant denominator
L
Linus Torvalds 已提交
887 888 889
 *
 * Returns non-zero if the value is changed, zero if not changed.
 */
T
Takashi Iwai 已提交
890 891
static int snd_interval_ratden(struct snd_interval *i,
			       unsigned int rats_count, struct snd_ratden *rats,
L
Linus Torvalds 已提交
892 893 894 895
			       unsigned int *nump, unsigned int *denp)
{
	unsigned int best_num, best_diff, best_den;
	unsigned int k;
T
Takashi Iwai 已提交
896
	struct snd_interval t;
L
Linus Torvalds 已提交
897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 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 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988
	int err;

	best_num = best_den = best_diff = 0;
	for (k = 0; k < rats_count; ++k) {
		unsigned int num;
		unsigned int den = rats[k].den;
		unsigned int q = i->min;
		int diff;
		num = mul(q, den);
		if (num > rats[k].num_max)
			continue;
		if (num < rats[k].num_min)
			num = rats[k].num_max;
		else {
			unsigned int r;
			r = (num - rats[k].num_min) % rats[k].num_step;
			if (r != 0)
				num += rats[k].num_step - r;
		}
		diff = num - q * den;
		if (best_num == 0 ||
		    diff * best_den < best_diff * den) {
			best_diff = diff;
			best_den = den;
			best_num = num;
		}
	}
	if (best_den == 0) {
		i->empty = 1;
		return -EINVAL;
	}
	t.min = div_down(best_num, best_den);
	t.openmin = !!(best_num % best_den);
	
	best_num = best_den = best_diff = 0;
	for (k = 0; k < rats_count; ++k) {
		unsigned int num;
		unsigned int den = rats[k].den;
		unsigned int q = i->max;
		int diff;
		num = mul(q, den);
		if (num < rats[k].num_min)
			continue;
		if (num > rats[k].num_max)
			num = rats[k].num_max;
		else {
			unsigned int r;
			r = (num - rats[k].num_min) % rats[k].num_step;
			if (r != 0)
				num -= r;
		}
		diff = q * den - num;
		if (best_num == 0 ||
		    diff * best_den < best_diff * den) {
			best_diff = diff;
			best_den = den;
			best_num = num;
		}
	}
	if (best_den == 0) {
		i->empty = 1;
		return -EINVAL;
	}
	t.max = div_up(best_num, best_den);
	t.openmax = !!(best_num % best_den);
	t.integer = 0;
	err = snd_interval_refine(i, &t);
	if (err < 0)
		return err;

	if (snd_interval_single(i)) {
		if (nump)
			*nump = best_num;
		if (denp)
			*denp = best_den;
	}
	return err;
}

/**
 * snd_interval_list - refine the interval value from the list
 * @i: the interval value to refine
 * @count: the number of elements in the list
 * @list: the value list
 * @mask: the bit-mask to evaluate
 *
 * Refines the interval value from the list.
 * When mask is non-zero, only the elements corresponding to bit 1 are
 * evaluated.
 *
 * Returns non-zero if the value is changed, zero if not changed.
 */
T
Takashi Iwai 已提交
989
int snd_interval_list(struct snd_interval *i, unsigned int count, unsigned int *list, unsigned int mask)
L
Linus Torvalds 已提交
990 991
{
        unsigned int k;
992
	struct snd_interval list_range;
993 994 995 996 997

	if (!count) {
		i->empty = 1;
		return -EINVAL;
	}
998 999 1000
	snd_interval_any(&list_range);
	list_range.min = UINT_MAX;
	list_range.max = 0;
L
Linus Torvalds 已提交
1001 1002 1003
        for (k = 0; k < count; k++) {
		if (mask && !(mask & (1 << k)))
			continue;
1004
		if (!snd_interval_test(i, list[k]))
L
Linus Torvalds 已提交
1005
			continue;
1006 1007
		list_range.min = min(list_range.min, list[k]);
		list_range.max = max(list_range.max, list[k]);
L
Linus Torvalds 已提交
1008
        }
1009
	return snd_interval_refine(i, &list_range);
L
Linus Torvalds 已提交
1010 1011
}

1012 1013
EXPORT_SYMBOL(snd_interval_list);

T
Takashi Iwai 已提交
1014
static int snd_interval_step(struct snd_interval *i, unsigned int min, unsigned int step)
L
Linus Torvalds 已提交
1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047
{
	unsigned int n;
	int changed = 0;
	n = (i->min - min) % step;
	if (n != 0 || i->openmin) {
		i->min += step - n;
		changed = 1;
	}
	n = (i->max - min) % step;
	if (n != 0 || i->openmax) {
		i->max -= n;
		changed = 1;
	}
	if (snd_interval_checkempty(i)) {
		i->empty = 1;
		return -EINVAL;
	}
	return changed;
}

/* Info constraints helpers */

/**
 * snd_pcm_hw_rule_add - add the hw-constraint rule
 * @runtime: the pcm runtime instance
 * @cond: condition bits
 * @var: the variable to evaluate
 * @func: the evaluation function
 * @private: the private data pointer passed to function
 * @dep: the dependent variables
 *
 * Returns zero if successful, or a negative error code on failure.
 */
T
Takashi Iwai 已提交
1048
int snd_pcm_hw_rule_add(struct snd_pcm_runtime *runtime, unsigned int cond,
L
Linus Torvalds 已提交
1049 1050 1051 1052
			int var,
			snd_pcm_hw_rule_func_t func, void *private,
			int dep, ...)
{
T
Takashi Iwai 已提交
1053 1054
	struct snd_pcm_hw_constraints *constrs = &runtime->hw_constraints;
	struct snd_pcm_hw_rule *c;
L
Linus Torvalds 已提交
1055 1056 1057 1058
	unsigned int k;
	va_list args;
	va_start(args, dep);
	if (constrs->rules_num >= constrs->rules_all) {
T
Takashi Iwai 已提交
1059
		struct snd_pcm_hw_rule *new;
L
Linus Torvalds 已提交
1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078
		unsigned int new_rules = constrs->rules_all + 16;
		new = kcalloc(new_rules, sizeof(*c), GFP_KERNEL);
		if (!new)
			return -ENOMEM;
		if (constrs->rules) {
			memcpy(new, constrs->rules,
			       constrs->rules_num * sizeof(*c));
			kfree(constrs->rules);
		}
		constrs->rules = new;
		constrs->rules_all = new_rules;
	}
	c = &constrs->rules[constrs->rules_num];
	c->cond = cond;
	c->func = func;
	c->var = var;
	c->private = private;
	k = 0;
	while (1) {
1079 1080
		if (snd_BUG_ON(k >= ARRAY_SIZE(c->deps)))
			return -EINVAL;
L
Linus Torvalds 已提交
1081 1082 1083 1084 1085 1086 1087 1088 1089 1090
		c->deps[k++] = dep;
		if (dep < 0)
			break;
		dep = va_arg(args, int);
	}
	constrs->rules_num++;
	va_end(args);
	return 0;
}				    

1091 1092
EXPORT_SYMBOL(snd_pcm_hw_rule_add);

L
Linus Torvalds 已提交
1093
/**
1094
 * snd_pcm_hw_constraint_mask - apply the given bitmap mask constraint
T
Takashi Iwai 已提交
1095 1096 1097 1098
 * @runtime: PCM runtime instance
 * @var: hw_params variable to apply the mask
 * @mask: the bitmap mask
 *
1099
 * Apply the constraint of the given bitmap mask to a 32-bit mask parameter.
L
Linus Torvalds 已提交
1100
 */
T
Takashi Iwai 已提交
1101
int snd_pcm_hw_constraint_mask(struct snd_pcm_runtime *runtime, snd_pcm_hw_param_t var,
L
Linus Torvalds 已提交
1102 1103
			       u_int32_t mask)
{
T
Takashi Iwai 已提交
1104 1105
	struct snd_pcm_hw_constraints *constrs = &runtime->hw_constraints;
	struct snd_mask *maskp = constrs_mask(constrs, var);
L
Linus Torvalds 已提交
1106 1107 1108 1109 1110 1111 1112 1113
	*maskp->bits &= mask;
	memset(maskp->bits + 1, 0, (SNDRV_MASK_MAX-32) / 8); /* clear rest */
	if (*maskp->bits == 0)
		return -EINVAL;
	return 0;
}

/**
1114
 * snd_pcm_hw_constraint_mask64 - apply the given bitmap mask constraint
T
Takashi Iwai 已提交
1115 1116 1117 1118
 * @runtime: PCM runtime instance
 * @var: hw_params variable to apply the mask
 * @mask: the 64bit bitmap mask
 *
1119
 * Apply the constraint of the given bitmap mask to a 64-bit mask parameter.
L
Linus Torvalds 已提交
1120
 */
T
Takashi Iwai 已提交
1121
int snd_pcm_hw_constraint_mask64(struct snd_pcm_runtime *runtime, snd_pcm_hw_param_t var,
L
Linus Torvalds 已提交
1122 1123
				 u_int64_t mask)
{
T
Takashi Iwai 已提交
1124 1125
	struct snd_pcm_hw_constraints *constrs = &runtime->hw_constraints;
	struct snd_mask *maskp = constrs_mask(constrs, var);
L
Linus Torvalds 已提交
1126 1127 1128 1129 1130 1131 1132 1133 1134
	maskp->bits[0] &= (u_int32_t)mask;
	maskp->bits[1] &= (u_int32_t)(mask >> 32);
	memset(maskp->bits + 2, 0, (SNDRV_MASK_MAX-64) / 8); /* clear rest */
	if (! maskp->bits[0] && ! maskp->bits[1])
		return -EINVAL;
	return 0;
}

/**
1135
 * snd_pcm_hw_constraint_integer - apply an integer constraint to an interval
T
Takashi Iwai 已提交
1136 1137 1138 1139
 * @runtime: PCM runtime instance
 * @var: hw_params variable to apply the integer constraint
 *
 * Apply the constraint of integer to an interval parameter.
L
Linus Torvalds 已提交
1140
 */
T
Takashi Iwai 已提交
1141
int snd_pcm_hw_constraint_integer(struct snd_pcm_runtime *runtime, snd_pcm_hw_param_t var)
L
Linus Torvalds 已提交
1142
{
T
Takashi Iwai 已提交
1143
	struct snd_pcm_hw_constraints *constrs = &runtime->hw_constraints;
L
Linus Torvalds 已提交
1144 1145 1146
	return snd_interval_setinteger(constrs_interval(constrs, var));
}

1147 1148
EXPORT_SYMBOL(snd_pcm_hw_constraint_integer);

L
Linus Torvalds 已提交
1149
/**
1150
 * snd_pcm_hw_constraint_minmax - apply a min/max range constraint to an interval
T
Takashi Iwai 已提交
1151 1152 1153 1154 1155 1156
 * @runtime: PCM runtime instance
 * @var: hw_params variable to apply the range
 * @min: the minimal value
 * @max: the maximal value
 * 
 * Apply the min/max range constraint to an interval parameter.
L
Linus Torvalds 已提交
1157
 */
T
Takashi Iwai 已提交
1158
int snd_pcm_hw_constraint_minmax(struct snd_pcm_runtime *runtime, snd_pcm_hw_param_t var,
L
Linus Torvalds 已提交
1159 1160
				 unsigned int min, unsigned int max)
{
T
Takashi Iwai 已提交
1161 1162
	struct snd_pcm_hw_constraints *constrs = &runtime->hw_constraints;
	struct snd_interval t;
L
Linus Torvalds 已提交
1163 1164 1165 1166 1167 1168 1169
	t.min = min;
	t.max = max;
	t.openmin = t.openmax = 0;
	t.integer = 0;
	return snd_interval_refine(constrs_interval(constrs, var), &t);
}

1170 1171
EXPORT_SYMBOL(snd_pcm_hw_constraint_minmax);

T
Takashi Iwai 已提交
1172 1173
static int snd_pcm_hw_rule_list(struct snd_pcm_hw_params *params,
				struct snd_pcm_hw_rule *rule)
L
Linus Torvalds 已提交
1174
{
T
Takashi Iwai 已提交
1175
	struct snd_pcm_hw_constraint_list *list = rule->private;
L
Linus Torvalds 已提交
1176 1177 1178 1179 1180
	return snd_interval_list(hw_param_interval(params, rule->var), list->count, list->list, list->mask);
}		


/**
1181
 * snd_pcm_hw_constraint_list - apply a list of constraints to a parameter
T
Takashi Iwai 已提交
1182 1183 1184 1185 1186 1187
 * @runtime: PCM runtime instance
 * @cond: condition bits
 * @var: hw_params variable to apply the list constraint
 * @l: list
 * 
 * Apply the list of constraints to an interval parameter.
L
Linus Torvalds 已提交
1188
 */
T
Takashi Iwai 已提交
1189
int snd_pcm_hw_constraint_list(struct snd_pcm_runtime *runtime,
L
Linus Torvalds 已提交
1190 1191
			       unsigned int cond,
			       snd_pcm_hw_param_t var,
T
Takashi Iwai 已提交
1192
			       struct snd_pcm_hw_constraint_list *l)
L
Linus Torvalds 已提交
1193 1194 1195 1196 1197 1198
{
	return snd_pcm_hw_rule_add(runtime, cond, var,
				   snd_pcm_hw_rule_list, l,
				   var, -1);
}

1199 1200
EXPORT_SYMBOL(snd_pcm_hw_constraint_list);

T
Takashi Iwai 已提交
1201 1202
static int snd_pcm_hw_rule_ratnums(struct snd_pcm_hw_params *params,
				   struct snd_pcm_hw_rule *rule)
L
Linus Torvalds 已提交
1203
{
T
Takashi Iwai 已提交
1204
	struct snd_pcm_hw_constraint_ratnums *r = rule->private;
L
Linus Torvalds 已提交
1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216
	unsigned int num = 0, den = 0;
	int err;
	err = snd_interval_ratnum(hw_param_interval(params, rule->var),
				  r->nrats, r->rats, &num, &den);
	if (err >= 0 && den && rule->var == SNDRV_PCM_HW_PARAM_RATE) {
		params->rate_num = num;
		params->rate_den = den;
	}
	return err;
}

/**
1217
 * snd_pcm_hw_constraint_ratnums - apply ratnums constraint to a parameter
T
Takashi Iwai 已提交
1218 1219 1220
 * @runtime: PCM runtime instance
 * @cond: condition bits
 * @var: hw_params variable to apply the ratnums constraint
T
Takashi Iwai 已提交
1221
 * @r: struct snd_ratnums constriants
L
Linus Torvalds 已提交
1222
 */
T
Takashi Iwai 已提交
1223
int snd_pcm_hw_constraint_ratnums(struct snd_pcm_runtime *runtime, 
L
Linus Torvalds 已提交
1224 1225
				  unsigned int cond,
				  snd_pcm_hw_param_t var,
T
Takashi Iwai 已提交
1226
				  struct snd_pcm_hw_constraint_ratnums *r)
L
Linus Torvalds 已提交
1227 1228 1229 1230 1231 1232
{
	return snd_pcm_hw_rule_add(runtime, cond, var,
				   snd_pcm_hw_rule_ratnums, r,
				   var, -1);
}

1233 1234
EXPORT_SYMBOL(snd_pcm_hw_constraint_ratnums);

T
Takashi Iwai 已提交
1235 1236
static int snd_pcm_hw_rule_ratdens(struct snd_pcm_hw_params *params,
				   struct snd_pcm_hw_rule *rule)
L
Linus Torvalds 已提交
1237
{
T
Takashi Iwai 已提交
1238
	struct snd_pcm_hw_constraint_ratdens *r = rule->private;
L
Linus Torvalds 已提交
1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249
	unsigned int num = 0, den = 0;
	int err = snd_interval_ratden(hw_param_interval(params, rule->var),
				  r->nrats, r->rats, &num, &den);
	if (err >= 0 && den && rule->var == SNDRV_PCM_HW_PARAM_RATE) {
		params->rate_num = num;
		params->rate_den = den;
	}
	return err;
}

/**
1250
 * snd_pcm_hw_constraint_ratdens - apply ratdens constraint to a parameter
T
Takashi Iwai 已提交
1251 1252 1253
 * @runtime: PCM runtime instance
 * @cond: condition bits
 * @var: hw_params variable to apply the ratdens constraint
T
Takashi Iwai 已提交
1254
 * @r: struct snd_ratdens constriants
L
Linus Torvalds 已提交
1255
 */
T
Takashi Iwai 已提交
1256
int snd_pcm_hw_constraint_ratdens(struct snd_pcm_runtime *runtime, 
L
Linus Torvalds 已提交
1257 1258
				  unsigned int cond,
				  snd_pcm_hw_param_t var,
T
Takashi Iwai 已提交
1259
				  struct snd_pcm_hw_constraint_ratdens *r)
L
Linus Torvalds 已提交
1260 1261 1262 1263 1264 1265
{
	return snd_pcm_hw_rule_add(runtime, cond, var,
				   snd_pcm_hw_rule_ratdens, r,
				   var, -1);
}

1266 1267
EXPORT_SYMBOL(snd_pcm_hw_constraint_ratdens);

T
Takashi Iwai 已提交
1268 1269
static int snd_pcm_hw_rule_msbits(struct snd_pcm_hw_params *params,
				  struct snd_pcm_hw_rule *rule)
L
Linus Torvalds 已提交
1270 1271 1272 1273
{
	unsigned int l = (unsigned long) rule->private;
	int width = l & 0xffff;
	unsigned int msbits = l >> 16;
T
Takashi Iwai 已提交
1274
	struct snd_interval *i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_SAMPLE_BITS);
L
Linus Torvalds 已提交
1275 1276 1277 1278 1279 1280
	if (snd_interval_single(i) && snd_interval_value(i) == width)
		params->msbits = msbits;
	return 0;
}

/**
1281
 * snd_pcm_hw_constraint_msbits - add a hw constraint msbits rule
T
Takashi Iwai 已提交
1282 1283 1284 1285
 * @runtime: PCM runtime instance
 * @cond: condition bits
 * @width: sample bits width
 * @msbits: msbits width
L
Linus Torvalds 已提交
1286
 */
T
Takashi Iwai 已提交
1287
int snd_pcm_hw_constraint_msbits(struct snd_pcm_runtime *runtime, 
L
Linus Torvalds 已提交
1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298
				 unsigned int cond,
				 unsigned int width,
				 unsigned int msbits)
{
	unsigned long l = (msbits << 16) | width;
	return snd_pcm_hw_rule_add(runtime, cond, -1,
				    snd_pcm_hw_rule_msbits,
				    (void*) l,
				    SNDRV_PCM_HW_PARAM_SAMPLE_BITS, -1);
}

1299 1300
EXPORT_SYMBOL(snd_pcm_hw_constraint_msbits);

T
Takashi Iwai 已提交
1301 1302
static int snd_pcm_hw_rule_step(struct snd_pcm_hw_params *params,
				struct snd_pcm_hw_rule *rule)
L
Linus Torvalds 已提交
1303 1304 1305 1306 1307 1308
{
	unsigned long step = (unsigned long) rule->private;
	return snd_interval_step(hw_param_interval(params, rule->var), 0, step);
}

/**
1309
 * snd_pcm_hw_constraint_step - add a hw constraint step rule
T
Takashi Iwai 已提交
1310 1311 1312 1313
 * @runtime: PCM runtime instance
 * @cond: condition bits
 * @var: hw_params variable to apply the step constraint
 * @step: step size
L
Linus Torvalds 已提交
1314
 */
T
Takashi Iwai 已提交
1315
int snd_pcm_hw_constraint_step(struct snd_pcm_runtime *runtime,
L
Linus Torvalds 已提交
1316 1317 1318 1319 1320 1321 1322 1323 1324
			       unsigned int cond,
			       snd_pcm_hw_param_t var,
			       unsigned long step)
{
	return snd_pcm_hw_rule_add(runtime, cond, var, 
				   snd_pcm_hw_rule_step, (void *) step,
				   var, -1);
}

1325 1326
EXPORT_SYMBOL(snd_pcm_hw_constraint_step);

T
Takashi Iwai 已提交
1327
static int snd_pcm_hw_rule_pow2(struct snd_pcm_hw_params *params, struct snd_pcm_hw_rule *rule)
L
Linus Torvalds 已提交
1328
{
1329
	static unsigned int pow2_sizes[] = {
L
Linus Torvalds 已提交
1330 1331 1332 1333 1334 1335 1336 1337 1338 1339
		1<<0, 1<<1, 1<<2, 1<<3, 1<<4, 1<<5, 1<<6, 1<<7,
		1<<8, 1<<9, 1<<10, 1<<11, 1<<12, 1<<13, 1<<14, 1<<15,
		1<<16, 1<<17, 1<<18, 1<<19, 1<<20, 1<<21, 1<<22, 1<<23,
		1<<24, 1<<25, 1<<26, 1<<27, 1<<28, 1<<29, 1<<30
	};
	return snd_interval_list(hw_param_interval(params, rule->var),
				 ARRAY_SIZE(pow2_sizes), pow2_sizes, 0);
}		

/**
1340
 * snd_pcm_hw_constraint_pow2 - add a hw constraint power-of-2 rule
T
Takashi Iwai 已提交
1341 1342 1343
 * @runtime: PCM runtime instance
 * @cond: condition bits
 * @var: hw_params variable to apply the power-of-2 constraint
L
Linus Torvalds 已提交
1344
 */
T
Takashi Iwai 已提交
1345
int snd_pcm_hw_constraint_pow2(struct snd_pcm_runtime *runtime,
L
Linus Torvalds 已提交
1346 1347 1348 1349 1350 1351 1352 1353
			       unsigned int cond,
			       snd_pcm_hw_param_t var)
{
	return snd_pcm_hw_rule_add(runtime, cond, var, 
				   snd_pcm_hw_rule_pow2, NULL,
				   var, -1);
}

1354 1355
EXPORT_SYMBOL(snd_pcm_hw_constraint_pow2);

T
Takashi Iwai 已提交
1356
static void _snd_pcm_hw_param_any(struct snd_pcm_hw_params *params,
1357
				  snd_pcm_hw_param_t var)
L
Linus Torvalds 已提交
1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373
{
	if (hw_is_mask(var)) {
		snd_mask_any(hw_param_mask(params, var));
		params->cmask |= 1 << var;
		params->rmask |= 1 << var;
		return;
	}
	if (hw_is_interval(var)) {
		snd_interval_any(hw_param_interval(params, var));
		params->cmask |= 1 << var;
		params->rmask |= 1 << var;
		return;
	}
	snd_BUG();
}

T
Takashi Iwai 已提交
1374
void _snd_pcm_hw_params_any(struct snd_pcm_hw_params *params)
L
Linus Torvalds 已提交
1375 1376 1377 1378 1379 1380 1381 1382 1383 1384
{
	unsigned int k;
	memset(params, 0, sizeof(*params));
	for (k = SNDRV_PCM_HW_PARAM_FIRST_MASK; k <= SNDRV_PCM_HW_PARAM_LAST_MASK; k++)
		_snd_pcm_hw_param_any(params, k);
	for (k = SNDRV_PCM_HW_PARAM_FIRST_INTERVAL; k <= SNDRV_PCM_HW_PARAM_LAST_INTERVAL; k++)
		_snd_pcm_hw_param_any(params, k);
	params->info = ~0U;
}

1385
EXPORT_SYMBOL(_snd_pcm_hw_params_any);
L
Linus Torvalds 已提交
1386 1387

/**
1388
 * snd_pcm_hw_param_value - return @params field @var value
T
Takashi Iwai 已提交
1389 1390
 * @params: the hw_params instance
 * @var: parameter to retrieve
1391
 * @dir: pointer to the direction (-1,0,1) or %NULL
L
Linus Torvalds 已提交
1392
 *
1393 1394
 * Return the value for field @var if it's fixed in configuration space
 * defined by @params. Return -%EINVAL otherwise.
L
Linus Torvalds 已提交
1395
 */
1396 1397
int snd_pcm_hw_param_value(const struct snd_pcm_hw_params *params,
			   snd_pcm_hw_param_t var, int *dir)
L
Linus Torvalds 已提交
1398 1399
{
	if (hw_is_mask(var)) {
T
Takashi Iwai 已提交
1400
		const struct snd_mask *mask = hw_param_mask_c(params, var);
L
Linus Torvalds 已提交
1401 1402 1403 1404 1405 1406 1407
		if (!snd_mask_single(mask))
			return -EINVAL;
		if (dir)
			*dir = 0;
		return snd_mask_value(mask);
	}
	if (hw_is_interval(var)) {
T
Takashi Iwai 已提交
1408
		const struct snd_interval *i = hw_param_interval_c(params, var);
L
Linus Torvalds 已提交
1409 1410 1411 1412 1413 1414 1415 1416 1417
		if (!snd_interval_single(i))
			return -EINVAL;
		if (dir)
			*dir = i->openmin;
		return snd_interval_value(i);
	}
	return -EINVAL;
}

1418
EXPORT_SYMBOL(snd_pcm_hw_param_value);
L
Linus Torvalds 已提交
1419

T
Takashi Iwai 已提交
1420
void _snd_pcm_hw_param_setempty(struct snd_pcm_hw_params *params,
L
Linus Torvalds 已提交
1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435
				snd_pcm_hw_param_t var)
{
	if (hw_is_mask(var)) {
		snd_mask_none(hw_param_mask(params, var));
		params->cmask |= 1 << var;
		params->rmask |= 1 << var;
	} else if (hw_is_interval(var)) {
		snd_interval_none(hw_param_interval(params, var));
		params->cmask |= 1 << var;
		params->rmask |= 1 << var;
	} else {
		snd_BUG();
	}
}

1436
EXPORT_SYMBOL(_snd_pcm_hw_param_setempty);
L
Linus Torvalds 已提交
1437

T
Takashi Iwai 已提交
1438
static int _snd_pcm_hw_param_first(struct snd_pcm_hw_params *params,
1439
				   snd_pcm_hw_param_t var)
L
Linus Torvalds 已提交
1440 1441 1442 1443 1444 1445
{
	int changed;
	if (hw_is_mask(var))
		changed = snd_mask_refine_first(hw_param_mask(params, var));
	else if (hw_is_interval(var))
		changed = snd_interval_refine_first(hw_param_interval(params, var));
1446
	else
L
Linus Torvalds 已提交
1447 1448 1449 1450 1451 1452 1453 1454 1455 1456
		return -EINVAL;
	if (changed) {
		params->cmask |= 1 << var;
		params->rmask |= 1 << var;
	}
	return changed;
}


/**
1457
 * snd_pcm_hw_param_first - refine config space and return minimum value
T
Takashi Iwai 已提交
1458 1459 1460
 * @pcm: PCM instance
 * @params: the hw_params instance
 * @var: parameter to retrieve
1461
 * @dir: pointer to the direction (-1,0,1) or %NULL
L
Linus Torvalds 已提交
1462
 *
1463
 * Inside configuration space defined by @params remove from @var all
L
Linus Torvalds 已提交
1464 1465 1466
 * values > minimum. Reduce configuration space accordingly.
 * Return the minimum.
 */
1467 1468 1469
int snd_pcm_hw_param_first(struct snd_pcm_substream *pcm, 
			   struct snd_pcm_hw_params *params, 
			   snd_pcm_hw_param_t var, int *dir)
L
Linus Torvalds 已提交
1470 1471 1472 1473 1474 1475
{
	int changed = _snd_pcm_hw_param_first(params, var);
	if (changed < 0)
		return changed;
	if (params->rmask) {
		int err = snd_pcm_hw_refine(pcm, params);
1476 1477
		if (snd_BUG_ON(err < 0))
			return err;
L
Linus Torvalds 已提交
1478 1479 1480 1481
	}
	return snd_pcm_hw_param_value(params, var, dir);
}

1482 1483
EXPORT_SYMBOL(snd_pcm_hw_param_first);

T
Takashi Iwai 已提交
1484
static int _snd_pcm_hw_param_last(struct snd_pcm_hw_params *params,
1485
				  snd_pcm_hw_param_t var)
L
Linus Torvalds 已提交
1486 1487 1488 1489 1490 1491
{
	int changed;
	if (hw_is_mask(var))
		changed = snd_mask_refine_last(hw_param_mask(params, var));
	else if (hw_is_interval(var))
		changed = snd_interval_refine_last(hw_param_interval(params, var));
1492
	else
L
Linus Torvalds 已提交
1493 1494 1495 1496 1497 1498 1499 1500 1501 1502
		return -EINVAL;
	if (changed) {
		params->cmask |= 1 << var;
		params->rmask |= 1 << var;
	}
	return changed;
}


/**
1503
 * snd_pcm_hw_param_last - refine config space and return maximum value
T
Takashi Iwai 已提交
1504 1505 1506
 * @pcm: PCM instance
 * @params: the hw_params instance
 * @var: parameter to retrieve
1507
 * @dir: pointer to the direction (-1,0,1) or %NULL
L
Linus Torvalds 已提交
1508
 *
1509
 * Inside configuration space defined by @params remove from @var all
L
Linus Torvalds 已提交
1510 1511 1512
 * values < maximum. Reduce configuration space accordingly.
 * Return the maximum.
 */
1513 1514 1515
int snd_pcm_hw_param_last(struct snd_pcm_substream *pcm, 
			  struct snd_pcm_hw_params *params,
			  snd_pcm_hw_param_t var, int *dir)
L
Linus Torvalds 已提交
1516 1517 1518 1519 1520 1521
{
	int changed = _snd_pcm_hw_param_last(params, var);
	if (changed < 0)
		return changed;
	if (params->rmask) {
		int err = snd_pcm_hw_refine(pcm, params);
1522 1523
		if (snd_BUG_ON(err < 0))
			return err;
L
Linus Torvalds 已提交
1524 1525 1526 1527
	}
	return snd_pcm_hw_param_value(params, var, dir);
}

1528
EXPORT_SYMBOL(snd_pcm_hw_param_last);
L
Linus Torvalds 已提交
1529 1530

/**
1531
 * snd_pcm_hw_param_choose - choose a configuration defined by @params
T
Takashi Iwai 已提交
1532 1533
 * @pcm: PCM instance
 * @params: the hw_params instance
L
Linus Torvalds 已提交
1534
 *
1535
 * Choose one configuration from configuration space defined by @params.
L
Linus Torvalds 已提交
1536 1537 1538 1539
 * The configuration chosen is that obtained fixing in this order:
 * first access, first format, first subformat, min channels,
 * min rate, min period time, max buffer size, min tick time
 */
1540 1541
int snd_pcm_hw_params_choose(struct snd_pcm_substream *pcm,
			     struct snd_pcm_hw_params *params)
L
Linus Torvalds 已提交
1542
{
1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554
	static int vars[] = {
		SNDRV_PCM_HW_PARAM_ACCESS,
		SNDRV_PCM_HW_PARAM_FORMAT,
		SNDRV_PCM_HW_PARAM_SUBFORMAT,
		SNDRV_PCM_HW_PARAM_CHANNELS,
		SNDRV_PCM_HW_PARAM_RATE,
		SNDRV_PCM_HW_PARAM_PERIOD_TIME,
		SNDRV_PCM_HW_PARAM_BUFFER_SIZE,
		SNDRV_PCM_HW_PARAM_TICK_TIME,
		-1
	};
	int err, *v;
L
Linus Torvalds 已提交
1555

1556 1557 1558 1559 1560
	for (v = vars; *v != -1; v++) {
		if (*v != SNDRV_PCM_HW_PARAM_BUFFER_SIZE)
			err = snd_pcm_hw_param_first(pcm, params, *v, NULL);
		else
			err = snd_pcm_hw_param_last(pcm, params, *v, NULL);
1561 1562
		if (snd_BUG_ON(err < 0))
			return err;
1563
	}
L
Linus Torvalds 已提交
1564 1565 1566
	return 0;
}

T
Takashi Iwai 已提交
1567
static int snd_pcm_lib_ioctl_reset(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
1568 1569
				   void *arg)
{
T
Takashi Iwai 已提交
1570
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581
	unsigned long flags;
	snd_pcm_stream_lock_irqsave(substream, flags);
	if (snd_pcm_running(substream) &&
	    snd_pcm_update_hw_ptr(substream) >= 0)
		runtime->status->hw_ptr %= runtime->buffer_size;
	else
		runtime->status->hw_ptr = 0;
	snd_pcm_stream_unlock_irqrestore(substream, flags);
	return 0;
}

T
Takashi Iwai 已提交
1582
static int snd_pcm_lib_ioctl_channel_info(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
1583 1584
					  void *arg)
{
T
Takashi Iwai 已提交
1585 1586
	struct snd_pcm_channel_info *info = arg;
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616
	int width;
	if (!(runtime->info & SNDRV_PCM_INFO_MMAP)) {
		info->offset = -1;
		return 0;
	}
	width = snd_pcm_format_physical_width(runtime->format);
	if (width < 0)
		return width;
	info->offset = 0;
	switch (runtime->access) {
	case SNDRV_PCM_ACCESS_MMAP_INTERLEAVED:
	case SNDRV_PCM_ACCESS_RW_INTERLEAVED:
		info->first = info->channel * width;
		info->step = runtime->channels * width;
		break;
	case SNDRV_PCM_ACCESS_MMAP_NONINTERLEAVED:
	case SNDRV_PCM_ACCESS_RW_NONINTERLEAVED:
	{
		size_t size = runtime->dma_bytes / runtime->channels;
		info->first = info->channel * size * 8;
		info->step = width;
		break;
	}
	default:
		snd_BUG();
		break;
	}
	return 0;
}

1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633
static int snd_pcm_lib_ioctl_fifo_size(struct snd_pcm_substream *substream,
				       void *arg)
{
	struct snd_pcm_hw_params *params = arg;
	snd_pcm_format_t format;
	int channels, width;

	params->fifo_size = substream->runtime->hw.fifo_size;
	if (!(substream->runtime->hw.info & SNDRV_PCM_INFO_FIFO_IN_FRAMES)) {
		format = params_format(params);
		channels = params_channels(params);
		width = snd_pcm_format_physical_width(format);
		params->fifo_size /= width * channels;
	}
	return 0;
}

L
Linus Torvalds 已提交
1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644
/**
 * snd_pcm_lib_ioctl - a generic PCM ioctl callback
 * @substream: the pcm substream instance
 * @cmd: ioctl command
 * @arg: ioctl argument
 *
 * Processes the generic ioctl commands for PCM.
 * Can be passed as the ioctl callback for PCM ops.
 *
 * Returns zero if successful, or a negative error code on failure.
 */
T
Takashi Iwai 已提交
1645
int snd_pcm_lib_ioctl(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
1646 1647 1648 1649 1650 1651 1652 1653 1654
		      unsigned int cmd, void *arg)
{
	switch (cmd) {
	case SNDRV_PCM_IOCTL1_INFO:
		return 0;
	case SNDRV_PCM_IOCTL1_RESET:
		return snd_pcm_lib_ioctl_reset(substream, arg);
	case SNDRV_PCM_IOCTL1_CHANNEL_INFO:
		return snd_pcm_lib_ioctl_channel_info(substream, arg);
1655 1656
	case SNDRV_PCM_IOCTL1_FIFO_SIZE:
		return snd_pcm_lib_ioctl_fifo_size(substream, arg);
L
Linus Torvalds 已提交
1657 1658 1659 1660
	}
	return -ENXIO;
}

1661 1662
EXPORT_SYMBOL(snd_pcm_lib_ioctl);

L
Linus Torvalds 已提交
1663 1664 1665 1666 1667 1668
/**
 * snd_pcm_period_elapsed - update the pcm status for the next period
 * @substream: the pcm substream instance
 *
 * This function is called from the interrupt handler when the
 * PCM has processed the period size.  It will update the current
1669
 * pointer, wake up sleepers, etc.
L
Linus Torvalds 已提交
1670 1671 1672 1673
 *
 * Even if more than one periods have elapsed since the last call, you
 * have to call this only once.
 */
T
Takashi Iwai 已提交
1674
void snd_pcm_period_elapsed(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
1675
{
T
Takashi Iwai 已提交
1676
	struct snd_pcm_runtime *runtime;
L
Linus Torvalds 已提交
1677 1678
	unsigned long flags;

1679 1680
	if (PCM_RUNTIME_CHECK(substream))
		return;
L
Linus Torvalds 已提交
1681 1682 1683 1684 1685 1686 1687
	runtime = substream->runtime;

	if (runtime->transfer_ack_begin)
		runtime->transfer_ack_begin(substream);

	snd_pcm_stream_lock_irqsave(substream, flags);
	if (!snd_pcm_running(substream) ||
1688
	    snd_pcm_update_hw_ptr0(substream, 1) < 0)
L
Linus Torvalds 已提交
1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699
		goto _end;

	if (substream->timer_running)
		snd_timer_interrupt(substream->timer, 1);
 _end:
	snd_pcm_stream_unlock_irqrestore(substream, flags);
	if (runtime->transfer_ack_end)
		runtime->transfer_ack_end(substream);
	kill_fasync(&runtime->fasync, SIGIO, POLL_IN);
}

1700 1701
EXPORT_SYMBOL(snd_pcm_period_elapsed);

1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718
/*
 * Wait until avail_min data becomes available
 * Returns a negative error code if any error occurs during operation.
 * The available space is stored on availp.  When err = 0 and avail = 0
 * on the capture stream, it indicates the stream is in DRAINING state.
 */
static int wait_for_avail_min(struct snd_pcm_substream *substream,
			      snd_pcm_uframes_t *availp)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	int is_playback = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
	wait_queue_t wait;
	int err = 0;
	snd_pcm_uframes_t avail = 0;
	long tout;

	init_waitqueue_entry(&wait, current);
1719
	add_wait_queue(&runtime->tsleep, &wait);
1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761
	for (;;) {
		if (signal_pending(current)) {
			err = -ERESTARTSYS;
			break;
		}
		set_current_state(TASK_INTERRUPTIBLE);
		snd_pcm_stream_unlock_irq(substream);
		tout = schedule_timeout(msecs_to_jiffies(10000));
		snd_pcm_stream_lock_irq(substream);
		switch (runtime->status->state) {
		case SNDRV_PCM_STATE_SUSPENDED:
			err = -ESTRPIPE;
			goto _endloop;
		case SNDRV_PCM_STATE_XRUN:
			err = -EPIPE;
			goto _endloop;
		case SNDRV_PCM_STATE_DRAINING:
			if (is_playback)
				err = -EPIPE;
			else 
				avail = 0; /* indicate draining */
			goto _endloop;
		case SNDRV_PCM_STATE_OPEN:
		case SNDRV_PCM_STATE_SETUP:
		case SNDRV_PCM_STATE_DISCONNECTED:
			err = -EBADFD;
			goto _endloop;
		}
		if (!tout) {
			snd_printd("%s write error (DMA or IRQ trouble?)\n",
				   is_playback ? "playback" : "capture");
			err = -EIO;
			break;
		}
		if (is_playback)
			avail = snd_pcm_playback_avail(runtime);
		else
			avail = snd_pcm_capture_avail(runtime);
		if (avail >= runtime->control->avail_min)
			break;
	}
 _endloop:
1762
	remove_wait_queue(&runtime->tsleep, &wait);
1763 1764 1765 1766
	*availp = avail;
	return err;
}
	
T
Takashi Iwai 已提交
1767
static int snd_pcm_lib_write_transfer(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
1768 1769 1770 1771
				      unsigned int hwoff,
				      unsigned long data, unsigned int off,
				      snd_pcm_uframes_t frames)
{
T
Takashi Iwai 已提交
1772
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785
	int err;
	char __user *buf = (char __user *) data + frames_to_bytes(runtime, off);
	if (substream->ops->copy) {
		if ((err = substream->ops->copy(substream, -1, hwoff, buf, frames)) < 0)
			return err;
	} else {
		char *hwbuf = runtime->dma_area + frames_to_bytes(runtime, hwoff);
		if (copy_from_user(hwbuf, buf, frames_to_bytes(runtime, frames)))
			return -EFAULT;
	}
	return 0;
}
 
T
Takashi Iwai 已提交
1786
typedef int (*transfer_f)(struct snd_pcm_substream *substream, unsigned int hwoff,
L
Linus Torvalds 已提交
1787 1788 1789
			  unsigned long data, unsigned int off,
			  snd_pcm_uframes_t size);

T
Takashi Iwai 已提交
1790
static snd_pcm_sframes_t snd_pcm_lib_write1(struct snd_pcm_substream *substream, 
L
Linus Torvalds 已提交
1791 1792 1793 1794 1795
					    unsigned long data,
					    snd_pcm_uframes_t size,
					    int nonblock,
					    transfer_f transfer)
{
T
Takashi Iwai 已提交
1796
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820
	snd_pcm_uframes_t xfer = 0;
	snd_pcm_uframes_t offset = 0;
	int err = 0;

	if (size == 0)
		return 0;

	snd_pcm_stream_lock_irq(substream);
	switch (runtime->status->state) {
	case SNDRV_PCM_STATE_PREPARED:
	case SNDRV_PCM_STATE_RUNNING:
	case SNDRV_PCM_STATE_PAUSED:
		break;
	case SNDRV_PCM_STATE_XRUN:
		err = -EPIPE;
		goto _end_unlock;
	case SNDRV_PCM_STATE_SUSPENDED:
		err = -ESTRPIPE;
		goto _end_unlock;
	default:
		err = -EBADFD;
		goto _end_unlock;
	}

1821
	runtime->twake = 1;
L
Linus Torvalds 已提交
1822 1823 1824 1825
	while (size > 0) {
		snd_pcm_uframes_t frames, appl_ptr, appl_ofs;
		snd_pcm_uframes_t avail;
		snd_pcm_uframes_t cont;
1826
		if (runtime->status->state == SNDRV_PCM_STATE_RUNNING)
L
Linus Torvalds 已提交
1827 1828
			snd_pcm_update_hw_ptr(substream);
		avail = snd_pcm_playback_avail(runtime);
1829
		if (!avail) {
L
Linus Torvalds 已提交
1830 1831 1832 1833
			if (nonblock) {
				err = -EAGAIN;
				goto _end_unlock;
			}
1834 1835
			err = wait_for_avail_min(substream, &avail);
			if (err < 0)
1836
				goto _end_unlock;
L
Linus Torvalds 已提交
1837 1838 1839 1840 1841
		}
		frames = size > avail ? avail : size;
		cont = runtime->buffer_size - runtime->control->appl_ptr % runtime->buffer_size;
		if (frames > cont)
			frames = cont;
1842
		if (snd_BUG_ON(!frames)) {
1843
			runtime->twake = 0;
1844 1845 1846
			snd_pcm_stream_unlock_irq(substream);
			return -EINVAL;
		}
L
Linus Torvalds 已提交
1847 1848 1849
		appl_ptr = runtime->control->appl_ptr;
		appl_ofs = appl_ptr % runtime->buffer_size;
		snd_pcm_stream_unlock_irq(substream);
1850
		err = transfer(substream, appl_ofs, data, offset, frames);
L
Linus Torvalds 已提交
1851
		snd_pcm_stream_lock_irq(substream);
1852 1853
		if (err < 0)
			goto _end_unlock;
L
Linus Torvalds 已提交
1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881
		switch (runtime->status->state) {
		case SNDRV_PCM_STATE_XRUN:
			err = -EPIPE;
			goto _end_unlock;
		case SNDRV_PCM_STATE_SUSPENDED:
			err = -ESTRPIPE;
			goto _end_unlock;
		default:
			break;
		}
		appl_ptr += frames;
		if (appl_ptr >= runtime->boundary)
			appl_ptr -= runtime->boundary;
		runtime->control->appl_ptr = appl_ptr;
		if (substream->ops->ack)
			substream->ops->ack(substream);

		offset += frames;
		size -= frames;
		xfer += frames;
		if (runtime->status->state == SNDRV_PCM_STATE_PREPARED &&
		    snd_pcm_playback_hw_avail(runtime) >= (snd_pcm_sframes_t)runtime->start_threshold) {
			err = snd_pcm_start(substream);
			if (err < 0)
				goto _end_unlock;
		}
	}
 _end_unlock:
1882
	runtime->twake = 0;
1883 1884
	if (xfer > 0 && err >= 0)
		snd_pcm_update_state(substream, runtime);
L
Linus Torvalds 已提交
1885 1886 1887 1888
	snd_pcm_stream_unlock_irq(substream);
	return xfer > 0 ? (snd_pcm_sframes_t)xfer : err;
}

1889 1890
/* sanity-check for read/write methods */
static int pcm_sanity_check(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
1891
{
T
Takashi Iwai 已提交
1892
	struct snd_pcm_runtime *runtime;
1893 1894
	if (PCM_RUNTIME_CHECK(substream))
		return -ENXIO;
L
Linus Torvalds 已提交
1895
	runtime = substream->runtime;
1896 1897
	if (snd_BUG_ON(!substream->ops->copy && !runtime->dma_area))
		return -EINVAL;
L
Linus Torvalds 已提交
1898 1899
	if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
		return -EBADFD;
1900 1901 1902 1903 1904 1905 1906 1907
	return 0;
}

snd_pcm_sframes_t snd_pcm_lib_write(struct snd_pcm_substream *substream, const void __user *buf, snd_pcm_uframes_t size)
{
	struct snd_pcm_runtime *runtime;
	int nonblock;
	int err;
L
Linus Torvalds 已提交
1908

1909 1910 1911 1912
	err = pcm_sanity_check(substream);
	if (err < 0)
		return err;
	runtime = substream->runtime;
1913
	nonblock = !!(substream->f_flags & O_NONBLOCK);
L
Linus Torvalds 已提交
1914 1915 1916 1917 1918 1919 1920 1921

	if (runtime->access != SNDRV_PCM_ACCESS_RW_INTERLEAVED &&
	    runtime->channels > 1)
		return -EINVAL;
	return snd_pcm_lib_write1(substream, (unsigned long)buf, size, nonblock,
				  snd_pcm_lib_write_transfer);
}

1922 1923
EXPORT_SYMBOL(snd_pcm_lib_write);

T
Takashi Iwai 已提交
1924
static int snd_pcm_lib_writev_transfer(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
1925 1926 1927 1928
				       unsigned int hwoff,
				       unsigned long data, unsigned int off,
				       snd_pcm_uframes_t frames)
{
T
Takashi Iwai 已提交
1929
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
1930 1931 1932 1933 1934
	int err;
	void __user **bufs = (void __user **)data;
	int channels = runtime->channels;
	int c;
	if (substream->ops->copy) {
1935 1936
		if (snd_BUG_ON(!substream->ops->silence))
			return -EINVAL;
L
Linus Torvalds 已提交
1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963
		for (c = 0; c < channels; ++c, ++bufs) {
			if (*bufs == NULL) {
				if ((err = substream->ops->silence(substream, c, hwoff, frames)) < 0)
					return err;
			} else {
				char __user *buf = *bufs + samples_to_bytes(runtime, off);
				if ((err = substream->ops->copy(substream, c, hwoff, buf, frames)) < 0)
					return err;
			}
		}
	} else {
		/* default transfer behaviour */
		size_t dma_csize = runtime->dma_bytes / channels;
		for (c = 0; c < channels; ++c, ++bufs) {
			char *hwbuf = runtime->dma_area + (c * dma_csize) + samples_to_bytes(runtime, hwoff);
			if (*bufs == NULL) {
				snd_pcm_format_set_silence(runtime->format, hwbuf, frames);
			} else {
				char __user *buf = *bufs + samples_to_bytes(runtime, off);
				if (copy_from_user(hwbuf, buf, samples_to_bytes(runtime, frames)))
					return -EFAULT;
			}
		}
	}
	return 0;
}
 
T
Takashi Iwai 已提交
1964
snd_pcm_sframes_t snd_pcm_lib_writev(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
1965 1966 1967
				     void __user **bufs,
				     snd_pcm_uframes_t frames)
{
T
Takashi Iwai 已提交
1968
	struct snd_pcm_runtime *runtime;
L
Linus Torvalds 已提交
1969
	int nonblock;
1970
	int err;
L
Linus Torvalds 已提交
1971

1972 1973 1974
	err = pcm_sanity_check(substream);
	if (err < 0)
		return err;
L
Linus Torvalds 已提交
1975
	runtime = substream->runtime;
1976
	nonblock = !!(substream->f_flags & O_NONBLOCK);
L
Linus Torvalds 已提交
1977 1978 1979 1980 1981 1982 1983

	if (runtime->access != SNDRV_PCM_ACCESS_RW_NONINTERLEAVED)
		return -EINVAL;
	return snd_pcm_lib_write1(substream, (unsigned long)bufs, frames,
				  nonblock, snd_pcm_lib_writev_transfer);
}

1984 1985
EXPORT_SYMBOL(snd_pcm_lib_writev);

T
Takashi Iwai 已提交
1986
static int snd_pcm_lib_read_transfer(struct snd_pcm_substream *substream, 
L
Linus Torvalds 已提交
1987 1988 1989 1990
				     unsigned int hwoff,
				     unsigned long data, unsigned int off,
				     snd_pcm_uframes_t frames)
{
T
Takashi Iwai 已提交
1991
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004
	int err;
	char __user *buf = (char __user *) data + frames_to_bytes(runtime, off);
	if (substream->ops->copy) {
		if ((err = substream->ops->copy(substream, -1, hwoff, buf, frames)) < 0)
			return err;
	} else {
		char *hwbuf = runtime->dma_area + frames_to_bytes(runtime, hwoff);
		if (copy_to_user(buf, hwbuf, frames_to_bytes(runtime, frames)))
			return -EFAULT;
	}
	return 0;
}

T
Takashi Iwai 已提交
2005
static snd_pcm_sframes_t snd_pcm_lib_read1(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
2006 2007 2008 2009 2010
					   unsigned long data,
					   snd_pcm_uframes_t size,
					   int nonblock,
					   transfer_f transfer)
{
T
Takashi Iwai 已提交
2011
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042
	snd_pcm_uframes_t xfer = 0;
	snd_pcm_uframes_t offset = 0;
	int err = 0;

	if (size == 0)
		return 0;

	snd_pcm_stream_lock_irq(substream);
	switch (runtime->status->state) {
	case SNDRV_PCM_STATE_PREPARED:
		if (size >= runtime->start_threshold) {
			err = snd_pcm_start(substream);
			if (err < 0)
				goto _end_unlock;
		}
		break;
	case SNDRV_PCM_STATE_DRAINING:
	case SNDRV_PCM_STATE_RUNNING:
	case SNDRV_PCM_STATE_PAUSED:
		break;
	case SNDRV_PCM_STATE_XRUN:
		err = -EPIPE;
		goto _end_unlock;
	case SNDRV_PCM_STATE_SUSPENDED:
		err = -ESTRPIPE;
		goto _end_unlock;
	default:
		err = -EBADFD;
		goto _end_unlock;
	}

2043
	runtime->twake = 1;
L
Linus Torvalds 已提交
2044 2045 2046 2047
	while (size > 0) {
		snd_pcm_uframes_t frames, appl_ptr, appl_ofs;
		snd_pcm_uframes_t avail;
		snd_pcm_uframes_t cont;
2048
		if (runtime->status->state == SNDRV_PCM_STATE_RUNNING)
L
Linus Torvalds 已提交
2049 2050
			snd_pcm_update_hw_ptr(substream);
		avail = snd_pcm_capture_avail(runtime);
2051 2052 2053 2054
		if (!avail) {
			if (runtime->status->state ==
			    SNDRV_PCM_STATE_DRAINING) {
				snd_pcm_stop(substream, SNDRV_PCM_STATE_SETUP);
L
Linus Torvalds 已提交
2055 2056 2057 2058 2059 2060
				goto _end_unlock;
			}
			if (nonblock) {
				err = -EAGAIN;
				goto _end_unlock;
			}
2061 2062
			err = wait_for_avail_min(substream, &avail);
			if (err < 0)
2063
				goto _end_unlock;
2064 2065
			if (!avail)
				continue; /* draining */
L
Linus Torvalds 已提交
2066 2067 2068 2069 2070
		}
		frames = size > avail ? avail : size;
		cont = runtime->buffer_size - runtime->control->appl_ptr % runtime->buffer_size;
		if (frames > cont)
			frames = cont;
2071
		if (snd_BUG_ON(!frames)) {
2072
			runtime->twake = 0;
2073 2074 2075
			snd_pcm_stream_unlock_irq(substream);
			return -EINVAL;
		}
L
Linus Torvalds 已提交
2076 2077 2078
		appl_ptr = runtime->control->appl_ptr;
		appl_ofs = appl_ptr % runtime->buffer_size;
		snd_pcm_stream_unlock_irq(substream);
2079
		err = transfer(substream, appl_ofs, data, offset, frames);
L
Linus Torvalds 已提交
2080
		snd_pcm_stream_lock_irq(substream);
2081 2082
		if (err < 0)
			goto _end_unlock;
L
Linus Torvalds 已提交
2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104
		switch (runtime->status->state) {
		case SNDRV_PCM_STATE_XRUN:
			err = -EPIPE;
			goto _end_unlock;
		case SNDRV_PCM_STATE_SUSPENDED:
			err = -ESTRPIPE;
			goto _end_unlock;
		default:
			break;
		}
		appl_ptr += frames;
		if (appl_ptr >= runtime->boundary)
			appl_ptr -= runtime->boundary;
		runtime->control->appl_ptr = appl_ptr;
		if (substream->ops->ack)
			substream->ops->ack(substream);

		offset += frames;
		size -= frames;
		xfer += frames;
	}
 _end_unlock:
2105
	runtime->twake = 0;
2106 2107
	if (xfer > 0 && err >= 0)
		snd_pcm_update_state(substream, runtime);
L
Linus Torvalds 已提交
2108 2109 2110 2111
	snd_pcm_stream_unlock_irq(substream);
	return xfer > 0 ? (snd_pcm_sframes_t)xfer : err;
}

T
Takashi Iwai 已提交
2112
snd_pcm_sframes_t snd_pcm_lib_read(struct snd_pcm_substream *substream, void __user *buf, snd_pcm_uframes_t size)
L
Linus Torvalds 已提交
2113
{
T
Takashi Iwai 已提交
2114
	struct snd_pcm_runtime *runtime;
L
Linus Torvalds 已提交
2115
	int nonblock;
2116
	int err;
L
Linus Torvalds 已提交
2117
	
2118 2119 2120
	err = pcm_sanity_check(substream);
	if (err < 0)
		return err;
L
Linus Torvalds 已提交
2121
	runtime = substream->runtime;
2122
	nonblock = !!(substream->f_flags & O_NONBLOCK);
L
Linus Torvalds 已提交
2123 2124 2125 2126 2127
	if (runtime->access != SNDRV_PCM_ACCESS_RW_INTERLEAVED)
		return -EINVAL;
	return snd_pcm_lib_read1(substream, (unsigned long)buf, size, nonblock, snd_pcm_lib_read_transfer);
}

2128 2129
EXPORT_SYMBOL(snd_pcm_lib_read);

T
Takashi Iwai 已提交
2130
static int snd_pcm_lib_readv_transfer(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
2131 2132 2133 2134
				      unsigned int hwoff,
				      unsigned long data, unsigned int off,
				      snd_pcm_uframes_t frames)
{
T
Takashi Iwai 已提交
2135
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165
	int err;
	void __user **bufs = (void __user **)data;
	int channels = runtime->channels;
	int c;
	if (substream->ops->copy) {
		for (c = 0; c < channels; ++c, ++bufs) {
			char __user *buf;
			if (*bufs == NULL)
				continue;
			buf = *bufs + samples_to_bytes(runtime, off);
			if ((err = substream->ops->copy(substream, c, hwoff, buf, frames)) < 0)
				return err;
		}
	} else {
		snd_pcm_uframes_t dma_csize = runtime->dma_bytes / channels;
		for (c = 0; c < channels; ++c, ++bufs) {
			char *hwbuf;
			char __user *buf;
			if (*bufs == NULL)
				continue;

			hwbuf = runtime->dma_area + (c * dma_csize) + samples_to_bytes(runtime, hwoff);
			buf = *bufs + samples_to_bytes(runtime, off);
			if (copy_to_user(buf, hwbuf, samples_to_bytes(runtime, frames)))
				return -EFAULT;
		}
	}
	return 0;
}
 
T
Takashi Iwai 已提交
2166
snd_pcm_sframes_t snd_pcm_lib_readv(struct snd_pcm_substream *substream,
L
Linus Torvalds 已提交
2167 2168 2169
				    void __user **bufs,
				    snd_pcm_uframes_t frames)
{
T
Takashi Iwai 已提交
2170
	struct snd_pcm_runtime *runtime;
L
Linus Torvalds 已提交
2171
	int nonblock;
2172
	int err;
L
Linus Torvalds 已提交
2173

2174 2175 2176
	err = pcm_sanity_check(substream);
	if (err < 0)
		return err;
L
Linus Torvalds 已提交
2177 2178 2179 2180
	runtime = substream->runtime;
	if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
		return -EBADFD;

2181
	nonblock = !!(substream->f_flags & O_NONBLOCK);
L
Linus Torvalds 已提交
2182 2183 2184 2185 2186 2187
	if (runtime->access != SNDRV_PCM_ACCESS_RW_NONINTERLEAVED)
		return -EINVAL;
	return snd_pcm_lib_read1(substream, (unsigned long)bufs, frames, nonblock, snd_pcm_lib_readv_transfer);
}

EXPORT_SYMBOL(snd_pcm_lib_readv);