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