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