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