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