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