git.oblomov.eu Git - linux-2.6/blob - sound/core/pcm_native.c

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