?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[NETFILTER]: x_tables: add SCTP/DCCP support where missing
[linux-2.6/verdex.git] / sound / core / pcm_native.c
blob0860c5a84502f6f67451cdea60a566b639fdbf9b
1 /*
2 * Digital Audio (PCM) abstract layer
3 * Copyright (c) by Jaroslav Kysela <perex@suse.cz>
4 *
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 *
20 */
21
22 #include <sound/driver.h>
23 #include <linux/mm.h>
24 #include <linux/smp_lock.h>
25 #include <linux/file.h>
26 #include <linux/slab.h>
27 #include <linux/time.h>
28 #include <linux/uio.h>
29 #include <sound/core.h>
30 #include <sound/control.h>
31 #include <sound/info.h>
32 #include <sound/pcm.h>
33 #include <sound/pcm_params.h>
34 #include <sound/timer.h>
35 #include <sound/minors.h>
36 #include <asm/io.h>
37
38 /*
39 * Compatibility
40 */
41
42 struct snd_pcm_hw_params_old {
43 unsigned int flags;
44 unsigned int masks[SNDRV_PCM_HW_PARAM_SUBFORMAT -
45 SNDRV_PCM_HW_PARAM_ACCESS + 1];
46 struct snd_interval intervals[SNDRV_PCM_HW_PARAM_TICK_TIME -
47 SNDRV_PCM_HW_PARAM_SAMPLE_BITS + 1];
48 unsigned int rmask;
49 unsigned int cmask;
50 unsigned int info;
51 unsigned int msbits;
52 unsigned int rate_num;
53 unsigned int rate_den;
54 snd_pcm_uframes_t fifo_size;
55 unsigned char reserved[64];
56 };
57
58 #ifdef CONFIG_SND_SUPPORT_OLD_API
59 #define SNDRV_PCM_IOCTL_HW_REFINE_OLD _IOWR('A', 0x10, struct snd_pcm_hw_params_old)
60 #define SNDRV_PCM_IOCTL_HW_PARAMS_OLD _IOWR('A', 0x11, struct snd_pcm_hw_params_old)
61
62 static int snd_pcm_hw_refine_old_user(struct snd_pcm_substream *substream,
63 struct snd_pcm_hw_params_old __user * _oparams);
64 static int snd_pcm_hw_params_old_user(struct snd_pcm_substream *substream,
65 struct snd_pcm_hw_params_old __user * _oparams);
66 #endif
67 static int snd_pcm_open(struct file *file, struct snd_pcm *pcm, int stream);
68
69 /*
70 *
71 */
72
73 DEFINE_RWLOCK(snd_pcm_link_rwlock);
74 static DECLARE_RWSEM(snd_pcm_link_rwsem);
75
76
77 static inline mm_segment_t snd_enter_user(void)
78 {
79 mm_segment_t fs = get_fs();
80 set_fs(get_ds());
81 return fs;
82 }
83
84 static inline void snd_leave_user(mm_segment_t fs)
85 {
86 set_fs(fs);
87 }
88
89
90
91 int snd_pcm_info(struct snd_pcm_substream *substream, struct snd_pcm_info *info)
92 {
93 struct snd_pcm_runtime *runtime;
94 struct snd_pcm *pcm = substream->pcm;
95 struct snd_pcm_str *pstr = substream->pstr;
96
97 snd_assert(substream != NULL, return -ENXIO);
98 memset(info, 0, sizeof(*info));
99 info->card = pcm->card->number;
100 info->device = pcm->device;
101 info->stream = substream->stream;
102 info->subdevice = substream->number;
103 strlcpy(info->id, pcm->id, sizeof(info->id));
104 strlcpy(info->name, pcm->name, sizeof(info->name));
105 info->dev_class = pcm->dev_class;
106 info->dev_subclass = pcm->dev_subclass;
107 info->subdevices_count = pstr->substream_count;
108 info->subdevices_avail = pstr->substream_count - pstr->substream_opened;
109 strlcpy(info->subname, substream->name, sizeof(info->subname));
110 runtime = substream->runtime;
111 /* AB: FIXME!!! This is definitely nonsense */
112 if (runtime) {
113 info->sync = runtime->sync;
114 substream->ops->ioctl(substream, SNDRV_PCM_IOCTL1_INFO, info);
115 }
116 return 0;
117 }
118
119 int snd_pcm_info_user(struct snd_pcm_substream *substream,
120 struct snd_pcm_info __user * _info)
121 {
122 struct snd_pcm_info *info;
123 int err;
124
125 info = kmalloc(sizeof(*info), GFP_KERNEL);
126 if (! info)
127 return -ENOMEM;
128 err = snd_pcm_info(substream, info);
129 if (err >= 0) {
130 if (copy_to_user(_info, info, sizeof(*info)))
131 err = -EFAULT;
132 }
133 kfree(info);
134 return err;
135 }
136
137 #undef RULES_DEBUG
138
139 #ifdef RULES_DEBUG
140 #define HW_PARAM(v) [SNDRV_PCM_HW_PARAM_##v] = #v
141 char *snd_pcm_hw_param_names[] = {
142 HW_PARAM(ACCESS),
143 HW_PARAM(FORMAT),
144 HW_PARAM(SUBFORMAT),
145 HW_PARAM(SAMPLE_BITS),
146 HW_PARAM(FRAME_BITS),
147 HW_PARAM(CHANNELS),
148 HW_PARAM(RATE),
149 HW_PARAM(PERIOD_TIME),
150 HW_PARAM(PERIOD_SIZE),
151 HW_PARAM(PERIOD_BYTES),
152 HW_PARAM(PERIODS),
153 HW_PARAM(BUFFER_TIME),
154 HW_PARAM(BUFFER_SIZE),
155 HW_PARAM(BUFFER_BYTES),
156 HW_PARAM(TICK_TIME),
157 };
158 #endif
159
160 int snd_pcm_hw_refine(struct snd_pcm_substream *substream,
161 struct snd_pcm_hw_params *params)
162 {
163 unsigned int k;
164 struct snd_pcm_hardware *hw;
165 struct snd_interval *i = NULL;
166 struct snd_mask *m = NULL;
167 struct snd_pcm_hw_constraints *constrs = &substream->runtime->hw_constraints;
168 unsigned int rstamps[constrs->rules_num];
169 unsigned int vstamps[SNDRV_PCM_HW_PARAM_LAST_INTERVAL + 1];
170 unsigned int stamp = 2;
171 int changed, again;
172
173 params->info = 0;
174 params->fifo_size = 0;
175 if (params->rmask & (1 << SNDRV_PCM_HW_PARAM_SAMPLE_BITS))
176 params->msbits = 0;
177 if (params->rmask & (1 << SNDRV_PCM_HW_PARAM_RATE)) {
178 params->rate_num = 0;
179 params->rate_den = 0;
180 }
181
182 for (k = SNDRV_PCM_HW_PARAM_FIRST_MASK; k <= SNDRV_PCM_HW_PARAM_LAST_MASK; k++) {
183 m = hw_param_mask(params, k);
184 if (snd_mask_empty(m))
185 return -EINVAL;
186 if (!(params->rmask & (1 << k)))
187 continue;
188 #ifdef RULES_DEBUG
189 printk("%s = ", snd_pcm_hw_param_names[k]);
190 printk("%04x%04x%04x%04x -> ", m->bits[3], m->bits[2], m->bits[1], m->bits[0]);
191 #endif
192 changed = snd_mask_refine(m, constrs_mask(constrs, k));
193 #ifdef RULES_DEBUG
194 printk("%04x%04x%04x%04x\n", m->bits[3], m->bits[2], m->bits[1], m->bits[0]);
195 #endif
196 if (changed)
197 params->cmask |= 1 << k;
198 if (changed < 0)
199 return changed;
200 }
201
202 for (k = SNDRV_PCM_HW_PARAM_FIRST_INTERVAL; k <= SNDRV_PCM_HW_PARAM_LAST_INTERVAL; k++) {
203 i = hw_param_interval(params, k);
204 if (snd_interval_empty(i))
205 return -EINVAL;
206 if (!(params->rmask & (1 << k)))
207 continue;
208 #ifdef RULES_DEBUG
209 printk("%s = ", snd_pcm_hw_param_names[k]);
210 if (i->empty)
211 printk("empty");
212 else
213 printk("%c%u %u%c",
214 i->openmin ? '(' : '[', i->min,
215 i->max, i->openmax ? ')' : ']');
216 printk(" -> ");
217 #endif
218 changed = snd_interval_refine(i, constrs_interval(constrs, k));
219 #ifdef RULES_DEBUG
220 if (i->empty)
221 printk("empty\n");
222 else
223 printk("%c%u %u%c\n",
224 i->openmin ? '(' : '[', i->min,
225 i->max, i->openmax ? ')' : ']');
226 #endif
227 if (changed)
228 params->cmask |= 1 << k;
229 if (changed < 0)
230 return changed;
231 }
232
233 for (k = 0; k < constrs->rules_num; k++)
234 rstamps[k] = 0;
235 for (k = 0; k <= SNDRV_PCM_HW_PARAM_LAST_INTERVAL; k++)
236 vstamps[k] = (params->rmask & (1 << k)) ? 1 : 0;
237 do {
238 again = 0;
239 for (k = 0; k < constrs->rules_num; k++) {
240 struct snd_pcm_hw_rule *r = &constrs->rules[k];
241 unsigned int d;
242 int doit = 0;
243 if (r->cond && !(r->cond & params->flags))
244 continue;
245 for (d = 0; r->deps[d] >= 0; d++) {
246 if (vstamps[r->deps[d]] > rstamps[k]) {
247 doit = 1;
248 break;
249 }
250 }
251 if (!doit)
252 continue;
253 #ifdef RULES_DEBUG
254 printk("Rule %d [%p]: ", k, r->func);
255 if (r->var >= 0) {
256 printk("%s = ", snd_pcm_hw_param_names[r->var]);
257 if (hw_is_mask(r->var)) {
258 m = hw_param_mask(params, r->var);
259 printk("%x", *m->bits);
260 } else {
261 i = hw_param_interval(params, r->var);
262 if (i->empty)
263 printk("empty");
264 else
265 printk("%c%u %u%c",
266 i->openmin ? '(' : '[', i->min,
267 i->max, i->openmax ? ')' : ']');
268 }
269 }
270 #endif
271 changed = r->func(params, r);
272 #ifdef RULES_DEBUG
273 if (r->var >= 0) {
274 printk(" -> ");
275 if (hw_is_mask(r->var))
276 printk("%x", *m->bits);
277 else {
278 if (i->empty)
279 printk("empty");
280 else
281 printk("%c%u %u%c",
282 i->openmin ? '(' : '[', i->min,
283 i->max, i->openmax ? ')' : ']');
284 }
285 }
286 printk("\n");
287 #endif
288 rstamps[k] = stamp;
289 if (changed && r->var >= 0) {
290 params->cmask |= (1 << r->var);
291 vstamps[r->var] = stamp;
292 again = 1;
293 }
294 if (changed < 0)
295 return changed;
296 stamp++;
297 }
298 } while (again);
299 if (!params->msbits) {
300 i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_SAMPLE_BITS);
301 if (snd_interval_single(i))
302 params->msbits = snd_interval_value(i);
303 }
304
305 if (!params->rate_den) {
306 i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
307 if (snd_interval_single(i)) {
308 params->rate_num = snd_interval_value(i);
309 params->rate_den = 1;
310 }
311 }
312
313 hw = &substream->runtime->hw;
314 if (!params->info)
315 params->info = hw->info;
316 if (!params->fifo_size)
317 params->fifo_size = hw->fifo_size;
318 params->rmask = 0;
319 return 0;
320 }
321
322 static int snd_pcm_hw_refine_user(struct snd_pcm_substream *substream,
323 struct snd_pcm_hw_params __user * _params)
324 {
325 struct snd_pcm_hw_params *params;
326 int err;
327
328 params = kmalloc(sizeof(*params), GFP_KERNEL);
329 if (!params) {
330 err = -ENOMEM;
331 goto out;
332 }
333 if (copy_from_user(params, _params, sizeof(*params))) {
334 err = -EFAULT;
335 goto out;
336 }
337 err = snd_pcm_hw_refine(substream, params);
338 if (copy_to_user(_params, params, sizeof(*params))) {
339 if (!err)
340 err = -EFAULT;
341 }
342 out:
343 kfree(params);
344 return err;
345 }
346
347 static int snd_pcm_hw_params(struct snd_pcm_substream *substream,
348 struct snd_pcm_hw_params *params)
349 {
350 struct snd_pcm_runtime *runtime;
351 int err;
352 unsigned int bits;
353 snd_pcm_uframes_t frames;
354
355 snd_assert(substream != NULL, return -ENXIO);
356 runtime = substream->runtime;
357 snd_assert(runtime != NULL, return -ENXIO);
358 snd_pcm_stream_lock_irq(substream);
359 switch (runtime->status->state) {
360 case SNDRV_PCM_STATE_OPEN:
361 case SNDRV_PCM_STATE_SETUP:
362 case SNDRV_PCM_STATE_PREPARED:
363 break;
364 default:
365 snd_pcm_stream_unlock_irq(substream);
366 return -EBADFD;
367 }
368 snd_pcm_stream_unlock_irq(substream);
369 #if defined(CONFIG_SND_PCM_OSS) || defined(CONFIG_SND_PCM_OSS_MODULE)
370 if (!substream->oss.oss)
371 #endif
372 if (atomic_read(&runtime->mmap_count))
373 return -EBADFD;
374
375 params->rmask = ~0U;
376 err = snd_pcm_hw_refine(substream, params);
377 if (err < 0)
378 goto _error;
379
380 err = snd_pcm_hw_params_choose(substream, params);
381 if (err < 0)
382 goto _error;
383
384 if (substream->ops->hw_params != NULL) {
385 err = substream->ops->hw_params(substream, params);
386 if (err < 0)
387 goto _error;
388 }
389
390 runtime->access = params_access(params);
391 runtime->format = params_format(params);
392 runtime->subformat = params_subformat(params);
393 runtime->channels = params_channels(params);
394 runtime->rate = params_rate(params);
395 runtime->period_size = params_period_size(params);
396 runtime->periods = params_periods(params);
397 runtime->buffer_size = params_buffer_size(params);
398 runtime->tick_time = params_tick_time(params);
399 runtime->info = params->info;
400 runtime->rate_num = params->rate_num;
401 runtime->rate_den = params->rate_den;
402
403 bits = snd_pcm_format_physical_width(runtime->format);
404 runtime->sample_bits = bits;
405 bits *= runtime->channels;
406 runtime->frame_bits = bits;
407 frames = 1;
408 while (bits % 8 != 0) {
409 bits *= 2;
410 frames *= 2;
411 }
412 runtime->byte_align = bits / 8;
413 runtime->min_align = frames;
414
415 /* Default sw params */
416 runtime->tstamp_mode = SNDRV_PCM_TSTAMP_NONE;
417 runtime->period_step = 1;
418 runtime->sleep_min = 0;
419 runtime->control->avail_min = runtime->period_size;
420 runtime->xfer_align = runtime->period_size;
421 runtime->start_threshold = 1;
422 runtime->stop_threshold = runtime->buffer_size;
423 runtime->silence_threshold = 0;
424 runtime->silence_size = 0;
425 runtime->boundary = runtime->buffer_size;
426 while (runtime->boundary * 2 <= LONG_MAX - runtime->buffer_size)
427 runtime->boundary *= 2;
428
429 snd_pcm_timer_resolution_change(substream);
430 runtime->status->state = SNDRV_PCM_STATE_SETUP;
431 return 0;
432 _error:
433 /* hardware might be unuseable from this time,
434 so we force application to retry to set
435 the correct hardware parameter settings */
436 runtime->status->state = SNDRV_PCM_STATE_OPEN;
437 if (substream->ops->hw_free != NULL)
438 substream->ops->hw_free(substream);
439 return err;
440 }
441
442 static int snd_pcm_hw_params_user(struct snd_pcm_substream *substream,
443 struct snd_pcm_hw_params __user * _params)
444 {
445 struct snd_pcm_hw_params *params;
446 int err;
447
448 params = kmalloc(sizeof(*params), GFP_KERNEL);
449 if (!params) {
450 err = -ENOMEM;
451 goto out;
452 }
453 if (copy_from_user(params, _params, sizeof(*params))) {
454 err = -EFAULT;
455 goto out;
456 }
457 err = snd_pcm_hw_params(substream, params);
458 if (copy_to_user(_params, params, sizeof(*params))) {
459 if (!err)
460 err = -EFAULT;
461 }
462 out:
463 kfree(params);
464 return err;
465 }
466
467 static int snd_pcm_hw_free(struct snd_pcm_substream *substream)
468 {
469 struct snd_pcm_runtime *runtime;
470 int result = 0;
471
472 snd_assert(substream != NULL, return -ENXIO);
473 runtime = substream->runtime;
474 snd_assert(runtime != NULL, return -ENXIO);
475 snd_pcm_stream_lock_irq(substream);
476 switch (runtime->status->state) {
477 case SNDRV_PCM_STATE_SETUP:
478 case SNDRV_PCM_STATE_PREPARED:
479 break;
480 default:
481 snd_pcm_stream_unlock_irq(substream);
482 return -EBADFD;
483 }
484 snd_pcm_stream_unlock_irq(substream);
485 if (atomic_read(&runtime->mmap_count))
486 return -EBADFD;
487 if (substream->ops->hw_free)
488 result = substream->ops->hw_free(substream);
489 runtime->status->state = SNDRV_PCM_STATE_OPEN;
490 return result;
491 }
492
493 static int snd_pcm_sw_params(struct snd_pcm_substream *substream,
494 struct snd_pcm_sw_params *params)
495 {
496 struct snd_pcm_runtime *runtime;
497
498 snd_assert(substream != NULL, return -ENXIO);
499 runtime = substream->runtime;
500 snd_assert(runtime != NULL, return -ENXIO);
501 snd_pcm_stream_lock_irq(substream);
502 if (runtime->status->state == SNDRV_PCM_STATE_OPEN) {
503 snd_pcm_stream_unlock_irq(substream);
504 return -EBADFD;
505 }
506 snd_pcm_stream_unlock_irq(substream);
507
508 if (params->tstamp_mode > SNDRV_PCM_TSTAMP_LAST)
509 return -EINVAL;
510 if (params->avail_min == 0)
511 return -EINVAL;
512 if (params->xfer_align == 0 ||
513 params->xfer_align % runtime->min_align != 0)
514 return -EINVAL;
515 if (params->silence_size >= runtime->boundary) {
516 if (params->silence_threshold != 0)
517 return -EINVAL;
518 } else {
519 if (params->silence_size > params->silence_threshold)
520 return -EINVAL;
521 if (params->silence_threshold > runtime->buffer_size)
522 return -EINVAL;
523 }
524 snd_pcm_stream_lock_irq(substream);
525 runtime->tstamp_mode = params->tstamp_mode;
526 runtime->sleep_min = params->sleep_min;
527 runtime->period_step = params->period_step;
528 runtime->control->avail_min = params->avail_min;
529 runtime->start_threshold = params->start_threshold;
530 runtime->stop_threshold = params->stop_threshold;
531 runtime->silence_threshold = params->silence_threshold;
532 runtime->silence_size = params->silence_size;
533 runtime->xfer_align = params->xfer_align;
534 params->boundary = runtime->boundary;
535 if (snd_pcm_running(substream)) {
536 if (runtime->sleep_min)
537 snd_pcm_tick_prepare(substream);
538 else
539 snd_pcm_tick_set(substream, 0);
540 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
541 runtime->silence_size > 0)
542 snd_pcm_playback_silence(substream, ULONG_MAX);
543 wake_up(&runtime->sleep);
544 }
545 snd_pcm_stream_unlock_irq(substream);
546 return 0;
547 }
548
549 static int snd_pcm_sw_params_user(struct snd_pcm_substream *substream,
550 struct snd_pcm_sw_params __user * _params)
551 {
552 struct snd_pcm_sw_params params;
553 int err;
554 if (copy_from_user(&params, _params, sizeof(params)))
555 return -EFAULT;
556 err = snd_pcm_sw_params(substream, &params);
557 if (copy_to_user(_params, &params, sizeof(params)))
558 return -EFAULT;
559 return err;
560 }
561
562 int snd_pcm_status(struct snd_pcm_substream *substream,
563 struct snd_pcm_status *status)
564 {
565 struct snd_pcm_runtime *runtime = substream->runtime;
566
567 snd_pcm_stream_lock_irq(substream);
568 status->state = runtime->status->state;
569 status->suspended_state = runtime->status->suspended_state;
570 if (status->state == SNDRV_PCM_STATE_OPEN)
571 goto _end;
572 status->trigger_tstamp = runtime->trigger_tstamp;
573 if (snd_pcm_running(substream)) {
574 snd_pcm_update_hw_ptr(substream);
575 if (runtime->tstamp_mode & SNDRV_PCM_TSTAMP_MMAP)
576 status->tstamp = runtime->status->tstamp;
577 else
578 getnstimeofday(&status->tstamp);
579 } else
580 getnstimeofday(&status->tstamp);
581 status->appl_ptr = runtime->control->appl_ptr;
582 status->hw_ptr = runtime->status->hw_ptr;
583 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
584 status->avail = snd_pcm_playback_avail(runtime);
585 if (runtime->status->state == SNDRV_PCM_STATE_RUNNING ||
586 runtime->status->state == SNDRV_PCM_STATE_DRAINING)
587 status->delay = runtime->buffer_size - status->avail;
588 else
589 status->delay = 0;
590 } else {
591 status->avail = snd_pcm_capture_avail(runtime);
592 if (runtime->status->state == SNDRV_PCM_STATE_RUNNING)
593 status->delay = status->avail;
594 else
595 status->delay = 0;
596 }
597 status->avail_max = runtime->avail_max;
598 status->overrange = runtime->overrange;
599 runtime->avail_max = 0;
600 runtime->overrange = 0;
601 _end:
602 snd_pcm_stream_unlock_irq(substream);
603 return 0;
604 }
605
606 static int snd_pcm_status_user(struct snd_pcm_substream *substream,
607 struct snd_pcm_status __user * _status)
608 {
609 struct snd_pcm_status status;
610 struct snd_pcm_runtime *runtime;
611 int res;
612
613 snd_assert(substream != NULL, return -ENXIO);
614 runtime = substream->runtime;
615 memset(&status, 0, sizeof(status));
616 res = snd_pcm_status(substream, &status);
617 if (res < 0)
618 return res;
619 if (copy_to_user(_status, &status, sizeof(status)))
620 return -EFAULT;
621 return 0;
622 }
623
624 static int snd_pcm_channel_info(struct snd_pcm_substream *substream,
625 struct snd_pcm_channel_info * info)
626 {
627 struct snd_pcm_runtime *runtime;
628 unsigned int channel;
629
630 snd_assert(substream != NULL, return -ENXIO);
631 channel = info->channel;
632 runtime = substream->runtime;
633 snd_pcm_stream_lock_irq(substream);
634 if (runtime->status->state == SNDRV_PCM_STATE_OPEN) {
635 snd_pcm_stream_unlock_irq(substream);
636 return -EBADFD;
637 }
638 snd_pcm_stream_unlock_irq(substream);
639 if (channel >= runtime->channels)
640 return -EINVAL;
641 memset(info, 0, sizeof(*info));
642 info->channel = channel;
643 return substream->ops->ioctl(substream, SNDRV_PCM_IOCTL1_CHANNEL_INFO, info);
644 }
645
646 static int snd_pcm_channel_info_user(struct snd_pcm_substream *substream,
647 struct snd_pcm_channel_info __user * _info)
648 {
649 struct snd_pcm_channel_info info;
650 int res;
651
652 if (copy_from_user(&info, _info, sizeof(info)))
653 return -EFAULT;
654 res = snd_pcm_channel_info(substream, &info);
655 if (res < 0)
656 return res;
657 if (copy_to_user(_info, &info, sizeof(info)))
658 return -EFAULT;
659 return 0;
660 }
661
662 static void snd_pcm_trigger_tstamp(struct snd_pcm_substream *substream)
663 {
664 struct snd_pcm_runtime *runtime = substream->runtime;
665 if (runtime->trigger_master == NULL)
666 return;
667 if (runtime->trigger_master == substream) {
668 getnstimeofday(&runtime->trigger_tstamp);
669 } else {
670 snd_pcm_trigger_tstamp(runtime->trigger_master);
671 runtime->trigger_tstamp = runtime->trigger_master->runtime->trigger_tstamp;
672 }
673 runtime->trigger_master = NULL;
674 }
675
676 struct action_ops {
677 int (*pre_action)(struct snd_pcm_substream *substream, int state);
678 int (*do_action)(struct snd_pcm_substream *substream, int state);
679 void (*undo_action)(struct snd_pcm_substream *substream, int state);
680 void (*post_action)(struct snd_pcm_substream *substream, int state);
681 };
682
683 /*
684 * this functions is core for handling of linked stream
685 * Note: the stream state might be changed also on failure
686 * Note2: call with calling stream lock + link lock
687 */
688 static int snd_pcm_action_group(struct action_ops *ops,
689 struct snd_pcm_substream *substream,
690 int state, int do_lock)
691 {
692 struct list_head *pos;
693 struct snd_pcm_substream *s = NULL;
694 struct snd_pcm_substream *s1;
695 int res = 0;
696
697 snd_pcm_group_for_each(pos, substream) {
698 s = snd_pcm_group_substream_entry(pos);
699 if (do_lock && s != substream)
700 spin_lock(&s->self_group.lock);
701 res = ops->pre_action(s, state);
702 if (res < 0)
703 goto _unlock;
704 }
705 snd_pcm_group_for_each(pos, substream) {
706 s = snd_pcm_group_substream_entry(pos);
707 res = ops->do_action(s, state);
708 if (res < 0) {
709 if (ops->undo_action) {
710 snd_pcm_group_for_each(pos, substream) {
711 s1 = snd_pcm_group_substream_entry(pos);
712 if (s1 == s) /* failed stream */
713 break;
714 ops->undo_action(s1, state);
715 }
716 }
717 s = NULL; /* unlock all */
718 goto _unlock;
719 }
720 }
721 snd_pcm_group_for_each(pos, substream) {
722 s = snd_pcm_group_substream_entry(pos);
723 ops->post_action(s, state);
724 }
725 _unlock:
726 if (do_lock) {
727 /* unlock streams */
728 snd_pcm_group_for_each(pos, substream) {
729 s1 = snd_pcm_group_substream_entry(pos);
730 if (s1 != substream)
731 spin_unlock(&s1->self_group.lock);
732 if (s1 == s) /* end */
733 break;
734 }
735 }
736 return res;
737 }
738
739 /*
740 * Note: call with stream lock
741 */
742 static int snd_pcm_action_single(struct action_ops *ops,
743 struct snd_pcm_substream *substream,
744 int state)
745 {
746 int res;
747
748 res = ops->pre_action(substream, state);
749 if (res < 0)
750 return res;
751 res = ops->do_action(substream, state);
752 if (res == 0)
753 ops->post_action(substream, state);
754 else if (ops->undo_action)
755 ops->undo_action(substream, state);
756 return res;
757 }
758
759 /*
760 * Note: call with stream lock
761 */
762 static int snd_pcm_action(struct action_ops *ops,
763 struct snd_pcm_substream *substream,
764 int state)
765 {
766 int res;
767
768 if (snd_pcm_stream_linked(substream)) {
769 if (!spin_trylock(&substream->group->lock)) {
770 spin_unlock(&substream->self_group.lock);
771 spin_lock(&substream->group->lock);
772 spin_lock(&substream->self_group.lock);
773 }
774 res = snd_pcm_action_group(ops, substream, state, 1);
775 spin_unlock(&substream->group->lock);
776 } else {
777 res = snd_pcm_action_single(ops, substream, state);
778 }
779 return res;
780 }
781
782 /*
783 * Note: don't use any locks before
784 */
785 static int snd_pcm_action_lock_irq(struct action_ops *ops,
786 struct snd_pcm_substream *substream,
787 int state)
788 {
789 int res;
790
791 read_lock_irq(&snd_pcm_link_rwlock);
792 if (snd_pcm_stream_linked(substream)) {
793 spin_lock(&substream->group->lock);
794 spin_lock(&substream->self_group.lock);
795 res = snd_pcm_action_group(ops, substream, state, 1);
796 spin_unlock(&substream->self_group.lock);
797 spin_unlock(&substream->group->lock);
798 } else {
799 spin_lock(&substream->self_group.lock);
800 res = snd_pcm_action_single(ops, substream, state);
801 spin_unlock(&substream->self_group.lock);
802 }
803 read_unlock_irq(&snd_pcm_link_rwlock);
804 return res;
805 }
806
807 /*
808 */
809 static int snd_pcm_action_nonatomic(struct action_ops *ops,
810 struct snd_pcm_substream *substream,
811 int state)
812 {
813 int res;
814
815 down_read(&snd_pcm_link_rwsem);
816 if (snd_pcm_stream_linked(substream))
817 res = snd_pcm_action_group(ops, substream, state, 0);
818 else
819 res = snd_pcm_action_single(ops, substream, state);
820 up_read(&snd_pcm_link_rwsem);
821 return res;
822 }
823
824 /*
825 * start callbacks
826 */
827 static int snd_pcm_pre_start(struct snd_pcm_substream *substream, int state)
828 {
829 struct snd_pcm_runtime *runtime = substream->runtime;
830 if (runtime->status->state != SNDRV_PCM_STATE_PREPARED)
831 return -EBADFD;
832 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
833 !snd_pcm_playback_data(substream))
834 return -EPIPE;
835 runtime->trigger_master = substream;
836 return 0;
837 }
838
839 static int snd_pcm_do_start(struct snd_pcm_substream *substream, int state)
840 {
841 if (substream->runtime->trigger_master != substream)
842 return 0;
843 return substream->ops->trigger(substream, SNDRV_PCM_TRIGGER_START);
844 }
845
846 static void snd_pcm_undo_start(struct snd_pcm_substream *substream, int state)
847 {
848 if (substream->runtime->trigger_master == substream)
849 substream->ops->trigger(substream, SNDRV_PCM_TRIGGER_STOP);
850 }
851
852 static void snd_pcm_post_start(struct snd_pcm_substream *substream, int state)
853 {
854 struct snd_pcm_runtime *runtime = substream->runtime;
855 snd_pcm_trigger_tstamp(substream);
856 runtime->status->state = state;
857 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
858 runtime->silence_size > 0)
859 snd_pcm_playback_silence(substream, ULONG_MAX);
860 if (runtime->sleep_min)
861 snd_pcm_tick_prepare(substream);
862 if (substream->timer)
863 snd_timer_notify(substream->timer, SNDRV_TIMER_EVENT_MSTART,
864 &runtime->trigger_tstamp);
865 }
866
867 static struct action_ops snd_pcm_action_start = {
868 .pre_action = snd_pcm_pre_start,
869 .do_action = snd_pcm_do_start,
870 .undo_action = snd_pcm_undo_start,
871 .post_action = snd_pcm_post_start
872 };
873
874 /**
875 * snd_pcm_start
876 * @substream: the PCM substream instance
877 *
878 * Start all linked streams.
879 */
880 int snd_pcm_start(struct snd_pcm_substream *substream)
881 {
882 return snd_pcm_action(&snd_pcm_action_start, substream,
883 SNDRV_PCM_STATE_RUNNING);
884 }
885
886 /*
887 * stop callbacks
888 */
889 static int snd_pcm_pre_stop(struct snd_pcm_substream *substream, int state)
890 {
891 struct snd_pcm_runtime *runtime = substream->runtime;
892 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
893 return -EBADFD;
894 runtime->trigger_master = substream;
895 return 0;
896 }
897
898 static int snd_pcm_do_stop(struct snd_pcm_substream *substream, int state)
899 {
900 if (substream->runtime->trigger_master == substream &&
901 snd_pcm_running(substream))
902 substream->ops->trigger(substream, SNDRV_PCM_TRIGGER_STOP);
903 return 0; /* unconditonally stop all substreams */
904 }
905
906 static void snd_pcm_post_stop(struct snd_pcm_substream *substream, int state)
907 {
908 struct snd_pcm_runtime *runtime = substream->runtime;
909 if (runtime->status->state != state) {
910 snd_pcm_trigger_tstamp(substream);
911 if (substream->timer)
912 snd_timer_notify(substream->timer, SNDRV_TIMER_EVENT_MSTOP,
913 &runtime->trigger_tstamp);
914 runtime->status->state = state;
915 snd_pcm_tick_set(substream, 0);
916 }
917 wake_up(&runtime->sleep);
918 }
919
920 static struct action_ops snd_pcm_action_stop = {
921 .pre_action = snd_pcm_pre_stop,
922 .do_action = snd_pcm_do_stop,
923 .post_action = snd_pcm_post_stop
924 };
925
926 /**
927 * snd_pcm_stop
928 * @substream: the PCM substream instance
929 * @state: PCM state after stopping the stream
930 *
931 * Try to stop all running streams in the substream group.
932 * The state of each stream is changed to the given value after that unconditionally.
933 */
934 int snd_pcm_stop(struct snd_pcm_substream *substream, int state)
935 {
936 return snd_pcm_action(&snd_pcm_action_stop, substream, state);
937 }
938
939 /**
940 * snd_pcm_drain_done
941 * @substream: the PCM substream
942 *
943 * Stop the DMA only when the given stream is playback.
944 * The state is changed to SETUP.
945 * Unlike snd_pcm_stop(), this affects only the given stream.
946 */
947 int snd_pcm_drain_done(struct snd_pcm_substream *substream)
948 {
949 return snd_pcm_action_single(&snd_pcm_action_stop, substream,
950 SNDRV_PCM_STATE_SETUP);
951 }
952
953 /*
954 * pause callbacks
955 */
956 static int snd_pcm_pre_pause(struct snd_pcm_substream *substream, int push)
957 {
958 struct snd_pcm_runtime *runtime = substream->runtime;
959 if (!(runtime->info & SNDRV_PCM_INFO_PAUSE))
960 return -ENOSYS;
961 if (push) {
962 if (runtime->status->state != SNDRV_PCM_STATE_RUNNING)
963 return -EBADFD;
964 } else if (runtime->status->state != SNDRV_PCM_STATE_PAUSED)
965 return -EBADFD;
966 runtime->trigger_master = substream;
967 return 0;
968 }
969
970 static int snd_pcm_do_pause(struct snd_pcm_substream *substream, int push)
971 {
972 if (substream->runtime->trigger_master != substream)
973 return 0;
974 return substream->ops->trigger(substream,
975 push ? SNDRV_PCM_TRIGGER_PAUSE_PUSH :
976 SNDRV_PCM_TRIGGER_PAUSE_RELEASE);
977 }
978
979 static void snd_pcm_undo_pause(struct snd_pcm_substream *substream, int push)
980 {
981 if (substream->runtime->trigger_master == substream)
982 substream->ops->trigger(substream,
983 push ? SNDRV_PCM_TRIGGER_PAUSE_RELEASE :
984 SNDRV_PCM_TRIGGER_PAUSE_PUSH);
985 }
986
987 static void snd_pcm_post_pause(struct snd_pcm_substream *substream, int push)
988 {
989 struct snd_pcm_runtime *runtime = substream->runtime;
990 snd_pcm_trigger_tstamp(substream);
991 if (push) {
992 runtime->status->state = SNDRV_PCM_STATE_PAUSED;
993 if (substream->timer)
994 snd_timer_notify(substream->timer,
995 SNDRV_TIMER_EVENT_MPAUSE,
996 &runtime->trigger_tstamp);
997 snd_pcm_tick_set(substream, 0);
998 wake_up(&runtime->sleep);
999 } else {
1000 runtime->status->state = SNDRV_PCM_STATE_RUNNING;
1001 if (runtime->sleep_min)
1002 snd_pcm_tick_prepare(substream);
1003 if (substream->timer)
1004 snd_timer_notify(substream->timer,
1005 SNDRV_TIMER_EVENT_MCONTINUE,
1006 &runtime->trigger_tstamp);
1007 }
1008 }
1009
1010 static struct action_ops snd_pcm_action_pause = {
1011 .pre_action = snd_pcm_pre_pause,
1012 .do_action = snd_pcm_do_pause,
1013 .undo_action = snd_pcm_undo_pause,
1014 .post_action = snd_pcm_post_pause
1015 };
1016
1017 /*
1018 * Push/release the pause for all linked streams.
1019 */
1020 static int snd_pcm_pause(struct snd_pcm_substream *substream, int push)
1021 {
1022 return snd_pcm_action(&snd_pcm_action_pause, substream, push);
1023 }
1024
1025 #ifdef CONFIG_PM
1026 /* suspend */
1027
1028 static int snd_pcm_pre_suspend(struct snd_pcm_substream *substream, int state)
1029 {
1030 struct snd_pcm_runtime *runtime = substream->runtime;
1031 if (runtime->status->state == SNDRV_PCM_STATE_SUSPENDED)
1032 return -EBUSY;
1033 runtime->trigger_master = substream;
1034 return 0;
1035 }
1036
1037 static int snd_pcm_do_suspend(struct snd_pcm_substream *substream, int state)
1038 {
1039 struct snd_pcm_runtime *runtime = substream->runtime;
1040 if (runtime->trigger_master != substream)
1041 return 0;
1042 if (! snd_pcm_running(substream))
1043 return 0;
1044 substream->ops->trigger(substream, SNDRV_PCM_TRIGGER_SUSPEND);
1045 return 0; /* suspend unconditionally */
1046 }
1047
1048 static void snd_pcm_post_suspend(struct snd_pcm_substream *substream, int state)
1049 {
1050 struct snd_pcm_runtime *runtime = substream->runtime;
1051 snd_pcm_trigger_tstamp(substream);
1052 if (substream->timer)
1053 snd_timer_notify(substream->timer, SNDRV_TIMER_EVENT_MSUSPEND,
1054 &runtime->trigger_tstamp);
1055 runtime->status->suspended_state = runtime->status->state;
1056 runtime->status->state = SNDRV_PCM_STATE_SUSPENDED;
1057 snd_pcm_tick_set(substream, 0);
1058 wake_up(&runtime->sleep);
1059 }
1060
1061 static struct action_ops snd_pcm_action_suspend = {
1062 .pre_action = snd_pcm_pre_suspend,
1063 .do_action = snd_pcm_do_suspend,
1064 .post_action = snd_pcm_post_suspend
1065 };
1066
1067 /**
1068 * snd_pcm_suspend
1069 * @substream: the PCM substream
1070 *
1071 * Trigger SUSPEND to all linked streams.
1072 * After this call, all streams are changed to SUSPENDED state.
1073 */
1074 int snd_pcm_suspend(struct snd_pcm_substream *substream)
1075 {
1076 int err;
1077 unsigned long flags;
1078
1079 if (! substream)
1080 return 0;
1081
1082 snd_pcm_stream_lock_irqsave(substream, flags);
1083 err = snd_pcm_action(&snd_pcm_action_suspend, substream, 0);
1084 snd_pcm_stream_unlock_irqrestore(substream, flags);
1085 return err;
1086 }
1087
1088 /**
1089 * snd_pcm_suspend_all
1090 * @pcm: the PCM instance
1091 *
1092 * Trigger SUSPEND to all substreams in the given pcm.
1093 * After this call, all streams are changed to SUSPENDED state.
1094 */
1095 int snd_pcm_suspend_all(struct snd_pcm *pcm)
1096 {
1097 struct snd_pcm_substream *substream;
1098 int stream, err = 0;
1099
1100 if (! pcm)
1101 return 0;
1102
1103 for (stream = 0; stream < 2; stream++) {
1104 for (substream = pcm->streams[stream].substream;
1105 substream; substream = substream->next) {
1106 /* FIXME: the open/close code should lock this as well */
1107 if (substream->runtime == NULL)
1108 continue;
1109 err = snd_pcm_suspend(substream);
1110 if (err < 0 && err != -EBUSY)
1111 return err;
1112 }
1113 }
1114 return 0;
1115 }
1116
1117 /* resume */
1118
1119 static int snd_pcm_pre_resume(struct snd_pcm_substream *substream, int state)
1120 {
1121 struct snd_pcm_runtime *runtime = substream->runtime;
1122 if (!(runtime->info & SNDRV_PCM_INFO_RESUME))
1123 return -ENOSYS;
1124 runtime->trigger_master = substream;
1125 return 0;
1126 }
1127
1128 static int snd_pcm_do_resume(struct snd_pcm_substream *substream, int state)
1129 {
1130 struct snd_pcm_runtime *runtime = substream->runtime;
1131 if (runtime->trigger_master != substream)
1132 return 0;
1133 /* DMA not running previously? */
1134 if (runtime->status->suspended_state != SNDRV_PCM_STATE_RUNNING &&
1135 (runtime->status->suspended_state != SNDRV_PCM_STATE_DRAINING ||
1136 substream->stream != SNDRV_PCM_STREAM_PLAYBACK))
1137 return 0;
1138 return substream->ops->trigger(substream, SNDRV_PCM_TRIGGER_RESUME);
1139 }
1140
1141 static void snd_pcm_undo_resume(struct snd_pcm_substream *substream, int state)
1142 {
1143 if (substream->runtime->trigger_master == substream &&
1144 snd_pcm_running(substream))
1145 substream->ops->trigger(substream, SNDRV_PCM_TRIGGER_SUSPEND);
1146 }
1147
1148 static void snd_pcm_post_resume(struct snd_pcm_substream *substream, int state)
1149 {
1150 struct snd_pcm_runtime *runtime = substream->runtime;
1151 snd_pcm_trigger_tstamp(substream);
1152 if (substream->timer)
1153 snd_timer_notify(substream->timer, SNDRV_TIMER_EVENT_MRESUME,
1154 &runtime->trigger_tstamp);
1155 runtime->status->state = runtime->status->suspended_state;
1156 if (runtime->sleep_min)
1157 snd_pcm_tick_prepare(substream);
1158 }
1159
1160 static struct action_ops snd_pcm_action_resume = {
1161 .pre_action = snd_pcm_pre_resume,
1162 .do_action = snd_pcm_do_resume,
1163 .undo_action = snd_pcm_undo_resume,
1164 .post_action = snd_pcm_post_resume
1165 };
1166
1167 static int snd_pcm_resume(struct snd_pcm_substream *substream)
1168 {
1169 struct snd_card *card = substream->pcm->card;
1170 int res;
1171
1172 snd_power_lock(card);
1173 if ((res = snd_power_wait(card, SNDRV_CTL_POWER_D0)) >= 0)
1174 res = snd_pcm_action_lock_irq(&snd_pcm_action_resume, substream, 0);
1175 snd_power_unlock(card);
1176 return res;
1177 }
1178
1179 #else
1180
1181 static int snd_pcm_resume(struct snd_pcm_substream *substream)
1182 {
1183 return -ENOSYS;
1184 }
1185
1186 #endif /* CONFIG_PM */
1187
1188 /*
1189 * xrun ioctl
1190 *
1191 * Change the RUNNING stream(s) to XRUN state.
1192 */
1193 static int snd_pcm_xrun(struct snd_pcm_substream *substream)
1194 {
1195 struct snd_card *card = substream->pcm->card;
1196 struct snd_pcm_runtime *runtime = substream->runtime;
1197 int result;
1198
1199 snd_power_lock(card);
1200 if (runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1201 result = snd_power_wait(card, SNDRV_CTL_POWER_D0);
1202 if (result < 0)
1203 goto _unlock;
1204 }
1205
1206 snd_pcm_stream_lock_irq(substream);
1207 switch (runtime->status->state) {
1208 case SNDRV_PCM_STATE_XRUN:
1209 result = 0; /* already there */
1210 break;
1211 case SNDRV_PCM_STATE_RUNNING:
1212 result = snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN);
1213 break;
1214 default:
1215 result = -EBADFD;
1216 }
1217 snd_pcm_stream_unlock_irq(substream);
1218 _unlock:
1219 snd_power_unlock(card);
1220 return result;
1221 }
1222
1223 /*
1224 * reset ioctl
1225 */
1226 static int snd_pcm_pre_reset(struct snd_pcm_substream *substream, int state)
1227 {
1228 struct snd_pcm_runtime *runtime = substream->runtime;
1229 switch (runtime->status->state) {
1230 case SNDRV_PCM_STATE_RUNNING:
1231 case SNDRV_PCM_STATE_PREPARED:
1232 case SNDRV_PCM_STATE_PAUSED:
1233 case SNDRV_PCM_STATE_SUSPENDED:
1234 return 0;
1235 default:
1236 return -EBADFD;
1237 }
1238 }
1239
1240 static int snd_pcm_do_reset(struct snd_pcm_substream *substream, int state)
1241 {
1242 struct snd_pcm_runtime *runtime = substream->runtime;
1243 int err = substream->ops->ioctl(substream, SNDRV_PCM_IOCTL1_RESET, NULL);
1244 if (err < 0)
1245 return err;
1246 // snd_assert(runtime->status->hw_ptr < runtime->buffer_size, );
1247 runtime->hw_ptr_base = 0;
1248 runtime->hw_ptr_interrupt = runtime->status->hw_ptr -
1249 runtime->status->hw_ptr % runtime->period_size;
1250 runtime->silence_start = runtime->status->hw_ptr;
1251 runtime->silence_filled = 0;
1252 return 0;
1253 }
1254
1255 static void snd_pcm_post_reset(struct snd_pcm_substream *substream, int state)
1256 {
1257 struct snd_pcm_runtime *runtime = substream->runtime;
1258 runtime->control->appl_ptr = runtime->status->hw_ptr;
1259 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
1260 runtime->silence_size > 0)
1261 snd_pcm_playback_silence(substream, ULONG_MAX);
1262 }
1263
1264 static struct action_ops snd_pcm_action_reset = {
1265 .pre_action = snd_pcm_pre_reset,
1266 .do_action = snd_pcm_do_reset,
1267 .post_action = snd_pcm_post_reset
1268 };
1269
1270 static int snd_pcm_reset(struct snd_pcm_substream *substream)
1271 {
1272 return snd_pcm_action_nonatomic(&snd_pcm_action_reset, substream, 0);
1273 }
1274
1275 /*
1276 * prepare ioctl
1277 */
1278 static int snd_pcm_pre_prepare(struct snd_pcm_substream *substream, int state)
1279 {
1280 struct snd_pcm_runtime *runtime = substream->runtime;
1281 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
1282 return -EBADFD;
1283 if (snd_pcm_running(substream))
1284 return -EBUSY;
1285 return 0;
1286 }
1287
1288 static int snd_pcm_do_prepare(struct snd_pcm_substream *substream, int state)
1289 {
1290 int err;
1291 err = substream->ops->prepare(substream);
1292 if (err < 0)
1293 return err;
1294 return snd_pcm_do_reset(substream, 0);
1295 }
1296
1297 static void snd_pcm_post_prepare(struct snd_pcm_substream *substream, int state)
1298 {
1299 struct snd_pcm_runtime *runtime = substream->runtime;
1300 runtime->control->appl_ptr = runtime->status->hw_ptr;
1301 runtime->status->state = SNDRV_PCM_STATE_PREPARED;
1302 }
1303
1304 static struct action_ops snd_pcm_action_prepare = {
1305 .pre_action = snd_pcm_pre_prepare,
1306 .do_action = snd_pcm_do_prepare,
1307 .post_action = snd_pcm_post_prepare
1308 };
1309
1310 /**
1311 * snd_pcm_prepare
1312 * @substream: the PCM substream instance
1313 *
1314 * Prepare the PCM substream to be triggerable.
1315 */
1316 static int snd_pcm_prepare(struct snd_pcm_substream *substream)
1317 {
1318 int res;
1319 struct snd_card *card = substream->pcm->card;
1320
1321 snd_power_lock(card);
1322 if ((res = snd_power_wait(card, SNDRV_CTL_POWER_D0)) >= 0)
1323 res = snd_pcm_action_nonatomic(&snd_pcm_action_prepare, substream, 0);
1324 snd_power_unlock(card);
1325 return res;
1326 }
1327
1328 /*
1329 * drain ioctl
1330 */
1331
1332 static int snd_pcm_pre_drain_init(struct snd_pcm_substream *substream, int state)
1333 {
1334 if (substream->ffile->f_flags & O_NONBLOCK)
1335 return -EAGAIN;
1336 substream->runtime->trigger_master = substream;
1337 return 0;
1338 }
1339
1340 static int snd_pcm_do_drain_init(struct snd_pcm_substream *substream, int state)
1341 {
1342 struct snd_pcm_runtime *runtime = substream->runtime;
1343 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1344 switch (runtime->status->state) {
1345 case SNDRV_PCM_STATE_PREPARED:
1346 /* start playback stream if possible */
1347 if (! snd_pcm_playback_empty(substream)) {
1348 snd_pcm_do_start(substream, SNDRV_PCM_STATE_DRAINING);
1349 snd_pcm_post_start(substream, SNDRV_PCM_STATE_DRAINING);
1350 }
1351 break;
1352 case SNDRV_PCM_STATE_RUNNING:
1353 runtime->status->state = SNDRV_PCM_STATE_DRAINING;
1354 break;
1355 default:
1356 break;
1357 }
1358 } else {
1359 /* stop running stream */
1360 if (runtime->status->state == SNDRV_PCM_STATE_RUNNING) {
1361 int state = snd_pcm_capture_avail(runtime) > 0 ?
1362 SNDRV_PCM_STATE_DRAINING : SNDRV_PCM_STATE_SETUP;
1363 snd_pcm_do_stop(substream, state);
1364 snd_pcm_post_stop(substream, state);
1365 }
1366 }
1367 return 0;
1368 }
1369
1370 static void snd_pcm_post_drain_init(struct snd_pcm_substream *substream, int state)
1371 {
1372 }
1373
1374 static struct action_ops snd_pcm_action_drain_init = {
1375 .pre_action = snd_pcm_pre_drain_init,
1376 .do_action = snd_pcm_do_drain_init,
1377 .post_action = snd_pcm_post_drain_init
1378 };
1379
1380 struct drain_rec {
1381 struct snd_pcm_substream *substream;
1382 wait_queue_t wait;
1383 snd_pcm_uframes_t stop_threshold;
1384 };
1385
1386 static int snd_pcm_drop(struct snd_pcm_substream *substream);
1387
1388 /*
1389 * Drain the stream(s).
1390 * When the substream is linked, sync until the draining of all playback streams
1391 * is finished.
1392 * After this call, all streams are supposed to be either SETUP or DRAINING
1393 * (capture only) state.
1394 */
1395 static int snd_pcm_drain(struct snd_pcm_substream *substream)
1396 {
1397 struct snd_card *card;
1398 struct snd_pcm_runtime *runtime;
1399 struct list_head *pos;
1400 int result = 0;
1401 int i, num_drecs;
1402 struct drain_rec *drec, drec_tmp, *d;
1403
1404 snd_assert(substream != NULL, return -ENXIO);
1405 card = substream->pcm->card;
1406 runtime = substream->runtime;
1407
1408 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
1409 return -EBADFD;
1410
1411 snd_power_lock(card);
1412 if (runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1413 result = snd_power_wait(card, SNDRV_CTL_POWER_D0);
1414 if (result < 0) {
1415 snd_power_unlock(card);
1416 return result;
1417 }
1418 }
1419
1420 /* allocate temporary record for drain sync */
1421 down_read(&snd_pcm_link_rwsem);
1422 if (snd_pcm_stream_linked(substream)) {
1423 drec = kmalloc(substream->group->count * sizeof(*drec), GFP_KERNEL);
1424 if (! drec) {
1425 up_read(&snd_pcm_link_rwsem);
1426 snd_power_unlock(card);
1427 return -ENOMEM;
1428 }
1429 } else
1430 drec = &drec_tmp;
1431
1432 /* count only playback streams */
1433 num_drecs = 0;
1434 snd_pcm_group_for_each(pos, substream) {
1435 struct snd_pcm_substream *s = snd_pcm_group_substream_entry(pos);
1436 runtime = s->runtime;
1437 if (s->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1438 d = &drec[num_drecs++];
1439 d->substream = s;
1440 init_waitqueue_entry(&d->wait, current);
1441 add_wait_queue(&runtime->sleep, &d->wait);
1442 /* stop_threshold fixup to avoid endless loop when
1443 * stop_threshold > buffer_size
1444 */
1445 d->stop_threshold = runtime->stop_threshold;
1446 if (runtime->stop_threshold > runtime->buffer_size)
1447 runtime->stop_threshold = runtime->buffer_size;
1448 }
1449 }
1450 up_read(&snd_pcm_link_rwsem);
1451 if (! num_drecs)
1452 goto _error;
1453
1454 snd_pcm_stream_lock_irq(substream);
1455 /* resume pause */
1456 if (runtime->status->state == SNDRV_PCM_STATE_PAUSED)
1457 snd_pcm_pause(substream, 0);
1458
1459 /* pre-start/stop - all running streams are changed to DRAINING state */
1460 result = snd_pcm_action(&snd_pcm_action_drain_init, substream, 0);
1461 if (result < 0) {
1462 snd_pcm_stream_unlock_irq(substream);
1463 goto _error;
1464 }
1465
1466 for (;;) {
1467 long tout;
1468 if (signal_pending(current)) {
1469 result = -ERESTARTSYS;
1470 break;
1471 }
1472 /* all finished? */
1473 for (i = 0; i < num_drecs; i++) {
1474 runtime = drec[i].substream->runtime;
1475 if (runtime->status->state == SNDRV_PCM_STATE_DRAINING)
1476 break;
1477 }
1478 if (i == num_drecs)
1479 break; /* yes, all drained */
1480
1481 set_current_state(TASK_INTERRUPTIBLE);
1482 snd_pcm_stream_unlock_irq(substream);
1483 snd_power_unlock(card);
1484 tout = schedule_timeout(10 * HZ);
1485 snd_power_lock(card);
1486 snd_pcm_stream_lock_irq(substream);
1487 if (tout == 0) {
1488 if (substream->runtime->status->state == SNDRV_PCM_STATE_SUSPENDED)
1489 result = -ESTRPIPE;
1490 else {
1491 snd_printd("playback drain error (DMA or IRQ trouble?)\n");
1492 snd_pcm_stop(substream, SNDRV_PCM_STATE_SETUP);
1493 result = -EIO;
1494 }
1495 break;
1496 }
1497 }
1498
1499 snd_pcm_stream_unlock_irq(substream);
1500
1501 _error:
1502 for (i = 0; i < num_drecs; i++) {
1503 d = &drec[i];
1504 runtime = d->substream->runtime;
1505 remove_wait_queue(&runtime->sleep, &d->wait);
1506 runtime->stop_threshold = d->stop_threshold;
1507 }
1508
1509 if (drec != &drec_tmp)
1510 kfree(drec);
1511 snd_power_unlock(card);
1512
1513 return result;
1514 }
1515
1516 /*
1517 * drop ioctl
1518 *
1519 * Immediately put all linked substreams into SETUP state.
1520 */
1521 static int snd_pcm_drop(struct snd_pcm_substream *substream)
1522 {
1523 struct snd_pcm_runtime *runtime;
1524 struct snd_card *card;
1525 int result = 0;
1526
1527 snd_assert(substream != NULL, return -ENXIO);
1528 runtime = substream->runtime;
1529 card = substream->pcm->card;
1530
1531 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
1532 return -EBADFD;
1533
1534 snd_power_lock(card);
1535 if (runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1536 result = snd_power_wait(card, SNDRV_CTL_POWER_D0);
1537 if (result < 0)
1538 goto _unlock;
1539 }
1540
1541 snd_pcm_stream_lock_irq(substream);
1542 /* resume pause */
1543 if (runtime->status->state == SNDRV_PCM_STATE_PAUSED)
1544 snd_pcm_pause(substream, 0);
1545
1546 snd_pcm_stop(substream, SNDRV_PCM_STATE_SETUP);
1547 /* runtime->control->appl_ptr = runtime->status->hw_ptr; */
1548 snd_pcm_stream_unlock_irq(substream);
1549 _unlock:
1550 snd_power_unlock(card);
1551 return result;
1552 }
1553
1554
1555 /* WARNING: Don't forget to fput back the file */
1556 static struct file *snd_pcm_file_fd(int fd)
1557 {
1558 struct file *file;
1559 struct inode *inode;
1560 unsigned int minor;
1561
1562 file = fget(fd);
1563 if (!file)
1564 return NULL;
1565 inode = file->f_dentry->d_inode;
1566 if (!S_ISCHR(inode->i_mode) ||
1567 imajor(inode) != snd_major) {
1568 fput(file);
1569 return NULL;
1570 }
1571 minor = iminor(inode);
1572 if (!snd_lookup_minor_data(minor, SNDRV_DEVICE_TYPE_PCM_PLAYBACK) &&
1573 !snd_lookup_minor_data(minor, SNDRV_DEVICE_TYPE_PCM_CAPTURE)) {
1574 fput(file);
1575 return NULL;
1576 }
1577 return file;
1578 }
1579
1580 /*
1581 * PCM link handling
1582 */
1583 static int snd_pcm_link(struct snd_pcm_substream *substream, int fd)
1584 {
1585 int res = 0;
1586 struct file *file;
1587 struct snd_pcm_file *pcm_file;
1588 struct snd_pcm_substream *substream1;
1589
1590 file = snd_pcm_file_fd(fd);
1591 if (!file)
1592 return -EBADFD;
1593 pcm_file = file->private_data;
1594 substream1 = pcm_file->substream;
1595 down_write(&snd_pcm_link_rwsem);
1596 write_lock_irq(&snd_pcm_link_rwlock);
1597 if (substream->runtime->status->state == SNDRV_PCM_STATE_OPEN ||
1598 substream->runtime->status->state != substream1->runtime->status->state) {
1599 res = -EBADFD;
1600 goto _end;
1601 }
1602 if (snd_pcm_stream_linked(substream1)) {
1603 res = -EALREADY;
1604 goto _end;
1605 }
1606 if (!snd_pcm_stream_linked(substream)) {
1607 substream->group = kmalloc(sizeof(struct snd_pcm_group), GFP_ATOMIC);
1608 if (substream->group == NULL) {
1609 res = -ENOMEM;
1610 goto _end;
1611 }
1612 spin_lock_init(&substream->group->lock);
1613 INIT_LIST_HEAD(&substream->group->substreams);
1614 list_add_tail(&substream->link_list, &substream->group->substreams);
1615 substream->group->count = 1;
1616 }
1617 list_add_tail(&substream1->link_list, &substream->group->substreams);
1618 substream->group->count++;
1619 substream1->group = substream->group;
1620 _end:
1621 write_unlock_irq(&snd_pcm_link_rwlock);
1622 up_write(&snd_pcm_link_rwsem);
1623 fput(file);
1624 return res;
1625 }
1626
1627 static void relink_to_local(struct snd_pcm_substream *substream)
1628 {
1629 substream->group = &substream->self_group;
1630 INIT_LIST_HEAD(&substream->self_group.substreams);
1631 list_add_tail(&substream->link_list, &substream->self_group.substreams);
1632 }
1633
1634 static int snd_pcm_unlink(struct snd_pcm_substream *substream)
1635 {
1636 struct list_head *pos;
1637 int res = 0;
1638
1639 down_write(&snd_pcm_link_rwsem);
1640 write_lock_irq(&snd_pcm_link_rwlock);
1641 if (!snd_pcm_stream_linked(substream)) {
1642 res = -EALREADY;
1643 goto _end;
1644 }
1645 list_del(&substream->link_list);
1646 substream->group->count--;
1647 if (substream->group->count == 1) { /* detach the last stream, too */
1648 snd_pcm_group_for_each(pos, substream) {
1649 relink_to_local(snd_pcm_group_substream_entry(pos));
1650 break;
1651 }
1652 kfree(substream->group);
1653 }
1654 relink_to_local(substream);
1655 _end:
1656 write_unlock_irq(&snd_pcm_link_rwlock);
1657 up_write(&snd_pcm_link_rwsem);
1658 return res;
1659 }
1660
1661 /*
1662 * hw configurator
1663 */
1664 static int snd_pcm_hw_rule_mul(struct snd_pcm_hw_params *params,
1665 struct snd_pcm_hw_rule *rule)
1666 {
1667 struct snd_interval t;
1668 snd_interval_mul(hw_param_interval_c(params, rule->deps[0]),
1669 hw_param_interval_c(params, rule->deps[1]), &t);
1670 return snd_interval_refine(hw_param_interval(params, rule->var), &t);
1671 }
1672
1673 static int snd_pcm_hw_rule_div(struct snd_pcm_hw_params *params,
1674 struct snd_pcm_hw_rule *rule)
1675 {
1676 struct snd_interval t;
1677 snd_interval_div(hw_param_interval_c(params, rule->deps[0]),
1678 hw_param_interval_c(params, rule->deps[1]), &t);
1679 return snd_interval_refine(hw_param_interval(params, rule->var), &t);
1680 }
1681
1682 static int snd_pcm_hw_rule_muldivk(struct snd_pcm_hw_params *params,
1683 struct snd_pcm_hw_rule *rule)
1684 {
1685 struct snd_interval t;
1686 snd_interval_muldivk(hw_param_interval_c(params, rule->deps[0]),
1687 hw_param_interval_c(params, rule->deps[1]),
1688 (unsigned long) rule->private, &t);
1689 return snd_interval_refine(hw_param_interval(params, rule->var), &t);
1690 }
1691
1692 static int snd_pcm_hw_rule_mulkdiv(struct snd_pcm_hw_params *params,
1693 struct snd_pcm_hw_rule *rule)
1694 {
1695 struct snd_interval t;
1696 snd_interval_mulkdiv(hw_param_interval_c(params, rule->deps[0]),
1697 (unsigned long) rule->private,
1698 hw_param_interval_c(params, rule->deps[1]), &t);
1699 return snd_interval_refine(hw_param_interval(params, rule->var), &t);
1700 }
1701
1702 static int snd_pcm_hw_rule_format(struct snd_pcm_hw_params *params,
1703 struct snd_pcm_hw_rule *rule)
1704 {
1705 unsigned int k;
1706 struct snd_interval *i = hw_param_interval(params, rule->deps[0]);
1707 struct snd_mask m;
1708 struct snd_mask *mask = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
1709 snd_mask_any(&m);
1710 for (k = 0; k <= SNDRV_PCM_FORMAT_LAST; ++k) {
1711 int bits;
1712 if (! snd_mask_test(mask, k))
1713 continue;
1714 bits = snd_pcm_format_physical_width(k);
1715 if (bits <= 0)
1716 continue; /* ignore invalid formats */
1717 if ((unsigned)bits < i->min || (unsigned)bits > i->max)
1718 snd_mask_reset(&m, k);
1719 }
1720 return snd_mask_refine(mask, &m);
1721 }
1722
1723 static int snd_pcm_hw_rule_sample_bits(struct snd_pcm_hw_params *params,
1724 struct snd_pcm_hw_rule *rule)
1725 {
1726 struct snd_interval t;
1727 unsigned int k;
1728 t.min = UINT_MAX;
1729 t.max = 0;
1730 t.openmin = 0;
1731 t.openmax = 0;
1732 for (k = 0; k <= SNDRV_PCM_FORMAT_LAST; ++k) {
1733 int bits;
1734 if (! snd_mask_test(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT), k))
1735 continue;
1736 bits = snd_pcm_format_physical_width(k);
1737 if (bits <= 0)
1738 continue; /* ignore invalid formats */
1739 if (t.min > (unsigned)bits)
1740 t.min = bits;
1741 if (t.max < (unsigned)bits)
1742 t.max = bits;
1743 }
1744 t.integer = 1;
1745 return snd_interval_refine(hw_param_interval(params, rule->var), &t);
1746 }
1747
1748 #if SNDRV_PCM_RATE_5512 != 1 << 0 || SNDRV_PCM_RATE_192000 != 1 << 12
1749 #error "Change this table"
1750 #endif
1751
1752 static unsigned int rates[] = { 5512, 8000, 11025, 16000, 22050, 32000, 44100,
1753 48000, 64000, 88200, 96000, 176400, 192000 };
1754
1755 static int snd_pcm_hw_rule_rate(struct snd_pcm_hw_params *params,
1756 struct snd_pcm_hw_rule *rule)
1757 {
1758 struct snd_pcm_hardware *hw = rule->private;
1759 return snd_interval_list(hw_param_interval(params, rule->var),
1760 ARRAY_SIZE(rates), rates, hw->rates);
1761 }
1762
1763 static int snd_pcm_hw_rule_buffer_bytes_max(struct snd_pcm_hw_params *params,
1764 struct snd_pcm_hw_rule *rule)
1765 {
1766 struct snd_interval t;
1767 struct snd_pcm_substream *substream = rule->private;
1768 t.min = 0;
1769 t.max = substream->buffer_bytes_max;
1770 t.openmin = 0;
1771 t.openmax = 0;
1772 t.integer = 1;
1773 return snd_interval_refine(hw_param_interval(params, rule->var), &t);
1774 }
1775
1776 int snd_pcm_hw_constraints_init(struct snd_pcm_substream *substream)
1777 {
1778 struct snd_pcm_runtime *runtime = substream->runtime;
1779 struct snd_pcm_hw_constraints *constrs = &runtime->hw_constraints;
1780 int k, err;
1781
1782 for (k = SNDRV_PCM_HW_PARAM_FIRST_MASK; k <= SNDRV_PCM_HW_PARAM_LAST_MASK; k++) {
1783 snd_mask_any(constrs_mask(constrs, k));
1784 }
1785
1786 for (k = SNDRV_PCM_HW_PARAM_FIRST_INTERVAL; k <= SNDRV_PCM_HW_PARAM_LAST_INTERVAL; k++) {
1787 snd_interval_any(constrs_interval(constrs, k));
1788 }
1789
1790 snd_interval_setinteger(constrs_interval(constrs, SNDRV_PCM_HW_PARAM_CHANNELS));
1791 snd_interval_setinteger(constrs_interval(constrs, SNDRV_PCM_HW_PARAM_BUFFER_SIZE));
1792 snd_interval_setinteger(constrs_interval(constrs, SNDRV_PCM_HW_PARAM_BUFFER_BYTES));
1793 snd_interval_setinteger(constrs_interval(constrs, SNDRV_PCM_HW_PARAM_SAMPLE_BITS));
1794 snd_interval_setinteger(constrs_interval(constrs, SNDRV_PCM_HW_PARAM_FRAME_BITS));
1795
1796 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_FORMAT,
1797 snd_pcm_hw_rule_format, NULL,
1798 SNDRV_PCM_HW_PARAM_SAMPLE_BITS, -1);
1799 if (err < 0)
1800 return err;
1801 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
1802 snd_pcm_hw_rule_sample_bits, NULL,
1803 SNDRV_PCM_HW_PARAM_FORMAT,
1804 SNDRV_PCM_HW_PARAM_SAMPLE_BITS, -1);
1805 if (err < 0)
1806 return err;
1807 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
1808 snd_pcm_hw_rule_div, NULL,
1809 SNDRV_PCM_HW_PARAM_FRAME_BITS, SNDRV_PCM_HW_PARAM_CHANNELS, -1);
1810 if (err < 0)
1811 return err;
1812 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_FRAME_BITS,
1813 snd_pcm_hw_rule_mul, NULL,
1814 SNDRV_PCM_HW_PARAM_SAMPLE_BITS, SNDRV_PCM_HW_PARAM_CHANNELS, -1);
1815 if (err < 0)
1816 return err;
1817 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_FRAME_BITS,
1818 snd_pcm_hw_rule_mulkdiv, (void*) 8,
1819 SNDRV_PCM_HW_PARAM_PERIOD_BYTES, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, -1);
1820 if (err < 0)
1821 return err;
1822 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_FRAME_BITS,
1823 snd_pcm_hw_rule_mulkdiv, (void*) 8,
1824 SNDRV_PCM_HW_PARAM_BUFFER_BYTES, SNDRV_PCM_HW_PARAM_BUFFER_SIZE, -1);
1825 if (err < 0)
1826 return err;
1827 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS,
1828 snd_pcm_hw_rule_div, NULL,
1829 SNDRV_PCM_HW_PARAM_FRAME_BITS, SNDRV_PCM_HW_PARAM_SAMPLE_BITS, -1);
1830 if (err < 0)
1831 return err;
1832 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
1833 snd_pcm_hw_rule_mulkdiv, (void*) 1000000,
1834 SNDRV_PCM_HW_PARAM_PERIOD_SIZE, SNDRV_PCM_HW_PARAM_PERIOD_TIME, -1);
1835 if (err < 0)
1836 return err;
1837 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
1838 snd_pcm_hw_rule_mulkdiv, (void*) 1000000,
1839 SNDRV_PCM_HW_PARAM_BUFFER_SIZE, SNDRV_PCM_HW_PARAM_BUFFER_TIME, -1);
1840 if (err < 0)
1841 return err;
1842 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_PERIODS,
1843 snd_pcm_hw_rule_div, NULL,
1844 SNDRV_PCM_HW_PARAM_BUFFER_SIZE, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, -1);
1845 if (err < 0)
1846 return err;
1847 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1848 snd_pcm_hw_rule_div, NULL,
1849 SNDRV_PCM_HW_PARAM_BUFFER_SIZE, SNDRV_PCM_HW_PARAM_PERIODS, -1);
1850 if (err < 0)
1851 return err;
1852 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1853 snd_pcm_hw_rule_mulkdiv, (void*) 8,
1854 SNDRV_PCM_HW_PARAM_PERIOD_BYTES, SNDRV_PCM_HW_PARAM_FRAME_BITS, -1);
1855 if (err < 0)
1856 return err;
1857 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
1858 snd_pcm_hw_rule_muldivk, (void*) 1000000,
1859 SNDRV_PCM_HW_PARAM_PERIOD_TIME, SNDRV_PCM_HW_PARAM_RATE, -1);
1860 if (err < 0)
1861 return err;
1862 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_SIZE,
1863 snd_pcm_hw_rule_mul, NULL,
1864 SNDRV_PCM_HW_PARAM_PERIOD_SIZE, SNDRV_PCM_HW_PARAM_PERIODS, -1);
1865 if (err < 0)
1866 return err;
1867 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_SIZE,
1868 snd_pcm_hw_rule_mulkdiv, (void*) 8,
1869 SNDRV_PCM_HW_PARAM_BUFFER_BYTES, SNDRV_PCM_HW_PARAM_FRAME_BITS, -1);
1870 if (err < 0)
1871 return err;
1872 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_SIZE,
1873 snd_pcm_hw_rule_muldivk, (void*) 1000000,
1874 SNDRV_PCM_HW_PARAM_BUFFER_TIME, SNDRV_PCM_HW_PARAM_RATE, -1);
1875 if (err < 0)
1876 return err;
1877 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_BYTES,
1878 snd_pcm_hw_rule_muldivk, (void*) 8,
1879 SNDRV_PCM_HW_PARAM_PERIOD_SIZE, SNDRV_PCM_HW_PARAM_FRAME_BITS, -1);
1880 if (err < 0)
1881 return err;
1882 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
1883 snd_pcm_hw_rule_muldivk, (void*) 8,
1884 SNDRV_PCM_HW_PARAM_BUFFER_SIZE, SNDRV_PCM_HW_PARAM_FRAME_BITS, -1);
1885 if (err < 0)
1886 return err;
1887 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_TIME,
1888 snd_pcm_hw_rule_mulkdiv, (void*) 1000000,
1889 SNDRV_PCM_HW_PARAM_PERIOD_SIZE, SNDRV_PCM_HW_PARAM_RATE, -1);
1890 if (err < 0)
1891 return err;
1892 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_TIME,
1893 snd_pcm_hw_rule_mulkdiv, (void*) 1000000,
1894 SNDRV_PCM_HW_PARAM_BUFFER_SIZE, SNDRV_PCM_HW_PARAM_RATE, -1);
1895 if (err < 0)
1896 return err;
1897 return 0;
1898 }
1899
1900 int snd_pcm_hw_constraints_complete(struct snd_pcm_substream *substream)
1901 {
1902 struct snd_pcm_runtime *runtime = substream->runtime;
1903 struct snd_pcm_hardware *hw = &runtime->hw;
1904 int err;
1905 unsigned int mask = 0;
1906
1907 if (hw->info & SNDRV_PCM_INFO_INTERLEAVED)
1908 mask |= 1 << SNDRV_PCM_ACCESS_RW_INTERLEAVED;
1909 if (hw->info & SNDRV_PCM_INFO_NONINTERLEAVED)
1910 mask |= 1 << SNDRV_PCM_ACCESS_RW_NONINTERLEAVED;
1911 if (hw->info & SNDRV_PCM_INFO_MMAP) {
1912 if (hw->info & SNDRV_PCM_INFO_INTERLEAVED)
1913 mask |= 1 << SNDRV_PCM_ACCESS_MMAP_INTERLEAVED;
1914 if (hw->info & SNDRV_PCM_INFO_NONINTERLEAVED)
1915 mask |= 1 << SNDRV_PCM_ACCESS_MMAP_NONINTERLEAVED;
1916 if (hw->info & SNDRV_PCM_INFO_COMPLEX)
1917 mask |= 1 << SNDRV_PCM_ACCESS_MMAP_COMPLEX;
1918 }
1919 err = snd_pcm_hw_constraint_mask(runtime, SNDRV_PCM_HW_PARAM_ACCESS, mask);
1920 snd_assert(err >= 0, return -EINVAL);
1921
1922 err = snd_pcm_hw_constraint_mask64(runtime, SNDRV_PCM_HW_PARAM_FORMAT, hw->formats);
1923 snd_assert(err >= 0, return -EINVAL);
1924
1925 err = snd_pcm_hw_constraint_mask(runtime, SNDRV_PCM_HW_PARAM_SUBFORMAT, 1 << SNDRV_PCM_SUBFORMAT_STD);
1926 snd_assert(err >= 0, return -EINVAL);
1927
1928 err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_CHANNELS,
1929 hw->channels_min, hw->channels_max);
1930 snd_assert(err >= 0, return -EINVAL);
1931
1932 err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_RATE,
1933 hw->rate_min, hw->rate_max);
1934 snd_assert(err >= 0, return -EINVAL);
1935
1936 err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_BYTES,
1937 hw->period_bytes_min, hw->period_bytes_max);
1938 snd_assert(err >= 0, return -EINVAL);
1939
1940 err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIODS,
1941 hw->periods_min, hw->periods_max);
1942 snd_assert(err >= 0, return -EINVAL);
1943
1944 err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
1945 hw->period_bytes_min, hw->buffer_bytes_max);
1946 snd_assert(err >= 0, return -EINVAL);
1947
1948 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
1949 snd_pcm_hw_rule_buffer_bytes_max, substream,
1950 SNDRV_PCM_HW_PARAM_BUFFER_BYTES, -1);
1951 if (err < 0)
1952 return err;
1953
1954 /* FIXME: remove */
1955 if (runtime->dma_bytes) {
1956 err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 0, runtime->dma_bytes);
1957 snd_assert(err >= 0, return -EINVAL);
1958 }
1959
1960 if (!(hw->rates & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))) {
1961 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
1962 snd_pcm_hw_rule_rate, hw,
1963 SNDRV_PCM_HW_PARAM_RATE, -1);
1964 if (err < 0)
1965 return err;
1966 }
1967
1968 /* FIXME: this belong to lowlevel */
1969 snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_TICK_TIME,
1970 1000000 / HZ, 1000000 / HZ);
1971 snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE);
1972
1973 return 0;
1974 }
1975
1976 static void snd_pcm_add_file(struct snd_pcm_str *str,
1977 struct snd_pcm_file *pcm_file)
1978 {
1979 pcm_file->next = str->files;
1980 str->files = pcm_file;
1981 }
1982
1983 static void snd_pcm_remove_file(struct snd_pcm_str *str,
1984 struct snd_pcm_file *pcm_file)
1985 {
1986 struct snd_pcm_file * pcm_file1;
1987 if (str->files == pcm_file) {
1988 str->files = pcm_file->next;
1989 } else {
1990 pcm_file1 = str->files;
1991 while (pcm_file1 && pcm_file1->next != pcm_file)
1992 pcm_file1 = pcm_file1->next;
1993 if (pcm_file1 != NULL)
1994 pcm_file1->next = pcm_file->next;
1995 }
1996 }
1997
1998 static void pcm_release_private(struct snd_pcm_substream *substream)
1999 {
2000 struct snd_pcm_file *pcm_file = substream->file;
2001
2002 snd_pcm_unlink(substream);
2003 snd_pcm_remove_file(substream->pstr, pcm_file);
2004 kfree(pcm_file);
2005 }
2006
2007 void snd_pcm_release_substream(struct snd_pcm_substream *substream)
2008 {
2009 snd_pcm_drop(substream);
2010 if (substream->hw_opened) {
2011 if (substream->ops->hw_free != NULL)
2012 substream->ops->hw_free(substream);
2013 substream->ops->close(substream);
2014 substream->hw_opened = 0;
2015 }
2016 if (substream->pcm_release) {
2017 substream->pcm_release(substream);
2018 substream->pcm_release = NULL;
2019 }
2020 snd_pcm_detach_substream(substream);
2021 }
2022
2023 int snd_pcm_open_substream(struct snd_pcm *pcm, int stream,
2024 struct file *file,
2025 struct snd_pcm_substream **rsubstream)
2026 {
2027 struct snd_pcm_substream *substream;
2028 int err;
2029
2030 err = snd_pcm_attach_substream(pcm, stream, file, &substream);
2031 if (err < 0)
2032 return err;
2033 substream->no_mmap_ctrl = 0;
2034 err = snd_pcm_hw_constraints_init(substream);
2035 if (err < 0) {
2036 snd_printd("snd_pcm_hw_constraints_init failed\n");
2037 goto error;
2038 }
2039
2040 if ((err = substream->ops->open(substream)) < 0)
2041 goto error;
2042
2043 substream->hw_opened = 1;
2044
2045 err = snd_pcm_hw_constraints_complete(substream);
2046 if (err < 0) {
2047 snd_printd("snd_pcm_hw_constraints_complete failed\n");
2048 goto error;
2049 }
2050
2051 *rsubstream = substream;
2052 return 0;
2053
2054 error:
2055 snd_pcm_release_substream(substream);
2056 return err;
2057 }
2058
2059 static int snd_pcm_open_file(struct file *file,
2060 struct snd_pcm *pcm,
2061 int stream,
2062 struct snd_pcm_file **rpcm_file)
2063 {
2064 struct snd_pcm_file *pcm_file;
2065 struct snd_pcm_substream *substream;
2066 struct snd_pcm_str *str;
2067 int err;
2068
2069 snd_assert(rpcm_file != NULL, return -EINVAL);
2070 *rpcm_file = NULL;
2071
2072 err = snd_pcm_open_substream(pcm, stream, file, &substream);
2073 if (err < 0)
2074 return err;
2075
2076 pcm_file = kzalloc(sizeof(*pcm_file), GFP_KERNEL);
2077 if (pcm_file == NULL) {
2078 snd_pcm_release_substream(substream);
2079 return -ENOMEM;
2080 }
2081 str = substream->pstr;
2082 substream->file = pcm_file;
2083 substream->pcm_release = pcm_release_private;
2084 pcm_file->substream = substream;
2085 snd_pcm_add_file(str, pcm_file);
2086
2087 file->private_data = pcm_file;
2088 *rpcm_file = pcm_file;
2089 return 0;
2090 }
2091
2092 static int snd_pcm_playback_open(struct inode *inode, struct file *file)
2093 {
2094 struct snd_pcm *pcm;
2095
2096 pcm = snd_lookup_minor_data(iminor(inode),
2097 SNDRV_DEVICE_TYPE_PCM_PLAYBACK);
2098 return snd_pcm_open(file, pcm, SNDRV_PCM_STREAM_PLAYBACK);
2099 }
2100
2101 static int snd_pcm_capture_open(struct inode *inode, struct file *file)
2102 {
2103 struct snd_pcm *pcm;
2104
2105 pcm = snd_lookup_minor_data(iminor(inode),
2106 SNDRV_DEVICE_TYPE_PCM_CAPTURE);
2107 return snd_pcm_open(file, pcm, SNDRV_PCM_STREAM_CAPTURE);
2108 }
2109
2110 static int snd_pcm_open(struct file *file, struct snd_pcm *pcm, int stream)
2111 {
2112 int err;
2113 struct snd_pcm_file *pcm_file;
2114 wait_queue_t wait;
2115
2116 if (pcm == NULL) {
2117 err = -ENODEV;
2118 goto __error1;
2119 }
2120 err = snd_card_file_add(pcm->card, file);
2121 if (err < 0)
2122 goto __error1;
2123 if (!try_module_get(pcm->card->module)) {
2124 err = -EFAULT;
2125 goto __error2;
2126 }
2127 init_waitqueue_entry(&wait, current);
2128 add_wait_queue(&pcm->open_wait, &wait);
2129 mutex_lock(&pcm->open_mutex);
2130 while (1) {
2131 err = snd_pcm_open_file(file, pcm, stream, &pcm_file);
2132 if (err >= 0)
2133 break;
2134 if (err == -EAGAIN) {
2135 if (file->f_flags & O_NONBLOCK) {
2136 err = -EBUSY;
2137 break;
2138 }
2139 } else
2140 break;
2141 set_current_state(TASK_INTERRUPTIBLE);
2142 mutex_unlock(&pcm->open_mutex);
2143 schedule();
2144 mutex_lock(&pcm->open_mutex);
2145 if (signal_pending(current)) {
2146 err = -ERESTARTSYS;
2147 break;
2148 }
2149 }
2150 remove_wait_queue(&pcm->open_wait, &wait);
2151 mutex_unlock(&pcm->open_mutex);
2152 if (err < 0)
2153 goto __error;
2154 return err;
2155
2156 __error:
2157 module_put(pcm->card->module);
2158 __error2:
2159 snd_card_file_remove(pcm->card, file);
2160 __error1:
2161 return err;
2162 }
2163
2164 static int snd_pcm_release(struct inode *inode, struct file *file)
2165 {
2166 struct snd_pcm *pcm;
2167 struct snd_pcm_substream *substream;
2168 struct snd_pcm_file *pcm_file;
2169
2170 pcm_file = file->private_data;
2171 substream = pcm_file->substream;
2172 snd_assert(substream != NULL, return -ENXIO);
2173 snd_assert(!atomic_read(&substream->runtime->mmap_count), );
2174 pcm = substream->pcm;
2175 fasync_helper(-1, file, 0, &substream->runtime->fasync);
2176 mutex_lock(&pcm->open_mutex);
2177 snd_pcm_release_substream(substream);
2178 mutex_unlock(&pcm->open_mutex);
2179 wake_up(&pcm->open_wait);
2180 module_put(pcm->card->module);
2181 snd_card_file_remove(pcm->card, file);
2182 return 0;
2183 }
2184
2185 static snd_pcm_sframes_t snd_pcm_playback_rewind(struct snd_pcm_substream *substream,
2186 snd_pcm_uframes_t frames)
2187 {
2188 struct snd_pcm_runtime *runtime = substream->runtime;
2189 snd_pcm_sframes_t appl_ptr;
2190 snd_pcm_sframes_t ret;
2191 snd_pcm_sframes_t hw_avail;
2192
2193 if (frames == 0)
2194 return 0;
2195
2196 snd_pcm_stream_lock_irq(substream);
2197 switch (runtime->status->state) {
2198 case SNDRV_PCM_STATE_PREPARED:
2199 break;
2200 case SNDRV_PCM_STATE_DRAINING:
2201 case SNDRV_PCM_STATE_RUNNING:
2202 if (snd_pcm_update_hw_ptr(substream) >= 0)
2203 break;
2204 /* Fall through */
2205 case SNDRV_PCM_STATE_XRUN:
2206 ret = -EPIPE;
2207 goto __end;
2208 default:
2209 ret = -EBADFD;
2210 goto __end;
2211 }
2212
2213 hw_avail = snd_pcm_playback_hw_avail(runtime);
2214 if (hw_avail <= 0) {
2215 ret = 0;
2216 goto __end;
2217 }
2218 if (frames > (snd_pcm_uframes_t)hw_avail)
2219 frames = hw_avail;
2220 else
2221 frames -= frames % runtime->xfer_align;
2222 appl_ptr = runtime->control->appl_ptr - frames;
2223 if (appl_ptr < 0)
2224 appl_ptr += runtime->boundary;
2225 runtime->control->appl_ptr = appl_ptr;
2226 if (runtime->status->state == SNDRV_PCM_STATE_RUNNING &&
2227 runtime->sleep_min)
2228 snd_pcm_tick_prepare(substream);
2229 ret = frames;
2230 __end:
2231 snd_pcm_stream_unlock_irq(substream);
2232 return ret;
2233 }
2234
2235 static snd_pcm_sframes_t snd_pcm_capture_rewind(struct snd_pcm_substream *substream,
2236 snd_pcm_uframes_t frames)
2237 {
2238 struct snd_pcm_runtime *runtime = substream->runtime;
2239 snd_pcm_sframes_t appl_ptr;
2240 snd_pcm_sframes_t ret;
2241 snd_pcm_sframes_t hw_avail;
2242
2243 if (frames == 0)
2244 return 0;
2245
2246 snd_pcm_stream_lock_irq(substream);
2247 switch (runtime->status->state) {
2248 case SNDRV_PCM_STATE_PREPARED:
2249 case SNDRV_PCM_STATE_DRAINING:
2250 break;
2251 case SNDRV_PCM_STATE_RUNNING:
2252 if (snd_pcm_update_hw_ptr(substream) >= 0)
2253 break;
2254 /* Fall through */
2255 case SNDRV_PCM_STATE_XRUN:
2256 ret = -EPIPE;
2257 goto __end;
2258 default:
2259 ret = -EBADFD;
2260 goto __end;
2261 }
2262
2263 hw_avail = snd_pcm_capture_hw_avail(runtime);
2264 if (hw_avail <= 0) {
2265 ret = 0;
2266 goto __end;
2267 }
2268 if (frames > (snd_pcm_uframes_t)hw_avail)
2269 frames = hw_avail;
2270 else
2271 frames -= frames % runtime->xfer_align;
2272 appl_ptr = runtime->control->appl_ptr - frames;
2273 if (appl_ptr < 0)
2274 appl_ptr += runtime->boundary;
2275 runtime->control->appl_ptr = appl_ptr;
2276 if (runtime->status->state == SNDRV_PCM_STATE_RUNNING &&
2277 runtime->sleep_min)
2278 snd_pcm_tick_prepare(substream);
2279 ret = frames;
2280 __end:
2281 snd_pcm_stream_unlock_irq(substream);
2282 return ret;
2283 }
2284
2285 static snd_pcm_sframes_t snd_pcm_playback_forward(struct snd_pcm_substream *substream,
2286 snd_pcm_uframes_t frames)
2287 {
2288 struct snd_pcm_runtime *runtime = substream->runtime;
2289 snd_pcm_sframes_t appl_ptr;
2290 snd_pcm_sframes_t ret;
2291 snd_pcm_sframes_t avail;
2292
2293 if (frames == 0)
2294 return 0;
2295
2296 snd_pcm_stream_lock_irq(substream);
2297 switch (runtime->status->state) {
2298 case SNDRV_PCM_STATE_PREPARED:
2299 case SNDRV_PCM_STATE_PAUSED:
2300 break;
2301 case SNDRV_PCM_STATE_DRAINING:
2302 case SNDRV_PCM_STATE_RUNNING:
2303 if (snd_pcm_update_hw_ptr(substream) >= 0)
2304 break;
2305 /* Fall through */
2306 case SNDRV_PCM_STATE_XRUN:
2307 ret = -EPIPE;
2308 goto __end;
2309 default:
2310 ret = -EBADFD;
2311 goto __end;
2312 }
2313
2314 avail = snd_pcm_playback_avail(runtime);
2315 if (avail <= 0) {
2316 ret = 0;
2317 goto __end;
2318 }
2319 if (frames > (snd_pcm_uframes_t)avail)
2320 frames = avail;
2321 else
2322 frames -= frames % runtime->xfer_align;
2323 appl_ptr = runtime->control->appl_ptr + frames;
2324 if (appl_ptr >= (snd_pcm_sframes_t)runtime->boundary)
2325 appl_ptr -= runtime->boundary;
2326 runtime->control->appl_ptr = appl_ptr;
2327 if (runtime->status->state == SNDRV_PCM_STATE_RUNNING &&
2328 runtime->sleep_min)
2329 snd_pcm_tick_prepare(substream);
2330 ret = frames;
2331 __end:
2332 snd_pcm_stream_unlock_irq(substream);
2333 return ret;
2334 }
2335
2336 static snd_pcm_sframes_t snd_pcm_capture_forward(struct snd_pcm_substream *substream,
2337 snd_pcm_uframes_t frames)
2338 {
2339 struct snd_pcm_runtime *runtime = substream->runtime;
2340 snd_pcm_sframes_t appl_ptr;
2341 snd_pcm_sframes_t ret;
2342 snd_pcm_sframes_t avail;
2343
2344 if (frames == 0)
2345 return 0;
2346
2347 snd_pcm_stream_lock_irq(substream);
2348 switch (runtime->status->state) {
2349 case SNDRV_PCM_STATE_PREPARED:
2350 case SNDRV_PCM_STATE_DRAINING:
2351 case SNDRV_PCM_STATE_PAUSED:
2352 break;
2353 case SNDRV_PCM_STATE_RUNNING:
2354 if (snd_pcm_update_hw_ptr(substream) >= 0)
2355 break;
2356 /* Fall through */
2357 case SNDRV_PCM_STATE_XRUN:
2358 ret = -EPIPE;
2359 goto __end;
2360 default:
2361 ret = -EBADFD;
2362 goto __end;
2363 }
2364
2365 avail = snd_pcm_capture_avail(runtime);
2366 if (avail <= 0) {
2367 ret = 0;
2368 goto __end;
2369 }
2370 if (frames > (snd_pcm_uframes_t)avail)
2371 frames = avail;
2372 else
2373 frames -= frames % runtime->xfer_align;
2374 appl_ptr = runtime->control->appl_ptr + frames;
2375 if (appl_ptr >= (snd_pcm_sframes_t)runtime->boundary)
2376 appl_ptr -= runtime->boundary;
2377 runtime->control->appl_ptr = appl_ptr;
2378 if (runtime->status->state == SNDRV_PCM_STATE_RUNNING &&
2379 runtime->sleep_min)
2380 snd_pcm_tick_prepare(substream);
2381 ret = frames;
2382 __end:
2383 snd_pcm_stream_unlock_irq(substream);
2384 return ret;
2385 }
2386
2387 static int snd_pcm_hwsync(struct snd_pcm_substream *substream)
2388 {
2389 struct snd_pcm_runtime *runtime = substream->runtime;
2390 int err;
2391
2392 snd_pcm_stream_lock_irq(substream);
2393 switch (runtime->status->state) {
2394 case SNDRV_PCM_STATE_DRAINING:
2395 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
2396 goto __badfd;
2397 case SNDRV_PCM_STATE_RUNNING:
2398 if ((err = snd_pcm_update_hw_ptr(substream)) < 0)
2399 break;
2400 /* Fall through */
2401 case SNDRV_PCM_STATE_PREPARED:
2402 case SNDRV_PCM_STATE_SUSPENDED:
2403 err = 0;
2404 break;
2405 case SNDRV_PCM_STATE_XRUN:
2406 err = -EPIPE;
2407 break;
2408 default:
2409 __badfd:
2410 err = -EBADFD;
2411 break;
2412 }
2413 snd_pcm_stream_unlock_irq(substream);
2414 return err;
2415 }
2416
2417 static int snd_pcm_delay(struct snd_pcm_substream *substream,
2418 snd_pcm_sframes_t __user *res)
2419 {
2420 struct snd_pcm_runtime *runtime = substream->runtime;
2421 int err;
2422 snd_pcm_sframes_t n = 0;
2423
2424 snd_pcm_stream_lock_irq(substream);
2425 switch (runtime->status->state) {
2426 case SNDRV_PCM_STATE_DRAINING:
2427 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
2428 goto __badfd;
2429 case SNDRV_PCM_STATE_RUNNING:
2430 if ((err = snd_pcm_update_hw_ptr(substream)) < 0)
2431 break;
2432 /* Fall through */
2433 case SNDRV_PCM_STATE_PREPARED:
2434 case SNDRV_PCM_STATE_SUSPENDED:
2435 err = 0;
2436 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
2437 n = snd_pcm_playback_hw_avail(runtime);
2438 else
2439 n = snd_pcm_capture_avail(runtime);
2440 break;
2441 case SNDRV_PCM_STATE_XRUN:
2442 err = -EPIPE;
2443 break;
2444 default:
2445 __badfd:
2446 err = -EBADFD;
2447 break;
2448 }
2449 snd_pcm_stream_unlock_irq(substream);
2450 if (!err)
2451 if (put_user(n, res))
2452 err = -EFAULT;
2453 return err;
2454 }
2455
2456 static int snd_pcm_sync_ptr(struct snd_pcm_substream *substream,
2457 struct snd_pcm_sync_ptr __user *_sync_ptr)
2458 {
2459 struct snd_pcm_runtime *runtime = substream->runtime;
2460 struct snd_pcm_sync_ptr sync_ptr;
2461 volatile struct snd_pcm_mmap_status *status;
2462 volatile struct snd_pcm_mmap_control *control;
2463 int err;
2464
2465 memset(&sync_ptr, 0, sizeof(sync_ptr));
2466 if (get_user(sync_ptr.flags, (unsigned __user *)&(_sync_ptr->flags)))
2467 return -EFAULT;
2468 if (copy_from_user(&sync_ptr.c.control, &(_sync_ptr->c.control), sizeof(struct snd_pcm_mmap_control)))
2469 return -EFAULT;
2470 status = runtime->status;
2471 control = runtime->control;
2472 if (sync_ptr.flags & SNDRV_PCM_SYNC_PTR_HWSYNC) {
2473 err = snd_pcm_hwsync(substream);
2474 if (err < 0)
2475 return err;
2476 }
2477 snd_pcm_stream_lock_irq(substream);
2478 if (!(sync_ptr.flags & SNDRV_PCM_SYNC_PTR_APPL))
2479 control->appl_ptr = sync_ptr.c.control.appl_ptr;
2480 else
2481 sync_ptr.c.control.appl_ptr = control->appl_ptr;
2482 if (!(sync_ptr.flags & SNDRV_PCM_SYNC_PTR_AVAIL_MIN))
2483 control->avail_min = sync_ptr.c.control.avail_min;
2484 else
2485 sync_ptr.c.control.avail_min = control->avail_min;
2486 sync_ptr.s.status.state = status->state;
2487 sync_ptr.s.status.hw_ptr = status->hw_ptr;
2488 sync_ptr.s.status.tstamp = status->tstamp;
2489 sync_ptr.s.status.suspended_state = status->suspended_state;
2490 snd_pcm_stream_unlock_irq(substream);
2491 if (copy_to_user(_sync_ptr, &sync_ptr, sizeof(sync_ptr)))
2492 return -EFAULT;
2493 return 0;
2494 }
2495
2496 static int snd_pcm_common_ioctl1(struct snd_pcm_substream *substream,
2497 unsigned int cmd, void __user *arg)
2498 {
2499 snd_assert(substream != NULL, return -ENXIO);
2500
2501 switch (cmd) {
2502 case SNDRV_PCM_IOCTL_PVERSION:
2503 return put_user(SNDRV_PCM_VERSION, (int __user *)arg) ? -EFAULT : 0;
2504 case SNDRV_PCM_IOCTL_INFO:
2505 return snd_pcm_info_user(substream, arg);
2506 case SNDRV_PCM_IOCTL_TSTAMP: /* just for compatibility */
2507 return 0;
2508 case SNDRV_PCM_IOCTL_HW_REFINE:
2509 return snd_pcm_hw_refine_user(substream, arg);
2510 case SNDRV_PCM_IOCTL_HW_PARAMS:
2511 return snd_pcm_hw_params_user(substream, arg);
2512 case SNDRV_PCM_IOCTL_HW_FREE:
2513 return snd_pcm_hw_free(substream);
2514 case SNDRV_PCM_IOCTL_SW_PARAMS:
2515 return snd_pcm_sw_params_user(substream, arg);
2516 case SNDRV_PCM_IOCTL_STATUS:
2517 return snd_pcm_status_user(substream, arg);
2518 case SNDRV_PCM_IOCTL_CHANNEL_INFO:
2519 return snd_pcm_channel_info_user(substream, arg);
2520 case SNDRV_PCM_IOCTL_PREPARE:
2521 return snd_pcm_prepare(substream);
2522 case SNDRV_PCM_IOCTL_RESET:
2523 return snd_pcm_reset(substream);
2524 case SNDRV_PCM_IOCTL_START:
2525 return snd_pcm_action_lock_irq(&snd_pcm_action_start, substream, SNDRV_PCM_STATE_RUNNING);
2526 case SNDRV_PCM_IOCTL_LINK:
2527 return snd_pcm_link(substream, (int)(unsigned long) arg);
2528 case SNDRV_PCM_IOCTL_UNLINK:
2529 return snd_pcm_unlink(substream);
2530 case SNDRV_PCM_IOCTL_RESUME:
2531 return snd_pcm_resume(substream);
2532 case SNDRV_PCM_IOCTL_XRUN:
2533 return snd_pcm_xrun(substream);
2534 case SNDRV_PCM_IOCTL_HWSYNC:
2535 return snd_pcm_hwsync(substream);
2536 case SNDRV_PCM_IOCTL_DELAY:
2537 return snd_pcm_delay(substream, arg);
2538 case SNDRV_PCM_IOCTL_SYNC_PTR:
2539 return snd_pcm_sync_ptr(substream, arg);
2540 #ifdef CONFIG_SND_SUPPORT_OLD_API
2541 case SNDRV_PCM_IOCTL_HW_REFINE_OLD:
2542 return snd_pcm_hw_refine_old_user(substream, arg);
2543 case SNDRV_PCM_IOCTL_HW_PARAMS_OLD:
2544 return snd_pcm_hw_params_old_user(substream, arg);
2545 #endif
2546 case SNDRV_PCM_IOCTL_DRAIN:
2547 return snd_pcm_drain(substream);
2548 case SNDRV_PCM_IOCTL_DROP:
2549 return snd_pcm_drop(substream);
2550 case SNDRV_PCM_IOCTL_PAUSE:
2551 {
2552 int res;
2553 snd_pcm_stream_lock_irq(substream);
2554 res = snd_pcm_pause(substream, (int)(unsigned long)arg);
2555 snd_pcm_stream_unlock_irq(substream);
2556 return res;
2557 }
2558 }
2559 snd_printd("unknown ioctl = 0x%x\n", cmd);
2560 return -ENOTTY;
2561 }
2562
2563 static int snd_pcm_playback_ioctl1(struct snd_pcm_substream *substream,
2564 unsigned int cmd, void __user *arg)
2565 {
2566 snd_assert(substream != NULL, return -ENXIO);
2567 snd_assert(substream->stream == SNDRV_PCM_STREAM_PLAYBACK, return -EINVAL);
2568 switch (cmd) {
2569 case SNDRV_PCM_IOCTL_WRITEI_FRAMES:
2570 {
2571 struct snd_xferi xferi;
2572 struct snd_xferi __user *_xferi = arg;
2573 struct snd_pcm_runtime *runtime = substream->runtime;
2574 snd_pcm_sframes_t result;
2575 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
2576 return -EBADFD;
2577 if (put_user(0, &_xferi->result))
2578 return -EFAULT;
2579 if (copy_from_user(&xferi, _xferi, sizeof(xferi)))
2580 return -EFAULT;
2581 result = snd_pcm_lib_write(substream, xferi.buf, xferi.frames);
2582 __put_user(result, &_xferi->result);
2583 return result < 0 ? result : 0;
2584 }
2585 case SNDRV_PCM_IOCTL_WRITEN_FRAMES:
2586 {
2587 struct snd_xfern xfern;
2588 struct snd_xfern __user *_xfern = arg;
2589 struct snd_pcm_runtime *runtime = substream->runtime;
2590 void __user **bufs;
2591 snd_pcm_sframes_t result;
2592 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
2593 return -EBADFD;
2594 if (runtime->channels > 128)
2595 return -EINVAL;
2596 if (put_user(0, &_xfern->result))
2597 return -EFAULT;
2598 if (copy_from_user(&xfern, _xfern, sizeof(xfern)))
2599 return -EFAULT;
2600 bufs = kmalloc(sizeof(void *) * runtime->channels, GFP_KERNEL);
2601 if (bufs == NULL)
2602 return -ENOMEM;
2603 if (copy_from_user(bufs, xfern.bufs, sizeof(void *) * runtime->channels)) {
2604 kfree(bufs);
2605 return -EFAULT;
2606 }
2607 result = snd_pcm_lib_writev(substream, bufs, xfern.frames);
2608 kfree(bufs);
2609 __put_user(result, &_xfern->result);
2610 return result < 0 ? result : 0;
2611 }
2612 case SNDRV_PCM_IOCTL_REWIND:
2613 {
2614 snd_pcm_uframes_t frames;
2615 snd_pcm_uframes_t __user *_frames = arg;
2616 snd_pcm_sframes_t result;
2617 if (get_user(frames, _frames))
2618 return -EFAULT;
2619 if (put_user(0, _frames))
2620 return -EFAULT;
2621 result = snd_pcm_playback_rewind(substream, frames);
2622 __put_user(result, _frames);
2623 return result < 0 ? result : 0;
2624 }
2625 case SNDRV_PCM_IOCTL_FORWARD:
2626 {
2627 snd_pcm_uframes_t frames;
2628 snd_pcm_uframes_t __user *_frames = arg;
2629 snd_pcm_sframes_t result;
2630 if (get_user(frames, _frames))
2631 return -EFAULT;
2632 if (put_user(0, _frames))
2633 return -EFAULT;
2634 result = snd_pcm_playback_forward(substream, frames);
2635 __put_user(result, _frames);
2636 return result < 0 ? result : 0;
2637 }
2638 }
2639 return snd_pcm_common_ioctl1(substream, cmd, arg);
2640 }
2641
2642 static int snd_pcm_capture_ioctl1(struct snd_pcm_substream *substream,
2643 unsigned int cmd, void __user *arg)
2644 {
2645 snd_assert(substream != NULL, return -ENXIO);
2646 snd_assert(substream->stream == SNDRV_PCM_STREAM_CAPTURE, return -EINVAL);
2647 switch (cmd) {
2648 case SNDRV_PCM_IOCTL_READI_FRAMES:
2649 {
2650 struct snd_xferi xferi;
2651 struct snd_xferi __user *_xferi = arg;
2652 struct snd_pcm_runtime *runtime = substream->runtime;
2653 snd_pcm_sframes_t result;
2654 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
2655 return -EBADFD;
2656 if (put_user(0, &_xferi->result))
2657 return -EFAULT;
2658 if (copy_from_user(&xferi, _xferi, sizeof(xferi)))
2659 return -EFAULT;
2660 result = snd_pcm_lib_read(substream, xferi.buf, xferi.frames);
2661 __put_user(result, &_xferi->result);
2662 return result < 0 ? result : 0;
2663 }
2664 case SNDRV_PCM_IOCTL_READN_FRAMES:
2665 {
2666 struct snd_xfern xfern;
2667 struct snd_xfern __user *_xfern = arg;
2668 struct snd_pcm_runtime *runtime = substream->runtime;
2669 void *bufs;
2670 snd_pcm_sframes_t result;
2671 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
2672 return -EBADFD;
2673 if (runtime->channels > 128)
2674 return -EINVAL;
2675 if (put_user(0, &_xfern->result))
2676 return -EFAULT;
2677 if (copy_from_user(&xfern, _xfern, sizeof(xfern)))
2678 return -EFAULT;
2679 bufs = kmalloc(sizeof(void *) * runtime->channels, GFP_KERNEL);
2680 if (bufs == NULL)
2681 return -ENOMEM;
2682 if (copy_from_user(bufs, xfern.bufs, sizeof(void *) * runtime->channels)) {
2683 kfree(bufs);
2684 return -EFAULT;
2685 }
2686 result = snd_pcm_lib_readv(substream, bufs, xfern.frames);
2687 kfree(bufs);
2688 __put_user(result, &_xfern->result);
2689 return result < 0 ? result : 0;
2690 }
2691 case SNDRV_PCM_IOCTL_REWIND:
2692 {
2693 snd_pcm_uframes_t frames;
2694 snd_pcm_uframes_t __user *_frames = arg;
2695 snd_pcm_sframes_t result;
2696 if (get_user(frames, _frames))
2697 return -EFAULT;
2698 if (put_user(0, _frames))
2699 return -EFAULT;
2700 result = snd_pcm_capture_rewind(substream, frames);
2701 __put_user(result, _frames);
2702 return result < 0 ? result : 0;
2703 }
2704 case SNDRV_PCM_IOCTL_FORWARD:
2705 {
2706 snd_pcm_uframes_t frames;
2707 snd_pcm_uframes_t __user *_frames = arg;
2708 snd_pcm_sframes_t result;
2709 if (get_user(frames, _frames))
2710 return -EFAULT;
2711 if (put_user(0, _frames))
2712 return -EFAULT;
2713 result = snd_pcm_capture_forward(substream, frames);
2714 __put_user(result, _frames);
2715 return result < 0 ? result : 0;
2716 }
2717 }
2718 return snd_pcm_common_ioctl1(substream, cmd, arg);
2719 }
2720
2721 static long snd_pcm_playback_ioctl(struct file *file, unsigned int cmd,
2722 unsigned long arg)
2723 {
2724 struct snd_pcm_file *pcm_file;
2725
2726 pcm_file = file->private_data;
2727
2728 if (((cmd >> 8) & 0xff) != 'A')
2729 return -ENOTTY;
2730
2731 return snd_pcm_playback_ioctl1(pcm_file->substream, cmd, (void __user *)arg);
2732 }
2733
2734 static long snd_pcm_capture_ioctl(struct file *file, unsigned int cmd,
2735 unsigned long arg)
2736 {
2737 struct snd_pcm_file *pcm_file;
2738
2739 pcm_file = file->private_data;
2740
2741 if (((cmd >> 8) & 0xff) != 'A')
2742 return -ENOTTY;
2743
2744 return snd_pcm_capture_ioctl1(pcm_file->substream, cmd, (void __user *)arg);
2745 }
2746
2747 int snd_pcm_kernel_ioctl(struct snd_pcm_substream *substream,
2748 unsigned int cmd, void *arg)
2749 {
2750 mm_segment_t fs;
2751 int result;
2752
2753 fs = snd_enter_user();
2754 switch (substream->stream) {
2755 case SNDRV_PCM_STREAM_PLAYBACK:
2756 result = snd_pcm_playback_ioctl1(substream,
2757 cmd, (void __user *)arg);
2758 break;
2759 case SNDRV_PCM_STREAM_CAPTURE:
2760 result = snd_pcm_capture_ioctl1(substream,
2761 cmd, (void __user *)arg);
2762 break;
2763 default:
2764 result = -EINVAL;
2765 break;
2766 }
2767 snd_leave_user(fs);
2768 return result;
2769 }
2770
2771 static ssize_t snd_pcm_read(struct file *file, char __user *buf, size_t count,
2772 loff_t * offset)
2773 {
2774 struct snd_pcm_file *pcm_file;
2775 struct snd_pcm_substream *substream;
2776 struct snd_pcm_runtime *runtime;
2777 snd_pcm_sframes_t result;
2778
2779 pcm_file = file->private_data;
2780 substream = pcm_file->substream;
2781 snd_assert(substream != NULL, return -ENXIO);
2782 runtime = substream->runtime;
2783 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
2784 return -EBADFD;
2785 if (!frame_aligned(runtime, count))
2786 return -EINVAL;
2787 count = bytes_to_frames(runtime, count);
2788 result = snd_pcm_lib_read(substream, buf, count);
2789 if (result > 0)
2790 result = frames_to_bytes(runtime, result);
2791 return result;
2792 }
2793
2794 static ssize_t snd_pcm_write(struct file *file, const char __user *buf,
2795 size_t count, loff_t * offset)
2796 {
2797 struct snd_pcm_file *pcm_file;
2798 struct snd_pcm_substream *substream;
2799 struct snd_pcm_runtime *runtime;
2800 snd_pcm_sframes_t result;
2801
2802 pcm_file = file->private_data;
2803 substream = pcm_file->substream;
2804 snd_assert(substream != NULL, result = -ENXIO; goto end);
2805 runtime = substream->runtime;
2806 if (runtime->status->state == SNDRV_PCM_STATE_OPEN) {
2807 result = -EBADFD;
2808 goto end;
2809 }
2810 if (!frame_aligned(runtime, count)) {
2811 result = -EINVAL;
2812 goto end;
2813 }
2814 count = bytes_to_frames(runtime, count);
2815 result = snd_pcm_lib_write(substream, buf, count);
2816 if (result > 0)
2817 result = frames_to_bytes(runtime, result);
2818 end:
2819 return result;
2820 }
2821
2822 static ssize_t snd_pcm_readv(struct file *file, const struct iovec *_vector,
2823 unsigned long count, loff_t * offset)
2824
2825 {
2826 struct snd_pcm_file *pcm_file;
2827 struct snd_pcm_substream *substream;
2828 struct snd_pcm_runtime *runtime;
2829 snd_pcm_sframes_t result;
2830 unsigned long i;
2831 void __user **bufs;
2832 snd_pcm_uframes_t frames;
2833
2834 pcm_file = file->private_data;
2835 substream = pcm_file->substream;
2836 snd_assert(substream != NULL, return -ENXIO);
2837 runtime = substream->runtime;
2838 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
2839 return -EBADFD;
2840 if (count > 1024 || count != runtime->channels)
2841 return -EINVAL;
2842 if (!frame_aligned(runtime, _vector->iov_len))
2843 return -EINVAL;
2844 frames = bytes_to_samples(runtime, _vector->iov_len);
2845 bufs = kmalloc(sizeof(void *) * count, GFP_KERNEL);
2846 if (bufs == NULL)
2847 return -ENOMEM;
2848 for (i = 0; i < count; ++i)
2849 bufs[i] = _vector[i].iov_base;
2850 result = snd_pcm_lib_readv(substream, bufs, frames);
2851 if (result > 0)
2852 result = frames_to_bytes(runtime, result);
2853 kfree(bufs);
2854 return result;
2855 }
2856
2857 static ssize_t snd_pcm_writev(struct file *file, const struct iovec *_vector,
2858 unsigned long count, loff_t * offset)
2859 {
2860 struct snd_pcm_file *pcm_file;
2861 struct snd_pcm_substream *substream;
2862 struct snd_pcm_runtime *runtime;
2863 snd_pcm_sframes_t result;
2864 unsigned long i;
2865 void __user **bufs;
2866 snd_pcm_uframes_t frames;
2867
2868 pcm_file = file->private_data;
2869 substream = pcm_file->substream;
2870 snd_assert(substream != NULL, result = -ENXIO; goto end);
2871 runtime = substream->runtime;
2872 if (runtime->status->state == SNDRV_PCM_STATE_OPEN) {
2873 result = -EBADFD;
2874 goto end;
2875 }
2876 if (count > 128 || count != runtime->channels ||
2877 !frame_aligned(runtime, _vector->iov_len)) {
2878 result = -EINVAL;
2879 goto end;
2880 }
2881 frames = bytes_to_samples(runtime, _vector->iov_len);
2882 bufs = kmalloc(sizeof(void *) * count, GFP_KERNEL);
2883 if (bufs == NULL)
2884 return -ENOMEM;
2885 for (i = 0; i < count; ++i)
2886 bufs[i] = _vector[i].iov_base;
2887 result = snd_pcm_lib_writev(substream, bufs, frames);
2888 if (result > 0)
2889 result = frames_to_bytes(runtime, result);
2890 kfree(bufs);
2891 end:
2892 return result;
2893 }
2894
2895 static unsigned int snd_pcm_playback_poll(struct file *file, poll_table * wait)
2896 {
2897 struct snd_pcm_file *pcm_file;
2898 struct snd_pcm_substream *substream;
2899 struct snd_pcm_runtime *runtime;
2900 unsigned int mask;
2901 snd_pcm_uframes_t avail;
2902
2903 pcm_file = file->private_data;
2904
2905 substream = pcm_file->substream;
2906 snd_assert(substream != NULL, return -ENXIO);
2907 runtime = substream->runtime;
2908
2909 poll_wait(file, &runtime->sleep, wait);
2910
2911 snd_pcm_stream_lock_irq(substream);
2912 avail = snd_pcm_playback_avail(runtime);
2913 switch (runtime->status->state) {
2914 case SNDRV_PCM_STATE_RUNNING:
2915 case SNDRV_PCM_STATE_PREPARED:
2916 case SNDRV_PCM_STATE_PAUSED:
2917 if (avail >= runtime->control->avail_min) {
2918 mask = POLLOUT | POLLWRNORM;
2919 break;
2920 }
2921 /* Fall through */
2922 case SNDRV_PCM_STATE_DRAINING:
2923 mask = 0;
2924 break;
2925 default:
2926 mask = POLLOUT | POLLWRNORM | POLLERR;
2927 break;
2928 }
2929 snd_pcm_stream_unlock_irq(substream);
2930 return mask;
2931 }
2932
2933 static unsigned int snd_pcm_capture_poll(struct file *file, poll_table * wait)
2934 {
2935 struct snd_pcm_file *pcm_file;
2936 struct snd_pcm_substream *substream;
2937 struct snd_pcm_runtime *runtime;
2938 unsigned int mask;
2939 snd_pcm_uframes_t avail;
2940
2941 pcm_file = file->private_data;
2942
2943 substream = pcm_file->substream;
2944 snd_assert(substream != NULL, return -ENXIO);
2945 runtime = substream->runtime;
2946
2947 poll_wait(file, &runtime->sleep, wait);
2948
2949 snd_pcm_stream_lock_irq(substream);
2950 avail = snd_pcm_capture_avail(runtime);
2951 switch (runtime->status->state) {
2952 case SNDRV_PCM_STATE_RUNNING:
2953 case SNDRV_PCM_STATE_PREPARED:
2954 case SNDRV_PCM_STATE_PAUSED:
2955 if (avail >= runtime->control->avail_min) {
2956 mask = POLLIN | POLLRDNORM;
2957 break;
2958 }
2959 mask = 0;
2960 break;
2961 case SNDRV_PCM_STATE_DRAINING:
2962 if (avail > 0) {
2963 mask = POLLIN | POLLRDNORM;
2964 break;
2965 }
2966 /* Fall through */
2967 default:
2968 mask = POLLIN | POLLRDNORM | POLLERR;
2969 break;
2970 }
2971 snd_pcm_stream_unlock_irq(substream);
2972 return mask;
2973 }
2974
2975 /*
2976 * mmap support
2977 */
2978
2979 /*
2980 * Only on coherent architectures, we can mmap the status and the control records
2981 * for effcient data transfer. On others, we have to use HWSYNC ioctl...
2982 */
2983 #if defined(CONFIG_X86) || defined(CONFIG_PPC) || defined(CONFIG_ALPHA)
2984 /*
2985 * mmap status record
2986 */
2987 static struct page * snd_pcm_mmap_status_nopage(struct vm_area_struct *area,
2988 unsigned long address, int *type)
2989 {
2990 struct snd_pcm_substream *substream = area->vm_private_data;
2991 struct snd_pcm_runtime *runtime;
2992 struct page * page;
2993
2994 if (substream == NULL)
2995 return NOPAGE_OOM;
2996 runtime = substream->runtime;
2997 page = virt_to_page(runtime->status);
2998 get_page(page);
2999 if (type)
3000 *type = VM_FAULT_MINOR;
3001 return page;
3002 }
3003
3004 static struct vm_operations_struct snd_pcm_vm_ops_status =
3005 {
3006 .nopage = snd_pcm_mmap_status_nopage,
3007 };
3008
3009 static int snd_pcm_mmap_status(struct snd_pcm_substream *substream, struct file *file,
3010 struct vm_area_struct *area)
3011 {
3012 struct snd_pcm_runtime *runtime;
3013 long size;
3014 if (!(area->vm_flags & VM_READ))
3015 return -EINVAL;
3016 runtime = substream->runtime;
3017 snd_assert(runtime != NULL, return -EAGAIN);
3018 size = area->vm_end - area->vm_start;
3019 if (size != PAGE_ALIGN(sizeof(struct snd_pcm_mmap_status)))
3020 return -EINVAL;
3021 area->vm_ops = &snd_pcm_vm_ops_status;
3022 area->vm_private_data = substream;
3023 area->vm_flags |= VM_RESERVED;
3024 return 0;
3025 }
3026
3027 /*
3028 * mmap control record
3029 */
3030 static struct page * snd_pcm_mmap_control_nopage(struct vm_area_struct *area,
3031 unsigned long address, int *type)
3032 {
3033 struct snd_pcm_substream *substream = area->vm_private_data;
3034 struct snd_pcm_runtime *runtime;
3035 struct page * page;
3036
3037 if (substream == NULL)
3038 return NOPAGE_OOM;
3039 runtime = substream->runtime;
3040 page = virt_to_page(runtime->control);
3041 get_page(page);
3042 if (type)
3043 *type = VM_FAULT_MINOR;
3044 return page;
3045 }
3046
3047 static struct vm_operations_struct snd_pcm_vm_ops_control =
3048 {
3049 .nopage = snd_pcm_mmap_control_nopage,
3050 };
3051
3052 static int snd_pcm_mmap_control(struct snd_pcm_substream *substream, struct file *file,
3053 struct vm_area_struct *area)
3054 {
3055 struct snd_pcm_runtime *runtime;
3056 long size;
3057 if (!(area->vm_flags & VM_READ))
3058 return -EINVAL;
3059 runtime = substream->runtime;
3060 snd_assert(runtime != NULL, return -EAGAIN);
3061 size = area->vm_end - area->vm_start;
3062 if (size != PAGE_ALIGN(sizeof(struct snd_pcm_mmap_control)))
3063 return -EINVAL;
3064 area->vm_ops = &snd_pcm_vm_ops_control;
3065 area->vm_private_data = substream;
3066 area->vm_flags |= VM_RESERVED;
3067 return 0;
3068 }
3069 #else /* ! coherent mmap */
3070 /*
3071 * don't support mmap for status and control records.
3072 */
3073 static int snd_pcm_mmap_status(struct snd_pcm_substream *substream, struct file *file,
3074 struct vm_area_struct *area)
3075 {
3076 return -ENXIO;
3077 }
3078 static int snd_pcm_mmap_control(struct snd_pcm_substream *substream, struct file *file,
3079 struct vm_area_struct *area)
3080 {
3081 return -ENXIO;
3082 }
3083 #endif /* coherent mmap */
3084
3085 /*
3086 * nopage callback for mmapping a RAM page
3087 */
3088 static struct page *snd_pcm_mmap_data_nopage(struct vm_area_struct *area,
3089 unsigned long address, int *type)
3090 {
3091 struct snd_pcm_substream *substream = area->vm_private_data;
3092 struct snd_pcm_runtime *runtime;
3093 unsigned long offset;
3094 struct page * page;
3095 void *vaddr;
3096 size_t dma_bytes;
3097
3098 if (substream == NULL)
3099 return NOPAGE_OOM;
3100 runtime = substream->runtime;
3101 offset = area->vm_pgoff << PAGE_SHIFT;
3102 offset += address - area->vm_start;
3103 snd_assert((offset % PAGE_SIZE) == 0, return NOPAGE_OOM);
3104 dma_bytes = PAGE_ALIGN(runtime->dma_bytes);
3105 if (offset > dma_bytes - PAGE_SIZE)
3106 return NOPAGE_SIGBUS;
3107 if (substream->ops->page) {
3108 page = substream->ops->page(substream, offset);
3109 if (! page)
3110 return NOPAGE_OOM;
3111 } else {
3112 vaddr = runtime->dma_area + offset;
3113 page = virt_to_page(vaddr);
3114 }
3115 get_page(page);
3116 if (type)
3117 *type = VM_FAULT_MINOR;
3118 return page;
3119 }
3120
3121 static struct vm_operations_struct snd_pcm_vm_ops_data =
3122 {
3123 .open = snd_pcm_mmap_data_open,
3124 .close = snd_pcm_mmap_data_close,
3125 .nopage = snd_pcm_mmap_data_nopage,
3126 };
3127
3128 /*
3129 * mmap the DMA buffer on RAM
3130 */
3131 static int snd_pcm_default_mmap(struct snd_pcm_substream *substream,
3132 struct vm_area_struct *area)
3133 {
3134 area->vm_ops = &snd_pcm_vm_ops_data;
3135 area->vm_private_data = substream;
3136 area->vm_flags |= VM_RESERVED;
3137 atomic_inc(&substream->runtime->mmap_count);
3138 return 0;
3139 }
3140
3141 /*
3142 * mmap the DMA buffer on I/O memory area
3143 */
3144 #if SNDRV_PCM_INFO_MMAP_IOMEM
3145 static struct vm_operations_struct snd_pcm_vm_ops_data_mmio =
3146 {
3147 .open = snd_pcm_mmap_data_open,
3148 .close = snd_pcm_mmap_data_close,
3149 };
3150
3151 int snd_pcm_lib_mmap_iomem(struct snd_pcm_substream *substream,
3152 struct vm_area_struct *area)
3153 {
3154 long size;
3155 unsigned long offset;
3156
3157 #ifdef pgprot_noncached
3158 area->vm_page_prot = pgprot_noncached(area->vm_page_prot);
3159 #endif
3160 area->vm_ops = &snd_pcm_vm_ops_data_mmio;
3161 area->vm_private_data = substream;
3162 area->vm_flags |= VM_IO;
3163 size = area->vm_end - area->vm_start;
3164 offset = area->vm_pgoff << PAGE_SHIFT;
3165 if (io_remap_pfn_range(area, area->vm_start,
3166 (substream->runtime->dma_addr + offset) >> PAGE_SHIFT,
3167 size, area->vm_page_prot))
3168 return -EAGAIN;
3169 atomic_inc(&substream->runtime->mmap_count);
3170 return 0;
3171 }
3172 #endif /* SNDRV_PCM_INFO_MMAP */
3173
3174 /*
3175 * mmap DMA buffer
3176 */
3177 int snd_pcm_mmap_data(struct snd_pcm_substream *substream, struct file *file,
3178 struct vm_area_struct *area)
3179 {
3180 struct snd_pcm_runtime *runtime;
3181 long size;
3182 unsigned long offset;
3183 size_t dma_bytes;
3184
3185 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
3186 if (!(area->vm_flags & (VM_WRITE|VM_READ)))
3187 return -EINVAL;
3188 } else {
3189 if (!(area->vm_flags & VM_READ))
3190 return -EINVAL;
3191 }
3192 runtime = substream->runtime;
3193 snd_assert(runtime != NULL, return -EAGAIN);
3194 if (runtime->status->state == SNDRV_PCM_STATE_OPEN)
3195 return -EBADFD;
3196 if (!(runtime->info & SNDRV_PCM_INFO_MMAP))
3197 return -ENXIO;
3198 if (runtime->access == SNDRV_PCM_ACCESS_RW_INTERLEAVED ||
3199 runtime->access == SNDRV_PCM_ACCESS_RW_NONINTERLEAVED)
3200 return -EINVAL;
3201 size = area->vm_end - area->vm_start;
3202 offset = area->vm_pgoff << PAGE_SHIFT;
3203 dma_bytes = PAGE_ALIGN(runtime->dma_bytes);
3204 if ((size_t)size > dma_bytes)
3205 return -EINVAL;
3206 if (offset > dma_bytes - size)
3207 return -EINVAL;
3208
3209 if (substream->ops->mmap)
3210 return substream->ops->mmap(substream, area);
3211 else
3212 return snd_pcm_default_mmap(substream, area);
3213 }
3214
3215 static int snd_pcm_mmap(struct file *file, struct vm_area_struct *area)
3216 {
3217 struct snd_pcm_file * pcm_file;
3218 struct snd_pcm_substream *substream;
3219 unsigned long offset;
3220
3221 pcm_file = file->private_data;
3222 substream = pcm_file->substream;
3223 snd_assert(substream != NULL, return -ENXIO);
3224
3225 offset = area->vm_pgoff << PAGE_SHIFT;
3226 switch (offset) {
3227 case SNDRV_PCM_MMAP_OFFSET_STATUS:
3228 if (substream->no_mmap_ctrl)
3229 return -ENXIO;
3230 return snd_pcm_mmap_status(substream, file, area);
3231 case SNDRV_PCM_MMAP_OFFSET_CONTROL:
3232 if (substream->no_mmap_ctrl)
3233 return -ENXIO;
3234 return snd_pcm_mmap_control(substream, file, area);
3235 default:
3236 return snd_pcm_mmap_data(substream, file, area);
3237 }
3238 return 0;
3239 }
3240
3241 static int snd_pcm_fasync(int fd, struct file * file, int on)
3242 {
3243 struct snd_pcm_file * pcm_file;
3244 struct snd_pcm_substream *substream;
3245 struct snd_pcm_runtime *runtime;
3246 int err;
3247
3248 pcm_file = file->private_data;
3249 substream = pcm_file->substream;
3250 snd_assert(substream != NULL, return -ENXIO);
3251 runtime = substream->runtime;
3252
3253 err = fasync_helper(fd, file, on, &runtime->fasync);
3254 if (err < 0)
3255 return err;
3256 return 0;
3257 }
3258
3259 /*
3260 * ioctl32 compat
3261 */
3262 #ifdef CONFIG_COMPAT
3263 #include "pcm_compat.c"
3264 #else
3265 #define snd_pcm_ioctl_compat NULL
3266 #endif
3267
3268 /*
3269 * To be removed helpers to keep binary compatibility
3270 */
3271
3272 #ifdef CONFIG_SND_SUPPORT_OLD_API
3273 #define __OLD_TO_NEW_MASK(x) ((x&7)|((x&0x07fffff8)<<5))
3274 #define __NEW_TO_OLD_MASK(x) ((x&7)|((x&0xffffff00)>>5))
3275
3276 static void snd_pcm_hw_convert_from_old_params(struct snd_pcm_hw_params *params,
3277 struct snd_pcm_hw_params_old *oparams)
3278 {
3279 unsigned int i;
3280
3281 memset(params, 0, sizeof(*params));
3282 params->flags = oparams->flags;
3283 for (i = 0; i < ARRAY_SIZE(oparams->masks); i++)
3284 params->masks[i].bits[0] = oparams->masks[i];
3285 memcpy(params->intervals, oparams->intervals, sizeof(oparams->intervals));
3286 params->rmask = __OLD_TO_NEW_MASK(oparams->rmask);
3287 params->cmask = __OLD_TO_NEW_MASK(oparams->cmask);
3288 params->info = oparams->info;
3289 params->msbits = oparams->msbits;
3290 params->rate_num = oparams->rate_num;
3291 params->rate_den = oparams->rate_den;
3292 params->fifo_size = oparams->fifo_size;
3293 }
3294
3295 static void snd_pcm_hw_convert_to_old_params(struct snd_pcm_hw_params_old *oparams,
3296 struct snd_pcm_hw_params *params)
3297 {
3298 unsigned int i;
3299
3300 memset(oparams, 0, sizeof(*oparams));
3301 oparams->flags = params->flags;
3302 for (i = 0; i < ARRAY_SIZE(oparams->masks); i++)
3303 oparams->masks[i] = params->masks[i].bits[0];
3304 memcpy(oparams->intervals, params->intervals, sizeof(oparams->intervals));
3305 oparams->rmask = __NEW_TO_OLD_MASK(params->rmask);
3306 oparams->cmask = __NEW_TO_OLD_MASK(params->cmask);
3307 oparams->info = params->info;
3308 oparams->msbits = params->msbits;
3309 oparams->rate_num = params->rate_num;
3310 oparams->rate_den = params->rate_den;
3311 oparams->fifo_size = params->fifo_size;
3312 }
3313
3314 static int snd_pcm_hw_refine_old_user(struct snd_pcm_substream *substream,
3315 struct snd_pcm_hw_params_old __user * _oparams)
3316 {
3317 struct snd_pcm_hw_params *params;
3318 struct snd_pcm_hw_params_old *oparams = NULL;
3319 int err;
3320
3321 params = kmalloc(sizeof(*params), GFP_KERNEL);
3322 if (!params) {
3323 err = -ENOMEM;
3324 goto out;
3325 }
3326 oparams = kmalloc(sizeof(*oparams), GFP_KERNEL);
3327 if (!oparams) {
3328 err = -ENOMEM;
3329 goto out;
3330 }
3331
3332 if (copy_from_user(oparams, _oparams, sizeof(*oparams))) {
3333 err = -EFAULT;
3334 goto out;
3335 }
3336 snd_pcm_hw_convert_from_old_params(params, oparams);
3337 err = snd_pcm_hw_refine(substream, params);
3338 snd_pcm_hw_convert_to_old_params(oparams, params);
3339 if (copy_to_user(_oparams, oparams, sizeof(*oparams))) {
3340 if (!err)
3341 err = -EFAULT;
3342 }
3343 out:
3344 kfree(params);
3345 kfree(oparams);
3346 return err;
3347 }
3348
3349 static int snd_pcm_hw_params_old_user(struct snd_pcm_substream *substream,
3350 struct snd_pcm_hw_params_old __user * _oparams)
3351 {
3352 struct snd_pcm_hw_params *params;
3353 struct snd_pcm_hw_params_old *oparams = NULL;
3354 int err;
3355
3356 params = kmalloc(sizeof(*params), GFP_KERNEL);
3357 if (!params) {
3358 err = -ENOMEM;
3359 goto out;
3360 }
3361 oparams = kmalloc(sizeof(*oparams), GFP_KERNEL);
3362 if (!oparams) {
3363 err = -ENOMEM;
3364 goto out;
3365 }
3366 if (copy_from_user(oparams, _oparams, sizeof(*oparams))) {
3367 err = -EFAULT;
3368 goto out;
3369 }
3370 snd_pcm_hw_convert_from_old_params(params, oparams);
3371 err = snd_pcm_hw_params(substream, params);
3372 snd_pcm_hw_convert_to_old_params(oparams, params);
3373 if (copy_to_user(_oparams, oparams, sizeof(*oparams))) {
3374 if (!err)
3375 err = -EFAULT;
3376 }
3377 out:
3378 kfree(params);
3379 kfree(oparams);
3380 return err;
3381 }
3382 #endif /* CONFIG_SND_SUPPORT_OLD_API */
3383
3384 /*
3385 * Register section
3386 */
3387
3388 struct file_operations snd_pcm_f_ops[2] = {
3389 {
3390 .owner = THIS_MODULE,
3391 .write = snd_pcm_write,
3392 .writev = snd_pcm_writev,
3393 .open = snd_pcm_playback_open,
3394 .release = snd_pcm_release,
3395 .poll = snd_pcm_playback_poll,
3396 .unlocked_ioctl = snd_pcm_playback_ioctl,
3397 .compat_ioctl = snd_pcm_ioctl_compat,
3398 .mmap = snd_pcm_mmap,
3399 .fasync = snd_pcm_fasync,
3400 },
3401 {
3402 .owner = THIS_MODULE,
3403 .read = snd_pcm_read,
3404 .readv = snd_pcm_readv,
3405 .open = snd_pcm_capture_open,
3406 .release = snd_pcm_release,
3407 .poll = snd_pcm_capture_poll,
3408 .unlocked_ioctl = snd_pcm_capture_ioctl,
3409 .compat_ioctl = snd_pcm_ioctl_compat,
3410 .mmap = snd_pcm_mmap,
3411 .fasync = snd_pcm_fasync,
3412 }
3413 };
Verdex Pro support