sound/core/oss/pcm_oss.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  *  Digital Audio (PCM) abstract layer / OSS compatible
   4  *  Copyright (c) by Jaroslav Kysela <perex@perex.cz>
   5  */
   6
   7 #if 0
   8 #define PLUGIN_DEBUG
   9 #endif
  10 #if 0
  11 #define OSS_DEBUG
  12 #endif
  13
  14 #include <linux/init.h>
  15 #include <linux/slab.h>
  16 #include <linux/sched/signal.h>
  17 #include <linux/time.h>
  18 #include <linux/vmalloc.h>
  19 #include <linux/module.h>
  20 #include <linux/math64.h>
  21 #include <linux/string.h>
  22 #include <linux/compat.h>
  23 #include <sound/core.h>
  24 #include <sound/minors.h>
  25 #include <sound/pcm.h>
  26 #include <sound/pcm_params.h>
  27 #include "pcm_plugin.h"
  28 #include <sound/info.h>
  29 #include <linux/soundcard.h>
  30 #include <sound/initval.h>
  31 #include <sound/mixer_oss.h>
  32
  33 #define OSS_ALSAEMULVER         _SIOR ('M', 249, int)
  34
  35 static int dsp_map[SNDRV_CARDS];
  36 static int adsp_map[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = 1};
  37 static bool nonblock_open = 1;
  38
  39 MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>, Abramo Bagnara <abramo@alsa-project.org>");
  40 MODULE_DESCRIPTION("PCM OSS emulation for ALSA.");
  41 MODULE_LICENSE("GPL");
  42 module_param_array(dsp_map, int, NULL, 0444);
  43 MODULE_PARM_DESC(dsp_map, "PCM device number assigned to 1st OSS device.");
  44 module_param_array(adsp_map, int, NULL, 0444);
  45 MODULE_PARM_DESC(adsp_map, "PCM device number assigned to 2nd OSS device.");
  46 module_param(nonblock_open, bool, 0644);
  47 MODULE_PARM_DESC(nonblock_open, "Don't block opening busy PCM devices.");
  48 MODULE_ALIAS_SNDRV_MINOR(SNDRV_MINOR_OSS_PCM);
  49 MODULE_ALIAS_SNDRV_MINOR(SNDRV_MINOR_OSS_PCM1);
  50
  51 static int snd_pcm_oss_get_rate(struct snd_pcm_oss_file *pcm_oss_file);
  52 static int snd_pcm_oss_get_channels(struct snd_pcm_oss_file *pcm_oss_file);
  53 static int snd_pcm_oss_get_format(struct snd_pcm_oss_file *pcm_oss_file);
  54
  55 /*
  56  * helper functions to process hw_params
  57  */
  58 static int snd_interval_refine_min(struct snd_interval *i, unsigned int min, int openmin)
  59 {
  60         int changed = 0;
  61         if (i->min < min) {
  62                 i->min = min;
  63                 i->openmin = openmin;
  64                 changed = 1;
  65         } else if (i->min == min && !i->openmin && openmin) {
  66                 i->openmin = 1;
  67                 changed = 1;
  68         }
  69         if (i->integer) {
  70                 if (i->openmin) {
  71                         i->min++;
  72                         i->openmin = 0;
  73                 }
  74         }
  75         if (snd_interval_checkempty(i)) {
  76                 snd_interval_none(i);
  77                 return -EINVAL;
  78         }
  79         return changed;
  80 }
  81
  82 static int snd_interval_refine_max(struct snd_interval *i, unsigned int max, int openmax)
  83 {
  84         int changed = 0;
  85         if (i->max > max) {
  86                 i->max = max;
  87                 i->openmax = openmax;
  88                 changed = 1;
  89         } else if (i->max == max && !i->openmax && openmax) {
  90                 i->openmax = 1;
  91                 changed = 1;
  92         }
  93         if (i->integer) {
  94                 if (i->openmax) {
  95                         i->max--;
  96                         i->openmax = 0;
  97                 }
  98         }
  99         if (snd_interval_checkempty(i)) {
 100                 snd_interval_none(i);
 101                 return -EINVAL;
 102         }
 103         return changed;
 104 }
 105
 106 static int snd_interval_refine_set(struct snd_interval *i, unsigned int val)
 107 {
 108         struct snd_interval t;
 109         t.empty = 0;
 110         t.min = t.max = val;
 111         t.openmin = t.openmax = 0;
 112         t.integer = 1;
 113         return snd_interval_refine(i, &t);
 114 }
 115
 116 /**
 117  * snd_pcm_hw_param_value_min
 118  * @params: the hw_params instance
 119  * @var: parameter to retrieve
 120  * @dir: pointer to the direction (-1,0,1) or NULL
 121  *
 122  * Return the minimum value for field PAR.
 123  */
 124 static unsigned int
 125 snd_pcm_hw_param_value_min(const struct snd_pcm_hw_params *params,
 126                            snd_pcm_hw_param_t var, int *dir)
 127 {
 128         if (hw_is_mask(var)) {
 129                 if (dir)
 130                         *dir = 0;
 131                 return snd_mask_min(hw_param_mask_c(params, var));
 132         }
 133         if (hw_is_interval(var)) {
 134                 const struct snd_interval *i = hw_param_interval_c(params, var);
 135                 if (dir)
 136                         *dir = i->openmin;
 137                 return snd_interval_min(i);
 138         }
 139         return -EINVAL;
 140 }
 141
 142 /**
 143  * snd_pcm_hw_param_value_max
 144  * @params: the hw_params instance
 145  * @var: parameter to retrieve
 146  * @dir: pointer to the direction (-1,0,1) or NULL
 147  *
 148  * Return the maximum value for field PAR.
 149  */
 150 static int
 151 snd_pcm_hw_param_value_max(const struct snd_pcm_hw_params *params,
 152                            snd_pcm_hw_param_t var, int *dir)
 153 {
 154         if (hw_is_mask(var)) {
 155                 if (dir)
 156                         *dir = 0;
 157                 return snd_mask_max(hw_param_mask_c(params, var));
 158         }
 159         if (hw_is_interval(var)) {
 160                 const struct snd_interval *i = hw_param_interval_c(params, var);
 161                 if (dir)
 162                         *dir = - (int) i->openmax;
 163                 return snd_interval_max(i);
 164         }
 165         return -EINVAL;
 166 }
 167
 168 static int _snd_pcm_hw_param_mask(struct snd_pcm_hw_params *params,
 169                                   snd_pcm_hw_param_t var,
 170                                   const struct snd_mask *val)
 171 {
 172         int changed;
 173         changed = snd_mask_refine(hw_param_mask(params, var), val);
 174         if (changed > 0) {
 175                 params->cmask |= 1 << var;
 176                 params->rmask |= 1 << var;
 177         }
 178         return changed;
 179 }
 180
 181 static int snd_pcm_hw_param_mask(struct snd_pcm_substream *pcm,
 182                                  struct snd_pcm_hw_params *params,
 183                                  snd_pcm_hw_param_t var,
 184                                  const struct snd_mask *val)
 185 {
 186         int changed = _snd_pcm_hw_param_mask(params, var, val);
 187         if (changed < 0)
 188                 return changed;
 189         if (params->rmask) {
 190                 int err = snd_pcm_hw_refine(pcm, params);
 191                 if (err < 0)
 192                         return err;
 193         }
 194         return 0;
 195 }
 196
 197 static int _snd_pcm_hw_param_min(struct snd_pcm_hw_params *params,
 198                                  snd_pcm_hw_param_t var, unsigned int val,
 199                                  int dir)
 200 {
 201         int changed;
 202         int open = 0;
 203         if (dir) {
 204                 if (dir > 0) {
 205                         open = 1;
 206                 } else if (dir < 0) {
 207                         if (val > 0) {
 208                                 open = 1;
 209                                 val--;
 210                         }
 211                 }
 212         }
 213         if (hw_is_mask(var))
 214                 changed = snd_mask_refine_min(hw_param_mask(params, var),
 215                                               val + !!open);
 216         else if (hw_is_interval(var))
 217                 changed = snd_interval_refine_min(hw_param_interval(params, var),
 218                                                   val, open);
 219         else
 220                 return -EINVAL;
 221         if (changed > 0) {
 222                 params->cmask |= 1 << var;
 223                 params->rmask |= 1 << var;
 224         }
 225         return changed;
 226 }
 227
 228 /**
 229  * snd_pcm_hw_param_min
 230  * @pcm: PCM instance
 231  * @params: the hw_params instance
 232  * @var: parameter to retrieve
 233  * @val: minimal value
 234  * @dir: pointer to the direction (-1,0,1) or NULL
 235  *
 236  * Inside configuration space defined by PARAMS remove from PAR all
 237  * values < VAL. Reduce configuration space accordingly.
 238  * Return new minimum or -EINVAL if the configuration space is empty
 239  */
 240 static int snd_pcm_hw_param_min(struct snd_pcm_substream *pcm,
 241                                 struct snd_pcm_hw_params *params,
 242                                 snd_pcm_hw_param_t var, unsigned int val,
 243                                 int *dir)
 244 {
 245         int changed = _snd_pcm_hw_param_min(params, var, val, dir ? *dir : 0);
 246         if (changed < 0)
 247                 return changed;
 248         if (params->rmask) {
 249                 int err = snd_pcm_hw_refine(pcm, params);
 250                 if (err < 0)
 251                         return err;
 252         }
 253         return snd_pcm_hw_param_value_min(params, var, dir);
 254 }
 255
 256 static int _snd_pcm_hw_param_max(struct snd_pcm_hw_params *params,
 257                                  snd_pcm_hw_param_t var, unsigned int val,
 258                                  int dir)
 259 {
 260         int changed;
 261         int open = 0;
 262         if (dir) {
 263                 if (dir < 0) {
 264                         open = 1;
 265                 } else if (dir > 0) {
 266                         open = 1;
 267                         val++;
 268                 }
 269         }
 270         if (hw_is_mask(var)) {
 271                 if (val == 0 && open) {
 272                         snd_mask_none(hw_param_mask(params, var));
 273                         changed = -EINVAL;
 274                 } else
 275                         changed = snd_mask_refine_max(hw_param_mask(params, var),
 276                                                       val - !!open);
 277         } else if (hw_is_interval(var))
 278                 changed = snd_interval_refine_max(hw_param_interval(params, var),
 279                                                   val, open);
 280         else
 281                 return -EINVAL;
 282         if (changed > 0) {
 283                 params->cmask |= 1 << var;
 284                 params->rmask |= 1 << var;
 285         }
 286         return changed;
 287 }
 288
 289 /**
 290  * snd_pcm_hw_param_max
 291  * @pcm: PCM instance
 292  * @params: the hw_params instance
 293  * @var: parameter to retrieve
 294  * @val: maximal value
 295  * @dir: pointer to the direction (-1,0,1) or NULL
 296  *
 297  * Inside configuration space defined by PARAMS remove from PAR all
 298  *  values >= VAL + 1. Reduce configuration space accordingly.
 299  *  Return new maximum or -EINVAL if the configuration space is empty
 300  */
 301 static int snd_pcm_hw_param_max(struct snd_pcm_substream *pcm,
 302                                 struct snd_pcm_hw_params *params,
 303                                 snd_pcm_hw_param_t var, unsigned int val,
 304                                 int *dir)
 305 {
 306         int changed = _snd_pcm_hw_param_max(params, var, val, dir ? *dir : 0);
 307         if (changed < 0)
 308                 return changed;
 309         if (params->rmask) {
 310                 int err = snd_pcm_hw_refine(pcm, params);
 311                 if (err < 0)
 312                         return err;
 313         }
 314         return snd_pcm_hw_param_value_max(params, var, dir);
 315 }
 316
 317 static int boundary_sub(int a, int adir,
 318                         int b, int bdir,
 319                         int *c, int *cdir)
 320 {
 321         adir = adir < 0 ? -1 : (adir > 0 ? 1 : 0);
 322         bdir = bdir < 0 ? -1 : (bdir > 0 ? 1 : 0);
 323         *c = a - b;
 324         *cdir = adir - bdir;
 325         if (*cdir == -2) {
 326                 (*c)--;
 327         } else if (*cdir == 2) {
 328                 (*c)++;
 329         }
 330         return 0;
 331 }
 332
 333 static int boundary_lt(unsigned int a, int adir,
 334                        unsigned int b, int bdir)
 335 {
 336         if (adir < 0) {
 337                 a--;
 338                 adir = 1;
 339         } else if (adir > 0)
 340                 adir = 1;
 341         if (bdir < 0) {
 342                 b--;
 343                 bdir = 1;
 344         } else if (bdir > 0)
 345                 bdir = 1;
 346         return a < b || (a == b && adir < bdir);
 347 }
 348
 349 /* Return 1 if min is nearer to best than max */
 350 static int boundary_nearer(int min, int mindir,
 351                            int best, int bestdir,
 352                            int max, int maxdir)
 353 {
 354         int dmin, dmindir;
 355         int dmax, dmaxdir;
 356         boundary_sub(best, bestdir, min, mindir, &dmin, &dmindir);
 357         boundary_sub(max, maxdir, best, bestdir, &dmax, &dmaxdir);
 358         return boundary_lt(dmin, dmindir, dmax, dmaxdir);
 359 }
 360
 361 /**
 362  * snd_pcm_hw_param_near
 363  * @pcm: PCM instance
 364  * @params: the hw_params instance
 365  * @var: parameter to retrieve
 366  * @best: value to set
 367  * @dir: pointer to the direction (-1,0,1) or NULL
 368  *
 369  * Inside configuration space defined by PARAMS set PAR to the available value
 370  * nearest to VAL. Reduce configuration space accordingly.
 371  * This function cannot be called for SNDRV_PCM_HW_PARAM_ACCESS,
 372  * SNDRV_PCM_HW_PARAM_FORMAT, SNDRV_PCM_HW_PARAM_SUBFORMAT.
 373  * Return the value found.
 374   */
 375 static int snd_pcm_hw_param_near(struct snd_pcm_substream *pcm,
 376                                  struct snd_pcm_hw_params *params,
 377                                  snd_pcm_hw_param_t var, unsigned int best,
 378                                  int *dir)
 379 {
 380         struct snd_pcm_hw_params *save = NULL;
 381         int v;
 382         unsigned int saved_min;
 383         int last = 0;
 384         int min, max;
 385         int mindir, maxdir;
 386         int valdir = dir ? *dir : 0;
 387         /* FIXME */
 388         if (best > INT_MAX)
 389                 best = INT_MAX;
 390         min = max = best;
 391         mindir = maxdir = valdir;
 392         if (maxdir > 0)
 393                 maxdir = 0;
 394         else if (maxdir == 0)
 395                 maxdir = -1;
 396         else {
 397                 maxdir = 1;
 398                 max--;
 399         }
 400         save = kmalloc(sizeof(*save), GFP_KERNEL);
 401         if (save == NULL)
 402                 return -ENOMEM;
 403         *save = *params;
 404         saved_min = min;
 405         min = snd_pcm_hw_param_min(pcm, params, var, min, &mindir);
 406         if (min >= 0) {
 407                 struct snd_pcm_hw_params *params1;
 408                 if (max < 0)
 409                         goto _end;
 410                 if ((unsigned int)min == saved_min && mindir == valdir)
 411                         goto _end;
 412                 params1 = kmalloc(sizeof(*params1), GFP_KERNEL);
 413                 if (params1 == NULL) {
 414                         kfree(save);
 415                         return -ENOMEM;
 416                 }
 417                 *params1 = *save;
 418                 max = snd_pcm_hw_param_max(pcm, params1, var, max, &maxdir);
 419                 if (max < 0) {
 420                         kfree(params1);
 421                         goto _end;
 422                 }
 423                 if (boundary_nearer(max, maxdir, best, valdir, min, mindir)) {
 424                         *params = *params1;
 425                         last = 1;
 426                 }
 427                 kfree(params1);
 428         } else {
 429                 *params = *save;
 430                 max = snd_pcm_hw_param_max(pcm, params, var, max, &maxdir);
 431                 if (max < 0) {
 432                         kfree(save);
 433                         return max;
 434                 }
 435                 last = 1;
 436         }
 437  _end:
 438         kfree(save);
 439         if (last)
 440                 v = snd_pcm_hw_param_last(pcm, params, var, dir);
 441         else
 442                 v = snd_pcm_hw_param_first(pcm, params, var, dir);
 443         return v;
 444 }
 445
 446 static int _snd_pcm_hw_param_set(struct snd_pcm_hw_params *params,
 447                                  snd_pcm_hw_param_t var, unsigned int val,
 448                                  int dir)
 449 {
 450         int changed;
 451         if (hw_is_mask(var)) {
 452                 struct snd_mask *m = hw_param_mask(params, var);
 453                 if (val == 0 && dir < 0) {
 454                         changed = -EINVAL;
 455                         snd_mask_none(m);
 456                 } else {
 457                         if (dir > 0)
 458                                 val++;
 459                         else if (dir < 0)
 460                                 val--;
 461                         changed = snd_mask_refine_set(hw_param_mask(params, var), val);
 462                 }
 463         } else if (hw_is_interval(var)) {
 464                 struct snd_interval *i = hw_param_interval(params, var);
 465                 if (val == 0 && dir < 0) {
 466                         changed = -EINVAL;
 467                         snd_interval_none(i);
 468                 } else if (dir == 0)
 469                         changed = snd_interval_refine_set(i, val);
 470                 else {
 471                         struct snd_interval t;
 472                         t.openmin = 1;
 473                         t.openmax = 1;
 474                         t.empty = 0;
 475                         t.integer = 0;
 476                         if (dir < 0) {
 477                                 t.min = val - 1;
 478                                 t.max = val;
 479                         } else {
 480                                 t.min = val;
 481                                 t.max = val+1;
 482                         }
 483                         changed = snd_interval_refine(i, &t);
 484                 }
 485         } else
 486                 return -EINVAL;
 487         if (changed > 0) {
 488                 params->cmask |= 1 << var;
 489                 params->rmask |= 1 << var;
 490         }
 491         return changed;
 492 }
 493
 494 /**
 495  * snd_pcm_hw_param_set
 496  * @pcm: PCM instance
 497  * @params: the hw_params instance
 498  * @var: parameter to retrieve
 499  * @val: value to set
 500  * @dir: pointer to the direction (-1,0,1) or NULL
 501  *
 502  * Inside configuration space defined by PARAMS remove from PAR all
 503  * values != VAL. Reduce configuration space accordingly.
 504  *  Return VAL or -EINVAL if the configuration space is empty
 505  */
 506 static int snd_pcm_hw_param_set(struct snd_pcm_substream *pcm,
 507                                 struct snd_pcm_hw_params *params,
 508                                 snd_pcm_hw_param_t var, unsigned int val,
 509                                 int dir)
 510 {
 511         int changed = _snd_pcm_hw_param_set(params, var, val, dir);
 512         if (changed < 0)
 513                 return changed;
 514         if (params->rmask) {
 515                 int err = snd_pcm_hw_refine(pcm, params);
 516                 if (err < 0)
 517                         return err;
 518         }
 519         return snd_pcm_hw_param_value(params, var, NULL);
 520 }
 521
 522 static int _snd_pcm_hw_param_setinteger(struct snd_pcm_hw_params *params,
 523                                         snd_pcm_hw_param_t var)
 524 {
 525         int changed;
 526         changed = snd_interval_setinteger(hw_param_interval(params, var));
 527         if (changed > 0) {
 528                 params->cmask |= 1 << var;
 529                 params->rmask |= 1 << var;
 530         }
 531         return changed;
 532 }
 533
 534 /*
 535  * plugin
 536  */
 537
 538 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
 539 static int snd_pcm_oss_plugin_clear(struct snd_pcm_substream *substream)
 540 {
 541         struct snd_pcm_runtime *runtime = substream->runtime;
 542         struct snd_pcm_plugin *plugin, *next;
 543
 544         plugin = runtime->oss.plugin_first;
 545         while (plugin) {
 546                 next = plugin->next;
 547                 snd_pcm_plugin_free(plugin);
 548                 plugin = next;
 549         }
 550         runtime->oss.plugin_first = runtime->oss.plugin_last = NULL;
 551         return 0;
 552 }
 553
 554 static int snd_pcm_plugin_insert(struct snd_pcm_plugin *plugin)
 555 {
 556         struct snd_pcm_runtime *runtime = plugin->plug->runtime;
 557         plugin->next = runtime->oss.plugin_first;
 558         plugin->prev = NULL;
 559         if (runtime->oss.plugin_first) {
 560                 runtime->oss.plugin_first->prev = plugin;
 561                 runtime->oss.plugin_first = plugin;
 562         } else {
 563                 runtime->oss.plugin_last =
 564                 runtime->oss.plugin_first = plugin;
 565         }
 566         return 0;
 567 }
 568
 569 int snd_pcm_plugin_append(struct snd_pcm_plugin *plugin)
 570 {
 571         struct snd_pcm_runtime *runtime = plugin->plug->runtime;
 572         plugin->next = NULL;
 573         plugin->prev = runtime->oss.plugin_last;
 574         if (runtime->oss.plugin_last) {
 575                 runtime->oss.plugin_last->next = plugin;
 576                 runtime->oss.plugin_last = plugin;
 577         } else {
 578                 runtime->oss.plugin_last =
 579                 runtime->oss.plugin_first = plugin;
 580         }
 581         return 0;
 582 }
 583 #endif /* CONFIG_SND_PCM_OSS_PLUGINS */
 584
 585 static long snd_pcm_oss_bytes(struct snd_pcm_substream *substream, long frames)
 586 {
 587         struct snd_pcm_runtime *runtime = substream->runtime;
 588         long buffer_size = snd_pcm_lib_buffer_bytes(substream);
 589         long bytes = frames_to_bytes(runtime, frames);
 590         if (buffer_size == runtime->oss.buffer_bytes)
 591                 return bytes;
 592 #if BITS_PER_LONG >= 64
 593         return runtime->oss.buffer_bytes * bytes / buffer_size;
 594 #else
 595         {
 596                 u64 bsize = (u64)runtime->oss.buffer_bytes * (u64)bytes;
 597                 return div_u64(bsize, buffer_size);
 598         }
 599 #endif
 600 }
 601
 602 static long snd_pcm_alsa_frames(struct snd_pcm_substream *substream, long bytes)
 603 {
 604         struct snd_pcm_runtime *runtime = substream->runtime;
 605         long buffer_size = snd_pcm_lib_buffer_bytes(substream);
 606         if (buffer_size == runtime->oss.buffer_bytes)
 607                 return bytes_to_frames(runtime, bytes);
 608         return bytes_to_frames(runtime, (buffer_size * bytes) / runtime->oss.buffer_bytes);
 609 }
 610
 611 static inline
 612 snd_pcm_uframes_t get_hw_ptr_period(struct snd_pcm_runtime *runtime)
 613 {
 614         return runtime->hw_ptr_interrupt;
 615 }
 616
 617 /* define extended formats in the recent OSS versions (if any) */
 618 /* linear formats */
 619 #define AFMT_S32_LE      0x00001000
 620 #define AFMT_S32_BE      0x00002000
 621 #define AFMT_S24_LE      0x00008000
 622 #define AFMT_S24_BE      0x00010000
 623 #define AFMT_S24_PACKED  0x00040000
 624
 625 /* other supported formats */
 626 #define AFMT_FLOAT       0x00004000
 627 #define AFMT_SPDIF_RAW   0x00020000
 628
 629 /* unsupported formats */
 630 #define AFMT_AC3         0x00000400
 631 #define AFMT_VORBIS      0x00000800
 632
 633 static snd_pcm_format_t snd_pcm_oss_format_from(int format)
 634 {
 635         switch (format) {
 636         case AFMT_MU_LAW:       return SNDRV_PCM_FORMAT_MU_LAW;
 637         case AFMT_A_LAW:        return SNDRV_PCM_FORMAT_A_LAW;
 638         case AFMT_IMA_ADPCM:    return SNDRV_PCM_FORMAT_IMA_ADPCM;
 639         case AFMT_U8:           return SNDRV_PCM_FORMAT_U8;
 640         case AFMT_S16_LE:       return SNDRV_PCM_FORMAT_S16_LE;
 641         case AFMT_S16_BE:       return SNDRV_PCM_FORMAT_S16_BE;
 642         case AFMT_S8:           return SNDRV_PCM_FORMAT_S8;
 643         case AFMT_U16_LE:       return SNDRV_PCM_FORMAT_U16_LE;
 644         case AFMT_U16_BE:       return SNDRV_PCM_FORMAT_U16_BE;
 645         case AFMT_MPEG:         return SNDRV_PCM_FORMAT_MPEG;
 646         case AFMT_S32_LE:       return SNDRV_PCM_FORMAT_S32_LE;
 647         case AFMT_S32_BE:       return SNDRV_PCM_FORMAT_S32_BE;
 648         case AFMT_S24_LE:       return SNDRV_PCM_FORMAT_S24_LE;
 649         case AFMT_S24_BE:       return SNDRV_PCM_FORMAT_S24_BE;
 650         case AFMT_S24_PACKED:   return SNDRV_PCM_FORMAT_S24_3LE;
 651         case AFMT_FLOAT:        return SNDRV_PCM_FORMAT_FLOAT;
 652         case AFMT_SPDIF_RAW:    return SNDRV_PCM_FORMAT_IEC958_SUBFRAME;
 653         default:                return SNDRV_PCM_FORMAT_U8;
 654         }
 655 }
 656
 657 static int snd_pcm_oss_format_to(snd_pcm_format_t format)
 658 {
 659         switch (format) {
 660         case SNDRV_PCM_FORMAT_MU_LAW:   return AFMT_MU_LAW;
 661         case SNDRV_PCM_FORMAT_A_LAW:    return AFMT_A_LAW;
 662         case SNDRV_PCM_FORMAT_IMA_ADPCM:        return AFMT_IMA_ADPCM;
 663         case SNDRV_PCM_FORMAT_U8:               return AFMT_U8;
 664         case SNDRV_PCM_FORMAT_S16_LE:   return AFMT_S16_LE;
 665         case SNDRV_PCM_FORMAT_S16_BE:   return AFMT_S16_BE;
 666         case SNDRV_PCM_FORMAT_S8:               return AFMT_S8;
 667         case SNDRV_PCM_FORMAT_U16_LE:   return AFMT_U16_LE;
 668         case SNDRV_PCM_FORMAT_U16_BE:   return AFMT_U16_BE;
 669         case SNDRV_PCM_FORMAT_MPEG:             return AFMT_MPEG;
 670         case SNDRV_PCM_FORMAT_S32_LE:   return AFMT_S32_LE;
 671         case SNDRV_PCM_FORMAT_S32_BE:   return AFMT_S32_BE;
 672         case SNDRV_PCM_FORMAT_S24_LE:   return AFMT_S24_LE;
 673         case SNDRV_PCM_FORMAT_S24_BE:   return AFMT_S24_BE;
 674         case SNDRV_PCM_FORMAT_S24_3LE:  return AFMT_S24_PACKED;
 675         case SNDRV_PCM_FORMAT_FLOAT:    return AFMT_FLOAT;
 676         case SNDRV_PCM_FORMAT_IEC958_SUBFRAME: return AFMT_SPDIF_RAW;
 677         default:                        return -EINVAL;
 678         }
 679 }
 680
 681 static int snd_pcm_oss_period_size(struct snd_pcm_substream *substream,
 682                                    struct snd_pcm_hw_params *oss_params,
 683                                    struct snd_pcm_hw_params *slave_params)
 684 {
 685         ssize_t s;
 686         ssize_t oss_buffer_size;
 687         ssize_t oss_period_size, oss_periods;
 688         ssize_t min_period_size, max_period_size;
 689         struct snd_pcm_runtime *runtime = substream->runtime;
 690         size_t oss_frame_size;
 691
 692         oss_frame_size = snd_pcm_format_physical_width(params_format(oss_params)) *
 693                          params_channels(oss_params) / 8;
 694
 695         oss_buffer_size = snd_pcm_hw_param_value_max(slave_params,
 696                                                      SNDRV_PCM_HW_PARAM_BUFFER_SIZE,
 697                                                      NULL);
 698         if (oss_buffer_size <= 0)
 699                 return -EINVAL;
 700         oss_buffer_size = snd_pcm_plug_client_size(substream,
 701                                                    oss_buffer_size * oss_frame_size);
 702         if (oss_buffer_size <= 0)
 703                 return -EINVAL;
 704         oss_buffer_size = rounddown_pow_of_two(oss_buffer_size);
 705         if (atomic_read(&substream->mmap_count)) {
 706                 if (oss_buffer_size > runtime->oss.mmap_bytes)
 707                         oss_buffer_size = runtime->oss.mmap_bytes;
 708         }
 709
 710         if (substream->oss.setup.period_size > 16)
 711                 oss_period_size = substream->oss.setup.period_size;
 712         else if (runtime->oss.fragshift) {
 713                 oss_period_size = 1 << runtime->oss.fragshift;
 714                 if (oss_period_size > oss_buffer_size / 2)
 715                         oss_period_size = oss_buffer_size / 2;
 716         } else {
 717                 int sd;
 718                 size_t bytes_per_sec = params_rate(oss_params) * snd_pcm_format_physical_width(params_format(oss_params)) * params_channels(oss_params) / 8;
 719
 720                 oss_period_size = oss_buffer_size;
 721                 do {
 722                         oss_period_size /= 2;
 723                 } while (oss_period_size > bytes_per_sec);
 724                 if (runtime->oss.subdivision == 0) {
 725                         sd = 4;
 726                         if (oss_period_size / sd > 4096)
 727                                 sd *= 2;
 728                         if (oss_period_size / sd < 4096)
 729                                 sd = 1;
 730                 } else
 731                         sd = runtime->oss.subdivision;
 732                 oss_period_size /= sd;
 733                 if (oss_period_size < 16)
 734                         oss_period_size = 16;
 735         }
 736
 737         min_period_size = snd_pcm_plug_client_size(substream,
 738                                                    snd_pcm_hw_param_value_min(slave_params, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, NULL));
 739         if (min_period_size > 0) {
 740                 min_period_size *= oss_frame_size;
 741                 min_period_size = roundup_pow_of_two(min_period_size);
 742                 if (oss_period_size < min_period_size)
 743                         oss_period_size = min_period_size;
 744         }
 745
 746         max_period_size = snd_pcm_plug_client_size(substream,
 747                                                    snd_pcm_hw_param_value_max(slave_params, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, NULL));
 748         if (max_period_size > 0) {
 749                 max_period_size *= oss_frame_size;
 750                 max_period_size = rounddown_pow_of_two(max_period_size);
 751                 if (oss_period_size > max_period_size)
 752                         oss_period_size = max_period_size;
 753         }
 754
 755         oss_periods = oss_buffer_size / oss_period_size;
 756
 757         if (substream->oss.setup.periods > 1)
 758                 oss_periods = substream->oss.setup.periods;
 759
 760         s = snd_pcm_hw_param_value_max(slave_params, SNDRV_PCM_HW_PARAM_PERIODS, NULL);
 761         if (s > 0 && runtime->oss.maxfrags && s > runtime->oss.maxfrags)
 762                 s = runtime->oss.maxfrags;
 763         if (oss_periods > s)
 764                 oss_periods = s;
 765
 766         s = snd_pcm_hw_param_value_min(slave_params, SNDRV_PCM_HW_PARAM_PERIODS, NULL);
 767         if (s < 2)
 768                 s = 2;
 769         if (oss_periods < s)
 770                 oss_periods = s;
 771
 772         while (oss_period_size * oss_periods > oss_buffer_size)
 773                 oss_period_size /= 2;
 774
 775         if (oss_period_size < 16)
 776                 return -EINVAL;
 777
 778         /* don't allocate too large period; 1MB period must be enough */
 779         if (oss_period_size > 1024 * 1024)
 780                 return -ENOMEM;
 781
 782         runtime->oss.period_bytes = oss_period_size;
 783         runtime->oss.period_frames = 1;
 784         runtime->oss.periods = oss_periods;
 785         return 0;
 786 }
 787
 788 static int choose_rate(struct snd_pcm_substream *substream,
 789                        struct snd_pcm_hw_params *params, unsigned int best_rate)
 790 {
 791         const struct snd_interval *it;
 792         struct snd_pcm_hw_params *save;
 793         unsigned int rate, prev;
 794
 795         save = kmalloc(sizeof(*save), GFP_KERNEL);
 796         if (save == NULL)
 797                 return -ENOMEM;
 798         *save = *params;
 799         it = hw_param_interval_c(save, SNDRV_PCM_HW_PARAM_RATE);
 800
 801         /* try multiples of the best rate */
 802         rate = best_rate;
 803         for (;;) {
 804                 if (it->max < rate || (it->max == rate && it->openmax))
 805                         break;
 806                 if (it->min < rate || (it->min == rate && !it->openmin)) {
 807                         int ret;
 808                         ret = snd_pcm_hw_param_set(substream, params,
 809                                                    SNDRV_PCM_HW_PARAM_RATE,
 810                                                    rate, 0);
 811                         if (ret == (int)rate) {
 812                                 kfree(save);
 813                                 return rate;
 814                         }
 815                         *params = *save;
 816                 }
 817                 prev = rate;
 818                 rate += best_rate;
 819                 if (rate <= prev)
 820                         break;
 821         }
 822
 823         /* not found, use the nearest rate */
 824         kfree(save);
 825         return snd_pcm_hw_param_near(substream, params, SNDRV_PCM_HW_PARAM_RATE, best_rate, NULL);
 826 }
 827
 828 /* parameter locking: returns immediately if tried during streaming */
 829 static int lock_params(struct snd_pcm_runtime *runtime)
 830 {
 831         if (mutex_lock_interruptible(&runtime->oss.params_lock))
 832                 return -ERESTARTSYS;
 833         if (atomic_read(&runtime->oss.rw_ref)) {
 834                 mutex_unlock(&runtime->oss.params_lock);
 835                 return -EBUSY;
 836         }
 837         return 0;
 838 }
 839
 840 static void unlock_params(struct snd_pcm_runtime *runtime)
 841 {
 842         mutex_unlock(&runtime->oss.params_lock);
 843 }
 844
 845 /* call with params_lock held */
 846 static int snd_pcm_oss_change_params_locked(struct snd_pcm_substream *substream)
 847 {
 848         struct snd_pcm_runtime *runtime = substream->runtime;
 849         struct snd_pcm_hw_params *params, *sparams;
 850         struct snd_pcm_sw_params *sw_params;
 851         ssize_t oss_buffer_size, oss_period_size;
 852         size_t oss_frame_size;
 853         int err;
 854         int direct;
 855         snd_pcm_format_t format, sformat;
 856         int n;
 857         const struct snd_mask *sformat_mask;
 858         struct snd_mask mask;
 859
 860         if (!runtime->oss.params)
 861                 return 0;
 862         sw_params = kzalloc(sizeof(*sw_params), GFP_KERNEL);
 863         params = kmalloc(sizeof(*params), GFP_KERNEL);
 864         sparams = kmalloc(sizeof(*sparams), GFP_KERNEL);
 865         if (!sw_params || !params || !sparams) {
 866                 err = -ENOMEM;
 867                 goto failure;
 868         }
 869
 870         if (atomic_read(&substream->mmap_count))
 871                 direct = 1;
 872         else
 873                 direct = substream->oss.setup.direct;
 874
 875         _snd_pcm_hw_params_any(sparams);
 876         _snd_pcm_hw_param_setinteger(sparams, SNDRV_PCM_HW_PARAM_PERIODS);
 877         _snd_pcm_hw_param_min(sparams, SNDRV_PCM_HW_PARAM_PERIODS, 2, 0);
 878         snd_mask_none(&mask);
 879         if (atomic_read(&substream->mmap_count))
 880                 snd_mask_set(&mask, (__force int)SNDRV_PCM_ACCESS_MMAP_INTERLEAVED);
 881         else {
 882                 snd_mask_set(&mask, (__force int)SNDRV_PCM_ACCESS_RW_INTERLEAVED);
 883                 if (!direct)
 884                         snd_mask_set(&mask, (__force int)SNDRV_PCM_ACCESS_RW_NONINTERLEAVED);
 885         }
 886         err = snd_pcm_hw_param_mask(substream, sparams, SNDRV_PCM_HW_PARAM_ACCESS, &mask);
 887         if (err < 0) {
 888                 pcm_dbg(substream->pcm, "No usable accesses\n");
 889                 err = -EINVAL;
 890                 goto failure;
 891         }
 892
 893         err = choose_rate(substream, sparams, runtime->oss.rate);
 894         if (err < 0)
 895                 goto failure;
 896         err = snd_pcm_hw_param_near(substream, sparams,
 897                                     SNDRV_PCM_HW_PARAM_CHANNELS,
 898                                     runtime->oss.channels, NULL);
 899         if (err < 0)
 900                 goto failure;
 901
 902         format = snd_pcm_oss_format_from(runtime->oss.format);
 903
 904         sformat_mask = hw_param_mask_c(sparams, SNDRV_PCM_HW_PARAM_FORMAT);
 905         if (direct)
 906                 sformat = format;
 907         else
 908                 sformat = snd_pcm_plug_slave_format(format, sformat_mask);
 909
 910         if ((__force int)sformat < 0 ||
 911             !snd_mask_test_format(sformat_mask, sformat)) {
 912                 pcm_for_each_format(sformat) {
 913                         if (snd_mask_test_format(sformat_mask, sformat) &&
 914                             snd_pcm_oss_format_to(sformat) >= 0)
 915                                 goto format_found;
 916                 }
 917                 pcm_dbg(substream->pcm, "Cannot find a format!!!\n");
 918                 err = -EINVAL;
 919                 goto failure;
 920         }
 921  format_found:
 922         err = _snd_pcm_hw_param_set(sparams, SNDRV_PCM_HW_PARAM_FORMAT, (__force int)sformat, 0);
 923         if (err < 0)
 924                 goto failure;
 925
 926         if (direct) {
 927                 memcpy(params, sparams, sizeof(*params));
 928         } else {
 929                 _snd_pcm_hw_params_any(params);
 930                 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_ACCESS,
 931                                       (__force int)SNDRV_PCM_ACCESS_RW_INTERLEAVED, 0);
 932                 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_FORMAT,
 933                                       (__force int)snd_pcm_oss_format_from(runtime->oss.format), 0);
 934                 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_CHANNELS,
 935                                       runtime->oss.channels, 0);
 936                 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_RATE,
 937                                       runtime->oss.rate, 0);
 938                 pdprintf("client: access = %i, format = %i, channels = %i, rate = %i\n",
 939                          params_access(params), params_format(params),
 940                          params_channels(params), params_rate(params));
 941         }
 942         pdprintf("slave: access = %i, format = %i, channels = %i, rate = %i\n",
 943                  params_access(sparams), params_format(sparams),
 944                  params_channels(sparams), params_rate(sparams));
 945
 946         oss_frame_size = snd_pcm_format_physical_width(params_format(params)) *
 947                          params_channels(params) / 8;
 948
 949         err = snd_pcm_oss_period_size(substream, params, sparams);
 950         if (err < 0)
 951                 goto failure;
 952
 953         n = snd_pcm_plug_slave_size(substream, runtime->oss.period_bytes / oss_frame_size);
 954         err = snd_pcm_hw_param_near(substream, sparams, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, n, NULL);
 955         if (err < 0)
 956                 goto failure;
 957
 958         err = snd_pcm_hw_param_near(substream, sparams, SNDRV_PCM_HW_PARAM_PERIODS,
 959                                      runtime->oss.periods, NULL);
 960         if (err < 0)
 961                 goto failure;
 962
 963         snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
 964
 965         err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_HW_PARAMS, sparams);
 966         if (err < 0) {
 967                 pcm_dbg(substream->pcm, "HW_PARAMS failed: %i\n", err);
 968                 goto failure;
 969         }
 970
 971 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
 972         snd_pcm_oss_plugin_clear(substream);
 973         if (!direct) {
 974                 /* add necessary plugins */
 975                 snd_pcm_oss_plugin_clear(substream);
 976                 if ((err = snd_pcm_plug_format_plugins(substream,
 977                                                        params,
 978                                                        sparams)) < 0) {
 979                         pcm_dbg(substream->pcm,
 980                                 "snd_pcm_plug_format_plugins failed: %i\n", err);
 981                         snd_pcm_oss_plugin_clear(substream);
 982                         goto failure;
 983                 }
 984                 if (runtime->oss.plugin_first) {
 985                         struct snd_pcm_plugin *plugin;
 986                         if ((err = snd_pcm_plugin_build_io(substream, sparams, &plugin)) < 0) {
 987                                 pcm_dbg(substream->pcm,
 988                                         "snd_pcm_plugin_build_io failed: %i\n", err);
 989                                 snd_pcm_oss_plugin_clear(substream);
 990                                 goto failure;
 991                         }
 992                         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 993                                 err = snd_pcm_plugin_append(plugin);
 994                         } else {
 995                                 err = snd_pcm_plugin_insert(plugin);
 996                         }
 997                         if (err < 0) {
 998                                 snd_pcm_oss_plugin_clear(substream);
 999                                 goto failure;
1000                         }
1001                 }
1002         }
1003 #endif
1004
1005         if (runtime->oss.trigger) {
1006                 sw_params->start_threshold = 1;
1007         } else {
1008                 sw_params->start_threshold = runtime->boundary;
1009         }
1010         if (atomic_read(&substream->mmap_count) ||
1011             substream->stream == SNDRV_PCM_STREAM_CAPTURE)
1012                 sw_params->stop_threshold = runtime->boundary;
1013         else
1014                 sw_params->stop_threshold = runtime->buffer_size;
1015         sw_params->tstamp_mode = SNDRV_PCM_TSTAMP_NONE;
1016         sw_params->period_step = 1;
1017         sw_params->avail_min = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
1018                 1 : runtime->period_size;
1019         if (atomic_read(&substream->mmap_count) ||
1020             substream->oss.setup.nosilence) {
1021                 sw_params->silence_threshold = 0;
1022                 sw_params->silence_size = 0;
1023         } else {
1024                 snd_pcm_uframes_t frames;
1025                 frames = runtime->period_size + 16;
1026                 if (frames > runtime->buffer_size)
1027                         frames = runtime->buffer_size;
1028                 sw_params->silence_threshold = frames;
1029                 sw_params->silence_size = frames;
1030         }
1031
1032         if ((err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_SW_PARAMS, sw_params)) < 0) {
1033                 pcm_dbg(substream->pcm, "SW_PARAMS failed: %i\n", err);
1034                 goto failure;
1035         }
1036
1037         runtime->oss.periods = params_periods(sparams);
1038         oss_period_size = snd_pcm_plug_client_size(substream, params_period_size(sparams));
1039         if (oss_period_size < 0) {
1040                 err = -EINVAL;
1041                 goto failure;
1042         }
1043 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
1044         if (runtime->oss.plugin_first) {
1045                 err = snd_pcm_plug_alloc(substream, oss_period_size);
1046                 if (err < 0)
1047                         goto failure;
1048         }
1049 #endif
1050         oss_period_size = array_size(oss_period_size, oss_frame_size);
1051         oss_buffer_size = array_size(oss_period_size, runtime->oss.periods);
1052         if (oss_buffer_size <= 0) {
1053                 err = -EINVAL;
1054                 goto failure;
1055         }
1056
1057         runtime->oss.period_bytes = oss_period_size;
1058         runtime->oss.buffer_bytes = oss_buffer_size;
1059
1060         pdprintf("oss: period bytes = %i, buffer bytes = %i\n",
1061                  runtime->oss.period_bytes,
1062                  runtime->oss.buffer_bytes);
1063         pdprintf("slave: period_size = %i, buffer_size = %i\n",
1064                  params_period_size(sparams),
1065                  params_buffer_size(sparams));
1066
1067         runtime->oss.format = snd_pcm_oss_format_to(params_format(params));
1068         runtime->oss.channels = params_channels(params);
1069         runtime->oss.rate = params_rate(params);
1070
1071         kvfree(runtime->oss.buffer);
1072         runtime->oss.buffer = kvzalloc(runtime->oss.period_bytes, GFP_KERNEL);
1073         if (!runtime->oss.buffer) {
1074                 err = -ENOMEM;
1075                 goto failure;
1076         }
1077
1078         runtime->oss.params = 0;
1079         runtime->oss.prepare = 1;
1080         runtime->oss.buffer_used = 0;
1081         if (runtime->dma_area)
1082                 snd_pcm_format_set_silence(runtime->format, runtime->dma_area, bytes_to_samples(runtime, runtime->dma_bytes));
1083
1084         runtime->oss.period_frames = snd_pcm_alsa_frames(substream, oss_period_size);
1085
1086         err = 0;
1087 failure:
1088         kfree(sw_params);
1089         kfree(params);
1090         kfree(sparams);
1091         return err;
1092 }
1093
1094 /* this one takes the lock by itself */
1095 static int snd_pcm_oss_change_params(struct snd_pcm_substream *substream,
1096                                      bool trylock)
1097 {
1098         struct snd_pcm_runtime *runtime = substream->runtime;
1099         int err;
1100
1101         if (trylock) {
1102                 if (!(mutex_trylock(&runtime->oss.params_lock)))
1103                         return -EAGAIN;
1104         } else if (mutex_lock_interruptible(&runtime->oss.params_lock))
1105                 return -ERESTARTSYS;
1106
1107         err = snd_pcm_oss_change_params_locked(substream);
1108         mutex_unlock(&runtime->oss.params_lock);
1109         return err;
1110 }
1111
1112 static int snd_pcm_oss_get_active_substream(struct snd_pcm_oss_file *pcm_oss_file, struct snd_pcm_substream **r_substream)
1113 {
1114         int idx, err;
1115         struct snd_pcm_substream *asubstream = NULL, *substream;
1116
1117         for (idx = 0; idx < 2; idx++) {
1118                 substream = pcm_oss_file->streams[idx];
1119                 if (substream == NULL)
1120                         continue;
1121                 if (asubstream == NULL)
1122                         asubstream = substream;
1123                 if (substream->runtime->oss.params) {
1124                         err = snd_pcm_oss_change_params(substream, false);
1125                         if (err < 0)
1126                                 return err;
1127                 }
1128         }
1129         if (!asubstream)
1130                 return -EIO;
1131         if (r_substream)
1132                 *r_substream = asubstream;
1133         return 0;
1134 }
1135
1136 /* call with params_lock held */
1137 /* NOTE: this always call PREPARE unconditionally no matter whether
1138  * runtime->oss.prepare is set or not
1139  */
1140 static int snd_pcm_oss_prepare(struct snd_pcm_substream *substream)
1141 {
1142         int err;
1143         struct snd_pcm_runtime *runtime = substream->runtime;
1144
1145         err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_PREPARE, NULL);
1146         if (err < 0) {
1147                 pcm_dbg(substream->pcm,
1148                         "snd_pcm_oss_prepare: SNDRV_PCM_IOCTL_PREPARE failed\n");
1149                 return err;
1150         }
1151         runtime->oss.prepare = 0;
1152         runtime->oss.prev_hw_ptr_period = 0;
1153         runtime->oss.period_ptr = 0;
1154         runtime->oss.buffer_used = 0;
1155
1156         return 0;
1157 }
1158
1159 static int snd_pcm_oss_make_ready(struct snd_pcm_substream *substream)
1160 {
1161         struct snd_pcm_runtime *runtime;
1162         int err;
1163
1164         runtime = substream->runtime;
1165         if (runtime->oss.params) {
1166                 err = snd_pcm_oss_change_params(substream, false);
1167                 if (err < 0)
1168                         return err;
1169         }
1170         if (runtime->oss.prepare) {
1171                 if (mutex_lock_interruptible(&runtime->oss.params_lock))
1172                         return -ERESTARTSYS;
1173                 err = snd_pcm_oss_prepare(substream);
1174                 mutex_unlock(&runtime->oss.params_lock);
1175                 if (err < 0)
1176                         return err;
1177         }
1178         return 0;
1179 }
1180
1181 /* call with params_lock held */
1182 static int snd_pcm_oss_make_ready_locked(struct snd_pcm_substream *substream)
1183 {
1184         struct snd_pcm_runtime *runtime;
1185         int err;
1186
1187         runtime = substream->runtime;
1188         if (runtime->oss.params) {
1189                 err = snd_pcm_oss_change_params_locked(substream);
1190                 if (err < 0)
1191                         return err;
1192         }
1193         if (runtime->oss.prepare) {
1194                 err = snd_pcm_oss_prepare(substream);
1195                 if (err < 0)
1196                         return err;
1197         }
1198         return 0;
1199 }
1200
1201 static int snd_pcm_oss_capture_position_fixup(struct snd_pcm_substream *substream, snd_pcm_sframes_t *delay)
1202 {
1203         struct snd_pcm_runtime *runtime;
1204         snd_pcm_uframes_t frames;
1205         int err = 0;
1206
1207         while (1) {
1208                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, delay);
1209                 if (err < 0)
1210                         break;
1211                 runtime = substream->runtime;
1212                 if (*delay <= (snd_pcm_sframes_t)runtime->buffer_size)
1213                         break;
1214                 /* in case of overrun, skip whole periods like OSS/Linux driver does */
1215                 /* until avail(delay) <= buffer_size */
1216                 frames = (*delay - runtime->buffer_size) + runtime->period_size - 1;
1217                 frames /= runtime->period_size;
1218                 frames *= runtime->period_size;
1219                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_FORWARD, &frames);
1220                 if (err < 0)
1221                         break;
1222         }
1223         return err;
1224 }
1225
1226 snd_pcm_sframes_t snd_pcm_oss_write3(struct snd_pcm_substream *substream, const char *ptr, snd_pcm_uframes_t frames, int in_kernel)
1227 {
1228         struct snd_pcm_runtime *runtime = substream->runtime;
1229         int ret;
1230         while (1) {
1231                 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
1232                     runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1233 #ifdef OSS_DEBUG
1234                         pcm_dbg(substream->pcm,
1235                                 "pcm_oss: write: recovering from %s\n",
1236                                 runtime->status->state == SNDRV_PCM_STATE_XRUN ?
1237                                 "XRUN" : "SUSPEND");
1238 #endif
1239                         ret = snd_pcm_oss_prepare(substream);
1240                         if (ret < 0)
1241                                 break;
1242                 }
1243                 mutex_unlock(&runtime->oss.params_lock);
1244                 ret = __snd_pcm_lib_xfer(substream, (void *)ptr, true,
1245                                          frames, in_kernel);
1246                 mutex_lock(&runtime->oss.params_lock);
1247                 if (ret != -EPIPE && ret != -ESTRPIPE)
1248                         break;
1249                 /* test, if we can't store new data, because the stream */
1250                 /* has not been started */
1251                 if (runtime->status->state == SNDRV_PCM_STATE_PREPARED)
1252                         return -EAGAIN;
1253         }
1254         return ret;
1255 }
1256
1257 snd_pcm_sframes_t snd_pcm_oss_read3(struct snd_pcm_substream *substream, char *ptr, snd_pcm_uframes_t frames, int in_kernel)
1258 {
1259         struct snd_pcm_runtime *runtime = substream->runtime;
1260         snd_pcm_sframes_t delay;
1261         int ret;
1262         while (1) {
1263                 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
1264                     runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1265 #ifdef OSS_DEBUG
1266                         pcm_dbg(substream->pcm,
1267                                 "pcm_oss: read: recovering from %s\n",
1268                                 runtime->status->state == SNDRV_PCM_STATE_XRUN ?
1269                                 "XRUN" : "SUSPEND");
1270 #endif
1271                         ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL);
1272                         if (ret < 0)
1273                                 break;
1274                 } else if (runtime->status->state == SNDRV_PCM_STATE_SETUP) {
1275                         ret = snd_pcm_oss_prepare(substream);
1276                         if (ret < 0)
1277                                 break;
1278                 }
1279                 ret = snd_pcm_oss_capture_position_fixup(substream, &delay);
1280                 if (ret < 0)
1281                         break;
1282                 mutex_unlock(&runtime->oss.params_lock);
1283                 ret = __snd_pcm_lib_xfer(substream, (void *)ptr, true,
1284                                          frames, in_kernel);
1285                 mutex_lock(&runtime->oss.params_lock);
1286                 if (ret == -EPIPE) {
1287                         if (runtime->status->state == SNDRV_PCM_STATE_DRAINING) {
1288                                 ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
1289                                 if (ret < 0)
1290                                         break;
1291                         }
1292                         continue;
1293                 }
1294                 if (ret != -ESTRPIPE)
1295                         break;
1296         }
1297         return ret;
1298 }
1299
1300 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
1301 snd_pcm_sframes_t snd_pcm_oss_writev3(struct snd_pcm_substream *substream, void **bufs, snd_pcm_uframes_t frames)
1302 {
1303         struct snd_pcm_runtime *runtime = substream->runtime;
1304         int ret;
1305         while (1) {
1306                 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
1307                     runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1308 #ifdef OSS_DEBUG
1309                         pcm_dbg(substream->pcm,
1310                                 "pcm_oss: writev: recovering from %s\n",
1311                                 runtime->status->state == SNDRV_PCM_STATE_XRUN ?
1312                                 "XRUN" : "SUSPEND");
1313 #endif
1314                         ret = snd_pcm_oss_prepare(substream);
1315                         if (ret < 0)
1316                                 break;
1317                 }
1318                 ret = snd_pcm_kernel_writev(substream, bufs, frames);
1319                 if (ret != -EPIPE && ret != -ESTRPIPE)
1320                         break;
1321
1322                 /* test, if we can't store new data, because the stream */
1323                 /* has not been started */
1324                 if (runtime->status->state == SNDRV_PCM_STATE_PREPARED)
1325                         return -EAGAIN;
1326         }
1327         return ret;
1328 }
1329
1330 snd_pcm_sframes_t snd_pcm_oss_readv3(struct snd_pcm_substream *substream, void **bufs, snd_pcm_uframes_t frames)
1331 {
1332         struct snd_pcm_runtime *runtime = substream->runtime;
1333         int ret;
1334         while (1) {
1335                 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
1336                     runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1337 #ifdef OSS_DEBUG
1338                         pcm_dbg(substream->pcm,
1339                                 "pcm_oss: readv: recovering from %s\n",
1340                                 runtime->status->state == SNDRV_PCM_STATE_XRUN ?
1341                                 "XRUN" : "SUSPEND");
1342 #endif
1343                         ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL);
1344                         if (ret < 0)
1345                                 break;
1346                 } else if (runtime->status->state == SNDRV_PCM_STATE_SETUP) {
1347                         ret = snd_pcm_oss_prepare(substream);
1348                         if (ret < 0)
1349                                 break;
1350                 }
1351                 ret = snd_pcm_kernel_readv(substream, bufs, frames);
1352                 if (ret != -EPIPE && ret != -ESTRPIPE)
1353                         break;
1354         }
1355         return ret;
1356 }
1357 #endif /* CONFIG_SND_PCM_OSS_PLUGINS */
1358
1359 static ssize_t snd_pcm_oss_write2(struct snd_pcm_substream *substream, const char *buf, size_t bytes, int in_kernel)
1360 {
1361         struct snd_pcm_runtime *runtime = substream->runtime;
1362         snd_pcm_sframes_t frames, frames1;
1363 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
1364         if (runtime->oss.plugin_first) {
1365                 struct snd_pcm_plugin_channel *channels;
1366                 size_t oss_frame_bytes = (runtime->oss.plugin_first->src_width * runtime->oss.plugin_first->src_format.channels) / 8;
1367                 if (!in_kernel) {
1368                         if (copy_from_user(runtime->oss.buffer, (const char __force __user *)buf, bytes))
1369                                 return -EFAULT;
1370                         buf = runtime->oss.buffer;
1371                 }
1372                 frames = bytes / oss_frame_bytes;
1373                 frames1 = snd_pcm_plug_client_channels_buf(substream, (char *)buf, frames, &channels);
1374                 if (frames1 < 0)
1375                         return frames1;
1376                 frames1 = snd_pcm_plug_write_transfer(substream, channels, frames1);
1377                 if (frames1 <= 0)
1378                         return frames1;
1379                 bytes = frames1 * oss_frame_bytes;
1380         } else
1381 #endif
1382         {
1383                 frames = bytes_to_frames(runtime, bytes);
1384                 frames1 = snd_pcm_oss_write3(substream, buf, frames, in_kernel);
1385                 if (frames1 <= 0)
1386                         return frames1;
1387                 bytes = frames_to_bytes(runtime, frames1);
1388         }
1389         return bytes;
1390 }
1391
1392 static ssize_t snd_pcm_oss_write1(struct snd_pcm_substream *substream, const char __user *buf, size_t bytes)
1393 {
1394         size_t xfer = 0;
1395         ssize_t tmp = 0;
1396         struct snd_pcm_runtime *runtime = substream->runtime;
1397
1398         if (atomic_read(&substream->mmap_count))
1399                 return -ENXIO;
1400
1401         atomic_inc(&runtime->oss.rw_ref);
1402         while (bytes > 0) {
1403                 if (mutex_lock_interruptible(&runtime->oss.params_lock)) {
1404                         tmp = -ERESTARTSYS;
1405                         break;
1406                 }
1407                 tmp = snd_pcm_oss_make_ready_locked(substream);
1408                 if (tmp < 0)
1409                         goto err;
1410                 if (bytes < runtime->oss.period_bytes || runtime->oss.buffer_used > 0) {
1411                         tmp = bytes;
1412                         if (tmp + runtime->oss.buffer_used > runtime->oss.period_bytes)
1413                                 tmp = runtime->oss.period_bytes - runtime->oss.buffer_used;
1414                         if (tmp > 0) {
1415                                 if (copy_from_user(runtime->oss.buffer + runtime->oss.buffer_used, buf, tmp)) {
1416                                         tmp = -EFAULT;
1417                                         goto err;
1418                                 }
1419                         }
1420                         runtime->oss.buffer_used += tmp;
1421                         buf += tmp;
1422                         bytes -= tmp;
1423                         xfer += tmp;
1424                         if (substream->oss.setup.partialfrag ||
1425                             runtime->oss.buffer_used == runtime->oss.period_bytes) {
1426                                 tmp = snd_pcm_oss_write2(substream, runtime->oss.buffer + runtime->oss.period_ptr,
1427                                                          runtime->oss.buffer_used - runtime->oss.period_ptr, 1);
1428                                 if (tmp <= 0)
1429                                         goto err;
1430                                 runtime->oss.bytes += tmp;
1431                                 runtime->oss.period_ptr += tmp;
1432                                 runtime->oss.period_ptr %= runtime->oss.period_bytes;
1433                                 if (runtime->oss.period_ptr == 0 ||
1434                                     runtime->oss.period_ptr == runtime->oss.buffer_used)
1435                                         runtime->oss.buffer_used = 0;
1436                                 else if ((substream->f_flags & O_NONBLOCK) != 0) {
1437                                         tmp = -EAGAIN;
1438                                         goto err;
1439                                 }
1440                         }
1441                 } else {
1442                         tmp = snd_pcm_oss_write2(substream,
1443                                                  (const char __force *)buf,
1444                                                  runtime->oss.period_bytes, 0);
1445                         if (tmp <= 0)
1446                                 goto err;
1447                         runtime->oss.bytes += tmp;
1448                         buf += tmp;
1449                         bytes -= tmp;
1450                         xfer += tmp;
1451                         if ((substream->f_flags & O_NONBLOCK) != 0 &&
1452                             tmp != runtime->oss.period_bytes)
1453                                 tmp = -EAGAIN;
1454                 }
1455  err:
1456                 mutex_unlock(&runtime->oss.params_lock);
1457                 if (tmp < 0)
1458                         break;
1459                 if (signal_pending(current)) {
1460                         tmp = -ERESTARTSYS;
1461                         break;
1462                 }
1463                 tmp = 0;
1464         }
1465         atomic_dec(&runtime->oss.rw_ref);
1466         return xfer > 0 ? (snd_pcm_sframes_t)xfer : tmp;
1467 }
1468
1469 static ssize_t snd_pcm_oss_read2(struct snd_pcm_substream *substream, char *buf, size_t bytes, int in_kernel)
1470 {
1471         struct snd_pcm_runtime *runtime = substream->runtime;
1472         snd_pcm_sframes_t frames, frames1;
1473 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
1474         char __user *final_dst = (char __force __user *)buf;
1475         if (runtime->oss.plugin_first) {
1476                 struct snd_pcm_plugin_channel *channels;
1477                 size_t oss_frame_bytes = (runtime->oss.plugin_last->dst_width * runtime->oss.plugin_last->dst_format.channels) / 8;
1478                 if (!in_kernel)
1479                         buf = runtime->oss.buffer;
1480                 frames = bytes / oss_frame_bytes;
1481                 frames1 = snd_pcm_plug_client_channels_buf(substream, buf, frames, &channels);
1482                 if (frames1 < 0)
1483                         return frames1;
1484                 frames1 = snd_pcm_plug_read_transfer(substream, channels, frames1);
1485                 if (frames1 <= 0)
1486                         return frames1;
1487                 bytes = frames1 * oss_frame_bytes;
1488                 if (!in_kernel && copy_to_user(final_dst, buf, bytes))
1489                         return -EFAULT;
1490         } else
1491 #endif
1492         {
1493                 frames = bytes_to_frames(runtime, bytes);
1494                 frames1 = snd_pcm_oss_read3(substream, buf, frames, in_kernel);
1495                 if (frames1 <= 0)
1496                         return frames1;
1497                 bytes = frames_to_bytes(runtime, frames1);
1498         }
1499         return bytes;
1500 }
1501
1502 static ssize_t snd_pcm_oss_read1(struct snd_pcm_substream *substream, char __user *buf, size_t bytes)
1503 {
1504         size_t xfer = 0;
1505         ssize_t tmp = 0;
1506         struct snd_pcm_runtime *runtime = substream->runtime;
1507
1508         if (atomic_read(&substream->mmap_count))
1509                 return -ENXIO;
1510
1511         atomic_inc(&runtime->oss.rw_ref);
1512         while (bytes > 0) {
1513                 if (mutex_lock_interruptible(&runtime->oss.params_lock)) {
1514                         tmp = -ERESTARTSYS;
1515                         break;
1516                 }
1517                 tmp = snd_pcm_oss_make_ready_locked(substream);
1518                 if (tmp < 0)
1519                         goto err;
1520                 if (bytes < runtime->oss.period_bytes || runtime->oss.buffer_used > 0) {
1521                         if (runtime->oss.buffer_used == 0) {
1522                                 tmp = snd_pcm_oss_read2(substream, runtime->oss.buffer, runtime->oss.period_bytes, 1);
1523                                 if (tmp <= 0)
1524                                         goto err;
1525                                 runtime->oss.bytes += tmp;
1526                                 runtime->oss.period_ptr = tmp;
1527                                 runtime->oss.buffer_used = tmp;
1528                         }
1529                         tmp = bytes;
1530                         if ((size_t) tmp > runtime->oss.buffer_used)
1531                                 tmp = runtime->oss.buffer_used;
1532                         if (copy_to_user(buf, runtime->oss.buffer + (runtime->oss.period_ptr - runtime->oss.buffer_used), tmp)) {
1533                                 tmp = -EFAULT;
1534                                 goto err;
1535                         }
1536                         buf += tmp;
1537                         bytes -= tmp;
1538                         xfer += tmp;
1539                         runtime->oss.buffer_used -= tmp;
1540                 } else {
1541                         tmp = snd_pcm_oss_read2(substream, (char __force *)buf,
1542                                                 runtime->oss.period_bytes, 0);
1543                         if (tmp <= 0)
1544                                 goto err;
1545                         runtime->oss.bytes += tmp;
1546                         buf += tmp;
1547                         bytes -= tmp;
1548                         xfer += tmp;
1549                 }
1550  err:
1551                 mutex_unlock(&runtime->oss.params_lock);
1552                 if (tmp < 0)
1553                         break;
1554                 if (signal_pending(current)) {
1555                         tmp = -ERESTARTSYS;
1556                         break;
1557                 }
1558                 tmp = 0;
1559         }
1560         atomic_dec(&runtime->oss.rw_ref);
1561         return xfer > 0 ? (snd_pcm_sframes_t)xfer : tmp;
1562 }
1563
1564 static int snd_pcm_oss_reset(struct snd_pcm_oss_file *pcm_oss_file)
1565 {
1566         struct snd_pcm_substream *substream;
1567         struct snd_pcm_runtime *runtime;
1568         int i;
1569
1570         for (i = 0; i < 2; i++) {
1571                 substream = pcm_oss_file->streams[i];
1572                 if (!substream)
1573                         continue;
1574                 runtime = substream->runtime;
1575                 snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
1576                 mutex_lock(&runtime->oss.params_lock);
1577                 runtime->oss.prepare = 1;
1578                 runtime->oss.buffer_used = 0;
1579                 runtime->oss.prev_hw_ptr_period = 0;
1580                 runtime->oss.period_ptr = 0;
1581                 mutex_unlock(&runtime->oss.params_lock);
1582         }
1583         return 0;
1584 }
1585
1586 static int snd_pcm_oss_post(struct snd_pcm_oss_file *pcm_oss_file)
1587 {
1588         struct snd_pcm_substream *substream;
1589         int err;
1590
1591         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
1592         if (substream != NULL) {
1593                 if ((err = snd_pcm_oss_make_ready(substream)) < 0)
1594                         return err;
1595                 snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_START, NULL);
1596         }
1597         /* note: all errors from the start action are ignored */
1598         /* OSS apps do not know, how to handle them */
1599         return 0;
1600 }
1601
1602 static int snd_pcm_oss_sync1(struct snd_pcm_substream *substream, size_t size)
1603 {
1604         struct snd_pcm_runtime *runtime;
1605         ssize_t result = 0;
1606         snd_pcm_state_t state;
1607         long res;
1608         wait_queue_entry_t wait;
1609
1610         runtime = substream->runtime;
1611         init_waitqueue_entry(&wait, current);
1612         add_wait_queue(&runtime->sleep, &wait);
1613 #ifdef OSS_DEBUG
1614         pcm_dbg(substream->pcm, "sync1: size = %li\n", size);
1615 #endif
1616         while (1) {
1617                 result = snd_pcm_oss_write2(substream, runtime->oss.buffer, size, 1);
1618                 if (result > 0) {
1619                         runtime->oss.buffer_used = 0;
1620                         result = 0;
1621                         break;
1622                 }
1623                 if (result != 0 && result != -EAGAIN)
1624                         break;
1625                 result = 0;
1626                 set_current_state(TASK_INTERRUPTIBLE);
1627                 snd_pcm_stream_lock_irq(substream);
1628                 state = runtime->status->state;
1629                 snd_pcm_stream_unlock_irq(substream);
1630                 if (state != SNDRV_PCM_STATE_RUNNING) {
1631                         set_current_state(TASK_RUNNING);
1632                         break;
1633                 }
1634                 res = schedule_timeout(10 * HZ);
1635                 if (signal_pending(current)) {
1636                         result = -ERESTARTSYS;
1637                         break;
1638                 }
1639                 if (res == 0) {
1640                         pcm_err(substream->pcm,
1641                                 "OSS sync error - DMA timeout\n");
1642                         result = -EIO;
1643                         break;
1644                 }
1645         }
1646         remove_wait_queue(&runtime->sleep, &wait);
1647         return result;
1648 }
1649
1650 static int snd_pcm_oss_sync(struct snd_pcm_oss_file *pcm_oss_file)
1651 {
1652         int err = 0;
1653         unsigned int saved_f_flags;
1654         struct snd_pcm_substream *substream;
1655         struct snd_pcm_runtime *runtime;
1656         snd_pcm_format_t format;
1657         unsigned long width;
1658         size_t size;
1659
1660         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
1661         if (substream != NULL) {
1662                 runtime = substream->runtime;
1663                 if (atomic_read(&substream->mmap_count))
1664                         goto __direct;
1665                 atomic_inc(&runtime->oss.rw_ref);
1666                 if (mutex_lock_interruptible(&runtime->oss.params_lock)) {
1667                         atomic_dec(&runtime->oss.rw_ref);
1668                         return -ERESTARTSYS;
1669                 }
1670                 err = snd_pcm_oss_make_ready_locked(substream);
1671                 if (err < 0)
1672                         goto unlock;
1673                 format = snd_pcm_oss_format_from(runtime->oss.format);
1674                 width = snd_pcm_format_physical_width(format);
1675                 if (runtime->oss.buffer_used > 0) {
1676 #ifdef OSS_DEBUG
1677                         pcm_dbg(substream->pcm, "sync: buffer_used\n");
1678 #endif
1679                         size = (8 * (runtime->oss.period_bytes - runtime->oss.buffer_used) + 7) / width;
1680                         snd_pcm_format_set_silence(format,
1681                                                    runtime->oss.buffer + runtime->oss.buffer_used,
1682                                                    size);
1683                         err = snd_pcm_oss_sync1(substream, runtime->oss.period_bytes);
1684                         if (err < 0)
1685                                 goto unlock;
1686                 } else if (runtime->oss.period_ptr > 0) {
1687 #ifdef OSS_DEBUG
1688                         pcm_dbg(substream->pcm, "sync: period_ptr\n");
1689 #endif
1690                         size = runtime->oss.period_bytes - runtime->oss.period_ptr;
1691                         snd_pcm_format_set_silence(format,
1692                                                    runtime->oss.buffer,
1693                                                    size * 8 / width);
1694                         err = snd_pcm_oss_sync1(substream, size);
1695                         if (err < 0)
1696                                 goto unlock;
1697                 }
1698                 /*
1699                  * The ALSA's period might be a bit large than OSS one.
1700                  * Fill the remain portion of ALSA period with zeros.
1701                  */
1702                 size = runtime->control->appl_ptr % runtime->period_size;
1703                 if (size > 0) {
1704                         size = runtime->period_size - size;
1705                         if (runtime->access == SNDRV_PCM_ACCESS_RW_INTERLEAVED)
1706                                 snd_pcm_lib_write(substream, NULL, size);
1707                         else if (runtime->access == SNDRV_PCM_ACCESS_RW_NONINTERLEAVED)
1708                                 snd_pcm_lib_writev(substream, NULL, size);
1709                 }
1710 unlock:
1711                 mutex_unlock(&runtime->oss.params_lock);
1712                 atomic_dec(&runtime->oss.rw_ref);
1713                 if (err < 0)
1714                         return err;
1715                 /*
1716                  * finish sync: drain the buffer
1717                  */
1718               __direct:
1719                 saved_f_flags = substream->f_flags;
1720                 substream->f_flags &= ~O_NONBLOCK;
1721                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL);
1722                 substream->f_flags = saved_f_flags;
1723                 if (err < 0)
1724                         return err;
1725                 mutex_lock(&runtime->oss.params_lock);
1726                 runtime->oss.prepare = 1;
1727                 mutex_unlock(&runtime->oss.params_lock);
1728         }
1729
1730         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
1731         if (substream != NULL) {
1732                 if ((err = snd_pcm_oss_make_ready(substream)) < 0)
1733                         return err;
1734                 runtime = substream->runtime;
1735                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
1736                 if (err < 0)
1737                         return err;
1738                 mutex_lock(&runtime->oss.params_lock);
1739                 runtime->oss.buffer_used = 0;
1740                 runtime->oss.prepare = 1;
1741                 mutex_unlock(&runtime->oss.params_lock);
1742         }
1743         return 0;
1744 }
1745
1746 static int snd_pcm_oss_set_rate(struct snd_pcm_oss_file *pcm_oss_file, int rate)
1747 {
1748         int idx;
1749
1750         for (idx = 1; idx >= 0; --idx) {
1751                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1752                 struct snd_pcm_runtime *runtime;
1753                 int err;
1754
1755                 if (substream == NULL)
1756                         continue;
1757                 runtime = substream->runtime;
1758                 if (rate < 1000)
1759                         rate = 1000;
1760                 else if (rate > 192000)
1761                         rate = 192000;
1762                 err = lock_params(runtime);
1763                 if (err < 0)
1764                         return err;
1765                 if (runtime->oss.rate != rate) {
1766                         runtime->oss.params = 1;
1767                         runtime->oss.rate = rate;
1768                 }
1769                 unlock_params(runtime);
1770         }
1771         return snd_pcm_oss_get_rate(pcm_oss_file);
1772 }
1773
1774 static int snd_pcm_oss_get_rate(struct snd_pcm_oss_file *pcm_oss_file)
1775 {
1776         struct snd_pcm_substream *substream;
1777         int err;
1778
1779         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1780                 return err;
1781         return substream->runtime->oss.rate;
1782 }
1783
1784 static int snd_pcm_oss_set_channels(struct snd_pcm_oss_file *pcm_oss_file, unsigned int channels)
1785 {
1786         int idx;
1787         if (channels < 1)
1788                 channels = 1;
1789         if (channels > 128)
1790                 return -EINVAL;
1791         for (idx = 1; idx >= 0; --idx) {
1792                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1793                 struct snd_pcm_runtime *runtime;
1794                 int err;
1795
1796                 if (substream == NULL)
1797                         continue;
1798                 runtime = substream->runtime;
1799                 err = lock_params(runtime);
1800                 if (err < 0)
1801                         return err;
1802                 if (runtime->oss.channels != channels) {
1803                         runtime->oss.params = 1;
1804                         runtime->oss.channels = channels;
1805                 }
1806                 unlock_params(runtime);
1807         }
1808         return snd_pcm_oss_get_channels(pcm_oss_file);
1809 }
1810
1811 static int snd_pcm_oss_get_channels(struct snd_pcm_oss_file *pcm_oss_file)
1812 {
1813         struct snd_pcm_substream *substream;
1814         int err;
1815
1816         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1817                 return err;
1818         return substream->runtime->oss.channels;
1819 }
1820
1821 static int snd_pcm_oss_get_block_size(struct snd_pcm_oss_file *pcm_oss_file)
1822 {
1823         struct snd_pcm_substream *substream;
1824         int err;
1825
1826         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1827                 return err;
1828         return substream->runtime->oss.period_bytes;
1829 }
1830
1831 static int snd_pcm_oss_get_formats(struct snd_pcm_oss_file *pcm_oss_file)
1832 {
1833         struct snd_pcm_substream *substream;
1834         int err;
1835         int direct;
1836         struct snd_pcm_hw_params *params;
1837         unsigned int formats = 0;
1838         const struct snd_mask *format_mask;
1839         int fmt;
1840
1841         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1842                 return err;
1843         if (atomic_read(&substream->mmap_count))
1844                 direct = 1;
1845         else
1846                 direct = substream->oss.setup.direct;
1847         if (!direct)
1848                 return AFMT_MU_LAW | AFMT_U8 |
1849                        AFMT_S16_LE | AFMT_S16_BE |
1850                        AFMT_S8 | AFMT_U16_LE |
1851                        AFMT_U16_BE |
1852                         AFMT_S32_LE | AFMT_S32_BE |
1853                         AFMT_S24_LE | AFMT_S24_BE |
1854                         AFMT_S24_PACKED;
1855         params = kmalloc(sizeof(*params), GFP_KERNEL);
1856         if (!params)
1857                 return -ENOMEM;
1858         _snd_pcm_hw_params_any(params);
1859         err = snd_pcm_hw_refine(substream, params);
1860         if (err < 0)
1861                 goto error;
1862         format_mask = hw_param_mask_c(params, SNDRV_PCM_HW_PARAM_FORMAT);
1863         for (fmt = 0; fmt < 32; ++fmt) {
1864                 if (snd_mask_test(format_mask, fmt)) {
1865                         int f = snd_pcm_oss_format_to((__force snd_pcm_format_t)fmt);
1866                         if (f >= 0)
1867                                 formats |= f;
1868                 }
1869         }
1870
1871  error:
1872         kfree(params);
1873         return err < 0 ? err : formats;
1874 }
1875
1876 static int snd_pcm_oss_set_format(struct snd_pcm_oss_file *pcm_oss_file, int format)
1877 {
1878         int formats, idx;
1879         int err;
1880
1881         if (format != AFMT_QUERY) {
1882                 formats = snd_pcm_oss_get_formats(pcm_oss_file);
1883                 if (formats < 0)
1884                         return formats;
1885                 if (!(formats & format))
1886                         format = AFMT_U8;
1887                 for (idx = 1; idx >= 0; --idx) {
1888                         struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1889                         struct snd_pcm_runtime *runtime;
1890                         if (substream == NULL)
1891                                 continue;
1892                         runtime = substream->runtime;
1893                         err = lock_params(runtime);
1894                         if (err < 0)
1895                                 return err;
1896                         if (runtime->oss.format != format) {
1897                                 runtime->oss.params = 1;
1898                                 runtime->oss.format = format;
1899                         }
1900                         unlock_params(runtime);
1901                 }
1902         }
1903         return snd_pcm_oss_get_format(pcm_oss_file);
1904 }
1905
1906 static int snd_pcm_oss_get_format(struct snd_pcm_oss_file *pcm_oss_file)
1907 {
1908         struct snd_pcm_substream *substream;
1909         int err;
1910
1911         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1912                 return err;
1913         return substream->runtime->oss.format;
1914 }
1915
1916 static int snd_pcm_oss_set_subdivide1(struct snd_pcm_substream *substream, int subdivide)
1917 {
1918         struct snd_pcm_runtime *runtime;
1919
1920         runtime = substream->runtime;
1921         if (subdivide == 0) {
1922                 subdivide = runtime->oss.subdivision;
1923                 if (subdivide == 0)
1924                         subdivide = 1;
1925                 return subdivide;
1926         }
1927         if (runtime->oss.subdivision || runtime->oss.fragshift)
1928                 return -EINVAL;
1929         if (subdivide != 1 && subdivide != 2 && subdivide != 4 &&
1930             subdivide != 8 && subdivide != 16)
1931                 return -EINVAL;
1932         runtime->oss.subdivision = subdivide;
1933         runtime->oss.params = 1;
1934         return subdivide;
1935 }
1936
1937 static int snd_pcm_oss_set_subdivide(struct snd_pcm_oss_file *pcm_oss_file, int subdivide)
1938 {
1939         int err = -EINVAL, idx;
1940
1941         for (idx = 1; idx >= 0; --idx) {
1942                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1943                 struct snd_pcm_runtime *runtime;
1944
1945                 if (substream == NULL)
1946                         continue;
1947                 runtime = substream->runtime;
1948                 err = lock_params(runtime);
1949                 if (err < 0)
1950                         return err;
1951                 err = snd_pcm_oss_set_subdivide1(substream, subdivide);
1952                 unlock_params(runtime);
1953                 if (err < 0)
1954                         return err;
1955         }
1956         return err;
1957 }
1958
1959 static int snd_pcm_oss_set_fragment1(struct snd_pcm_substream *substream, unsigned int val)
1960 {
1961         struct snd_pcm_runtime *runtime;
1962         int fragshift;
1963
1964         runtime = substream->runtime;
1965         if (runtime->oss.subdivision || runtime->oss.fragshift)
1966                 return -EINVAL;
1967         fragshift = val & 0xffff;
1968         if (fragshift >= 25) /* should be large enough */
1969                 return -EINVAL;
1970         runtime->oss.fragshift = fragshift;
1971         runtime->oss.maxfrags = (val >> 16) & 0xffff;
1972         if (runtime->oss.fragshift < 4)         /* < 16 */
1973                 runtime->oss.fragshift = 4;
1974         if (runtime->oss.maxfrags < 2)
1975                 runtime->oss.maxfrags = 2;
1976         runtime->oss.params = 1;
1977         return 0;
1978 }
1979
1980 static int snd_pcm_oss_set_fragment(struct snd_pcm_oss_file *pcm_oss_file, unsigned int val)
1981 {
1982         int err = -EINVAL, idx;
1983
1984         for (idx = 1; idx >= 0; --idx) {
1985                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1986                 struct snd_pcm_runtime *runtime;
1987
1988                 if (substream == NULL)
1989                         continue;
1990                 runtime = substream->runtime;
1991                 err = lock_params(runtime);
1992                 if (err < 0)
1993                         return err;
1994                 err = snd_pcm_oss_set_fragment1(substream, val);
1995                 unlock_params(runtime);
1996                 if (err < 0)
1997                         return err;
1998         }
1999         return err;
2000 }
2001
2002 static int snd_pcm_oss_nonblock(struct file * file)
2003 {
2004         spin_lock(&file->f_lock);
2005         file->f_flags |= O_NONBLOCK;
2006         spin_unlock(&file->f_lock);
2007         return 0;
2008 }
2009
2010 static int snd_pcm_oss_get_caps1(struct snd_pcm_substream *substream, int res)
2011 {
2012
2013         if (substream == NULL) {
2014                 res &= ~DSP_CAP_DUPLEX;
2015                 return res;
2016         }
2017 #ifdef DSP_CAP_MULTI
2018         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
2019                 if (substream->pstr->substream_count > 1)
2020                         res |= DSP_CAP_MULTI;
2021 #endif
2022         /* DSP_CAP_REALTIME is set all times: */
2023         /* all ALSA drivers can return actual pointer in ring buffer */
2024 #if defined(DSP_CAP_REALTIME) && 0
2025         {
2026                 struct snd_pcm_runtime *runtime = substream->runtime;
2027                 if (runtime->info & (SNDRV_PCM_INFO_BLOCK_TRANSFER|SNDRV_PCM_INFO_BATCH))
2028                         res &= ~DSP_CAP_REALTIME;
2029         }
2030 #endif
2031         return res;
2032 }
2033
2034 static int snd_pcm_oss_get_caps(struct snd_pcm_oss_file *pcm_oss_file)
2035 {
2036         int result, idx;
2037
2038         result = DSP_CAP_TRIGGER | DSP_CAP_MMAP | DSP_CAP_DUPLEX | DSP_CAP_REALTIME;
2039         for (idx = 0; idx < 2; idx++) {
2040                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
2041                 result = snd_pcm_oss_get_caps1(substream, result);
2042         }
2043         result |= 0x0001;       /* revision - same as SB AWE 64 */
2044         return result;
2045 }
2046
2047 static void snd_pcm_oss_simulate_fill(struct snd_pcm_substream *substream,
2048                                       snd_pcm_uframes_t hw_ptr)
2049 {
2050         struct snd_pcm_runtime *runtime = substream->runtime;
2051         snd_pcm_uframes_t appl_ptr;
2052         appl_ptr = hw_ptr + runtime->buffer_size;
2053         appl_ptr %= runtime->boundary;
2054         runtime->control->appl_ptr = appl_ptr;
2055 }
2056
2057 static int snd_pcm_oss_set_trigger(struct snd_pcm_oss_file *pcm_oss_file, int trigger)
2058 {
2059         struct snd_pcm_runtime *runtime;
2060         struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL;
2061         int err, cmd;
2062
2063 #ifdef OSS_DEBUG
2064         pr_debug("pcm_oss: trigger = 0x%x\n", trigger);
2065 #endif
2066
2067         psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2068         csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2069
2070         if (psubstream) {
2071                 if ((err = snd_pcm_oss_make_ready(psubstream)) < 0)
2072                         return err;
2073         }
2074         if (csubstream) {
2075                 if ((err = snd_pcm_oss_make_ready(csubstream)) < 0)
2076                         return err;
2077         }
2078         if (psubstream) {
2079                 runtime = psubstream->runtime;
2080                 cmd = 0;
2081                 if (mutex_lock_interruptible(&runtime->oss.params_lock))
2082                         return -ERESTARTSYS;
2083                 if (trigger & PCM_ENABLE_OUTPUT) {
2084                         if (runtime->oss.trigger)
2085                                 goto _skip1;
2086                         if (atomic_read(&psubstream->mmap_count))
2087                                 snd_pcm_oss_simulate_fill(psubstream,
2088                                                 get_hw_ptr_period(runtime));
2089                         runtime->oss.trigger = 1;
2090                         runtime->start_threshold = 1;
2091                         cmd = SNDRV_PCM_IOCTL_START;
2092                 } else {
2093                         if (!runtime->oss.trigger)
2094                                 goto _skip1;
2095                         runtime->oss.trigger = 0;
2096                         runtime->start_threshold = runtime->boundary;
2097                         cmd = SNDRV_PCM_IOCTL_DROP;
2098                         runtime->oss.prepare = 1;
2099                 }
2100  _skip1:
2101                 mutex_unlock(&runtime->oss.params_lock);
2102                 if (cmd) {
2103                         err = snd_pcm_kernel_ioctl(psubstream, cmd, NULL);
2104                         if (err < 0)
2105                                 return err;
2106                 }
2107         }
2108         if (csubstream) {
2109                 runtime = csubstream->runtime;
2110                 cmd = 0;
2111                 if (mutex_lock_interruptible(&runtime->oss.params_lock))
2112                         return -ERESTARTSYS;
2113                 if (trigger & PCM_ENABLE_INPUT) {
2114                         if (runtime->oss.trigger)
2115                                 goto _skip2;
2116                         runtime->oss.trigger = 1;
2117                         runtime->start_threshold = 1;
2118                         cmd = SNDRV_PCM_IOCTL_START;
2119                 } else {
2120                         if (!runtime->oss.trigger)
2121                                 goto _skip2;
2122                         runtime->oss.trigger = 0;
2123                         runtime->start_threshold = runtime->boundary;
2124                         cmd = SNDRV_PCM_IOCTL_DROP;
2125                         runtime->oss.prepare = 1;
2126                 }
2127  _skip2:
2128                 mutex_unlock(&runtime->oss.params_lock);
2129                 if (cmd) {
2130                         err = snd_pcm_kernel_ioctl(csubstream, cmd, NULL);
2131                         if (err < 0)
2132                                 return err;
2133                 }
2134         }
2135         return 0;
2136 }
2137
2138 static int snd_pcm_oss_get_trigger(struct snd_pcm_oss_file *pcm_oss_file)
2139 {
2140         struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL;
2141         int result = 0;
2142
2143         psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2144         csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2145         if (psubstream && psubstream->runtime && psubstream->runtime->oss.trigger)
2146                 result |= PCM_ENABLE_OUTPUT;
2147         if (csubstream && csubstream->runtime && csubstream->runtime->oss.trigger)
2148                 result |= PCM_ENABLE_INPUT;
2149         return result;
2150 }
2151
2152 static int snd_pcm_oss_get_odelay(struct snd_pcm_oss_file *pcm_oss_file)
2153 {
2154         struct snd_pcm_substream *substream;
2155         struct snd_pcm_runtime *runtime;
2156         snd_pcm_sframes_t delay;
2157         int err;
2158
2159         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2160         if (substream == NULL)
2161                 return -EINVAL;
2162         if ((err = snd_pcm_oss_make_ready(substream)) < 0)
2163                 return err;
2164         runtime = substream->runtime;
2165         if (runtime->oss.params || runtime->oss.prepare)
2166                 return 0;
2167         err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &delay);
2168         if (err == -EPIPE)
2169                 delay = 0;      /* hack for broken OSS applications */
2170         else if (err < 0)
2171                 return err;
2172         return snd_pcm_oss_bytes(substream, delay);
2173 }
2174
2175 static int snd_pcm_oss_get_ptr(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct count_info __user * _info)
2176 {
2177         struct snd_pcm_substream *substream;
2178         struct snd_pcm_runtime *runtime;
2179         snd_pcm_sframes_t delay;
2180         int fixup;
2181         struct count_info info;
2182         int err;
2183
2184         if (_info == NULL)
2185                 return -EFAULT;
2186         substream = pcm_oss_file->streams[stream];
2187         if (substream == NULL)
2188                 return -EINVAL;
2189         if ((err = snd_pcm_oss_make_ready(substream)) < 0)
2190                 return err;
2191         runtime = substream->runtime;
2192         if (runtime->oss.params || runtime->oss.prepare) {
2193                 memset(&info, 0, sizeof(info));
2194                 if (copy_to_user(_info, &info, sizeof(info)))
2195                         return -EFAULT;
2196                 return 0;
2197         }
2198         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
2199                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &delay);
2200                 if (err == -EPIPE || err == -ESTRPIPE || (! err && delay < 0)) {
2201                         err = 0;
2202                         delay = 0;
2203                         fixup = 0;
2204                 } else {
2205                         fixup = runtime->oss.buffer_used;
2206                 }
2207         } else {
2208                 err = snd_pcm_oss_capture_position_fixup(substream, &delay);
2209                 fixup = -runtime->oss.buffer_used;
2210         }
2211         if (err < 0)
2212                 return err;
2213         info.ptr = snd_pcm_oss_bytes(substream, runtime->status->hw_ptr % runtime->buffer_size);
2214         if (atomic_read(&substream->mmap_count)) {
2215                 snd_pcm_sframes_t n;
2216                 delay = get_hw_ptr_period(runtime);
2217                 n = delay - runtime->oss.prev_hw_ptr_period;
2218                 if (n < 0)
2219                         n += runtime->boundary;
2220                 info.blocks = n / runtime->period_size;
2221                 runtime->oss.prev_hw_ptr_period = delay;
2222                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
2223                         snd_pcm_oss_simulate_fill(substream, delay);
2224                 info.bytes = snd_pcm_oss_bytes(substream, runtime->status->hw_ptr) & INT_MAX;
2225         } else {
2226                 delay = snd_pcm_oss_bytes(substream, delay);
2227                 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
2228                         if (substream->oss.setup.buggyptr)
2229                                 info.blocks = (runtime->oss.buffer_bytes - delay - fixup) / runtime->oss.period_bytes;
2230                         else
2231                                 info.blocks = (delay + fixup) / runtime->oss.period_bytes;
2232                         info.bytes = (runtime->oss.bytes - delay) & INT_MAX;
2233                 } else {
2234                         delay += fixup;
2235                         info.blocks = delay / runtime->oss.period_bytes;
2236                         info.bytes = (runtime->oss.bytes + delay) & INT_MAX;
2237                 }
2238         }
2239         if (copy_to_user(_info, &info, sizeof(info)))
2240                 return -EFAULT;
2241         return 0;
2242 }
2243
2244 static int snd_pcm_oss_get_space(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct audio_buf_info __user *_info)
2245 {
2246         struct snd_pcm_substream *substream;
2247         struct snd_pcm_runtime *runtime;
2248         snd_pcm_sframes_t avail;
2249         int fixup;
2250         struct audio_buf_info info;
2251         int err;
2252
2253         if (_info == NULL)
2254                 return -EFAULT;
2255         substream = pcm_oss_file->streams[stream];
2256         if (substream == NULL)
2257                 return -EINVAL;
2258         runtime = substream->runtime;
2259
2260         if (runtime->oss.params &&
2261             (err = snd_pcm_oss_change_params(substream, false)) < 0)
2262                 return err;
2263
2264         info.fragsize = runtime->oss.period_bytes;
2265         info.fragstotal = runtime->periods;
2266         if (runtime->oss.prepare) {
2267                 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
2268                         info.bytes = runtime->oss.period_bytes * runtime->oss.periods;
2269                         info.fragments = runtime->oss.periods;
2270                 } else {
2271                         info.bytes = 0;
2272                         info.fragments = 0;
2273                 }
2274         } else {
2275                 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
2276                         err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &avail);
2277                         if (err == -EPIPE || err == -ESTRPIPE || (! err && avail < 0)) {
2278                                 avail = runtime->buffer_size;
2279                                 err = 0;
2280                                 fixup = 0;
2281                         } else {
2282                                 avail = runtime->buffer_size - avail;
2283                                 fixup = -runtime->oss.buffer_used;
2284                         }
2285                 } else {
2286                         err = snd_pcm_oss_capture_position_fixup(substream, &avail);
2287                         fixup = runtime->oss.buffer_used;
2288                 }
2289                 if (err < 0)
2290                         return err;
2291                 info.bytes = snd_pcm_oss_bytes(substream, avail) + fixup;
2292                 info.fragments = info.bytes / runtime->oss.period_bytes;
2293         }
2294
2295 #ifdef OSS_DEBUG
2296         pcm_dbg(substream->pcm,
2297                 "pcm_oss: space: bytes = %i, fragments = %i, fragstotal = %i, fragsize = %i\n",
2298                 info.bytes, info.fragments, info.fragstotal, info.fragsize);
2299 #endif
2300         if (copy_to_user(_info, &info, sizeof(info)))
2301                 return -EFAULT;
2302         return 0;
2303 }
2304
2305 static int snd_pcm_oss_get_mapbuf(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct buffmem_desc __user * _info)
2306 {
2307         // it won't be probably implemented
2308         // pr_debug("TODO: snd_pcm_oss_get_mapbuf\n");
2309         return -EINVAL;
2310 }
2311
2312 static const char *strip_task_path(const char *path)
2313 {
2314         const char *ptr, *ptrl = NULL;
2315         for (ptr = path; *ptr; ptr++) {
2316                 if (*ptr == '/')
2317                         ptrl = ptr + 1;
2318         }
2319         return ptrl;
2320 }
2321
2322 static void snd_pcm_oss_look_for_setup(struct snd_pcm *pcm, int stream,
2323                                       const char *task_name,
2324                                       struct snd_pcm_oss_setup *rsetup)
2325 {
2326         struct snd_pcm_oss_setup *setup;
2327
2328         mutex_lock(&pcm->streams[stream].oss.setup_mutex);
2329         do {
2330                 for (setup = pcm->streams[stream].oss.setup_list; setup;
2331                      setup = setup->next) {
2332                         if (!strcmp(setup->task_name, task_name))
2333                                 goto out;
2334                 }
2335         } while ((task_name = strip_task_path(task_name)) != NULL);
2336  out:
2337         if (setup)
2338                 *rsetup = *setup;
2339         mutex_unlock(&pcm->streams[stream].oss.setup_mutex);
2340 }
2341
2342 static void snd_pcm_oss_release_substream(struct snd_pcm_substream *substream)
2343 {
2344         struct snd_pcm_runtime *runtime;
2345         runtime = substream->runtime;
2346         kvfree(runtime->oss.buffer);
2347         runtime->oss.buffer = NULL;
2348 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
2349         snd_pcm_oss_plugin_clear(substream);
2350 #endif
2351         substream->oss.oss = 0;
2352 }
2353
2354 static void snd_pcm_oss_init_substream(struct snd_pcm_substream *substream,
2355                                        struct snd_pcm_oss_setup *setup,
2356                                        int minor)
2357 {
2358         struct snd_pcm_runtime *runtime;
2359
2360         substream->oss.oss = 1;
2361         substream->oss.setup = *setup;
2362         if (setup->nonblock)
2363                 substream->f_flags |= O_NONBLOCK;
2364         else if (setup->block)
2365                 substream->f_flags &= ~O_NONBLOCK;
2366         runtime = substream->runtime;
2367         runtime->oss.params = 1;
2368         runtime->oss.trigger = 1;
2369         runtime->oss.rate = 8000;
2370         mutex_init(&runtime->oss.params_lock);
2371         switch (SNDRV_MINOR_OSS_DEVICE(minor)) {
2372         case SNDRV_MINOR_OSS_PCM_8:
2373                 runtime->oss.format = AFMT_U8;
2374                 break;
2375         case SNDRV_MINOR_OSS_PCM_16:
2376                 runtime->oss.format = AFMT_S16_LE;
2377                 break;
2378         default:
2379                 runtime->oss.format = AFMT_MU_LAW;
2380         }
2381         runtime->oss.channels = 1;
2382         runtime->oss.fragshift = 0;
2383         runtime->oss.maxfrags = 0;
2384         runtime->oss.subdivision = 0;
2385         substream->pcm_release = snd_pcm_oss_release_substream;
2386         atomic_set(&runtime->oss.rw_ref, 0);
2387 }
2388
2389 static int snd_pcm_oss_release_file(struct snd_pcm_oss_file *pcm_oss_file)
2390 {
2391         int cidx;
2392         if (!pcm_oss_file)
2393                 return 0;
2394         for (cidx = 0; cidx < 2; ++cidx) {
2395                 struct snd_pcm_substream *substream = pcm_oss_file->streams[cidx];
2396                 if (substream)
2397                         snd_pcm_release_substream(substream);
2398         }
2399         kfree(pcm_oss_file);
2400         return 0;
2401 }
2402
2403 static int snd_pcm_oss_open_file(struct file *file,
2404                                  struct snd_pcm *pcm,
2405                                  struct snd_pcm_oss_file **rpcm_oss_file,
2406                                  int minor,
2407                                  struct snd_pcm_oss_setup *setup)
2408 {
2409         int idx, err;
2410         struct snd_pcm_oss_file *pcm_oss_file;
2411         struct snd_pcm_substream *substream;
2412         fmode_t f_mode = file->f_mode;
2413
2414         if (rpcm_oss_file)
2415                 *rpcm_oss_file = NULL;
2416
2417         pcm_oss_file = kzalloc(sizeof(*pcm_oss_file), GFP_KERNEL);
2418         if (pcm_oss_file == NULL)
2419                 return -ENOMEM;
2420
2421         if ((f_mode & (FMODE_WRITE|FMODE_READ)) == (FMODE_WRITE|FMODE_READ) &&
2422             (pcm->info_flags & SNDRV_PCM_INFO_HALF_DUPLEX))
2423                 f_mode = FMODE_WRITE;
2424
2425         file->f_flags &= ~O_APPEND;
2426         for (idx = 0; idx < 2; idx++) {
2427                 if (setup[idx].disable)
2428                         continue;
2429                 if (! pcm->streams[idx].substream_count)
2430                         continue; /* no matching substream */
2431                 if (idx == SNDRV_PCM_STREAM_PLAYBACK) {
2432                         if (! (f_mode & FMODE_WRITE))
2433                                 continue;
2434                 } else {
2435                         if (! (f_mode & FMODE_READ))
2436                                 continue;
2437                 }
2438                 err = snd_pcm_open_substream(pcm, idx, file, &substream);
2439                 if (err < 0) {
2440                         snd_pcm_oss_release_file(pcm_oss_file);
2441                         return err;
2442                 }
2443
2444                 pcm_oss_file->streams[idx] = substream;
2445                 snd_pcm_oss_init_substream(substream, &setup[idx], minor);
2446         }
2447
2448         if (!pcm_oss_file->streams[0] && !pcm_oss_file->streams[1]) {
2449                 snd_pcm_oss_release_file(pcm_oss_file);
2450                 return -EINVAL;
2451         }
2452
2453         file->private_data = pcm_oss_file;
2454         if (rpcm_oss_file)
2455                 *rpcm_oss_file = pcm_oss_file;
2456         return 0;
2457 }
2458
2459
2460 static int snd_task_name(struct task_struct *task, char *name, size_t size)
2461 {
2462         unsigned int idx;
2463
2464         if (snd_BUG_ON(!task || !name || size < 2))
2465                 return -EINVAL;
2466         for (idx = 0; idx < sizeof(task->comm) && idx + 1 < size; idx++)
2467                 name[idx] = task->comm[idx];
2468         name[idx] = '\0';
2469         return 0;
2470 }
2471
2472 static int snd_pcm_oss_open(struct inode *inode, struct file *file)
2473 {
2474         int err;
2475         char task_name[32];
2476         struct snd_pcm *pcm;
2477         struct snd_pcm_oss_file *pcm_oss_file;
2478         struct snd_pcm_oss_setup setup[2];
2479         int nonblock;
2480         wait_queue_entry_t wait;
2481
2482         err = nonseekable_open(inode, file);
2483         if (err < 0)
2484                 return err;
2485
2486         pcm = snd_lookup_oss_minor_data(iminor(inode),
2487                                         SNDRV_OSS_DEVICE_TYPE_PCM);
2488         if (pcm == NULL) {
2489                 err = -ENODEV;
2490                 goto __error1;
2491         }
2492         err = snd_card_file_add(pcm->card, file);
2493         if (err < 0)
2494                 goto __error1;
2495         if (!try_module_get(pcm->card->module)) {
2496                 err = -EFAULT;
2497                 goto __error2;
2498         }
2499         if (snd_task_name(current, task_name, sizeof(task_name)) < 0) {
2500                 err = -EFAULT;
2501                 goto __error;
2502         }
2503         memset(setup, 0, sizeof(setup));
2504         if (file->f_mode & FMODE_WRITE)
2505                 snd_pcm_oss_look_for_setup(pcm, SNDRV_PCM_STREAM_PLAYBACK,
2506                                            task_name, &setup[0]);
2507         if (file->f_mode & FMODE_READ)
2508                 snd_pcm_oss_look_for_setup(pcm, SNDRV_PCM_STREAM_CAPTURE,
2509                                            task_name, &setup[1]);
2510
2511         nonblock = !!(file->f_flags & O_NONBLOCK);
2512         if (!nonblock)
2513                 nonblock = nonblock_open;
2514
2515         init_waitqueue_entry(&wait, current);
2516         add_wait_queue(&pcm->open_wait, &wait);
2517         mutex_lock(&pcm->open_mutex);
2518         while (1) {
2519                 err = snd_pcm_oss_open_file(file, pcm, &pcm_oss_file,
2520                                             iminor(inode), setup);
2521                 if (err >= 0)
2522                         break;
2523                 if (err == -EAGAIN) {
2524                         if (nonblock) {
2525                                 err = -EBUSY;
2526                                 break;
2527                         }
2528                 } else
2529                         break;
2530                 set_current_state(TASK_INTERRUPTIBLE);
2531                 mutex_unlock(&pcm->open_mutex);
2532                 schedule();
2533                 mutex_lock(&pcm->open_mutex);
2534                 if (pcm->card->shutdown) {
2535                         err = -ENODEV;
2536                         break;
2537                 }
2538                 if (signal_pending(current)) {
2539                         err = -ERESTARTSYS;
2540                         break;
2541                 }
2542         }
2543         remove_wait_queue(&pcm->open_wait, &wait);
2544         mutex_unlock(&pcm->open_mutex);
2545         if (err < 0)
2546                 goto __error;
2547         snd_card_unref(pcm->card);
2548         return err;
2549
2550       __error:
2551         module_put(pcm->card->module);
2552       __error2:
2553         snd_card_file_remove(pcm->card, file);
2554       __error1:
2555         if (pcm)
2556                 snd_card_unref(pcm->card);
2557         return err;
2558 }
2559
2560 static int snd_pcm_oss_release(struct inode *inode, struct file *file)
2561 {
2562         struct snd_pcm *pcm;
2563         struct snd_pcm_substream *substream;
2564         struct snd_pcm_oss_file *pcm_oss_file;
2565
2566         pcm_oss_file = file->private_data;
2567         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2568         if (substream == NULL)
2569                 substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2570         if (snd_BUG_ON(!substream))
2571                 return -ENXIO;
2572         pcm = substream->pcm;
2573         if (!pcm->card->shutdown)
2574                 snd_pcm_oss_sync(pcm_oss_file);
2575         mutex_lock(&pcm->open_mutex);
2576         snd_pcm_oss_release_file(pcm_oss_file);
2577         mutex_unlock(&pcm->open_mutex);
2578         wake_up(&pcm->open_wait);
2579         module_put(pcm->card->module);
2580         snd_card_file_remove(pcm->card, file);
2581         return 0;
2582 }
2583
2584 static long snd_pcm_oss_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
2585 {
2586         struct snd_pcm_oss_file *pcm_oss_file;
2587         int __user *p = (int __user *)arg;
2588         int res;
2589
2590         pcm_oss_file = file->private_data;
2591         if (cmd == OSS_GETVERSION)
2592                 return put_user(SNDRV_OSS_VERSION, p);
2593         if (cmd == OSS_ALSAEMULVER)
2594                 return put_user(1, p);
2595 #if IS_REACHABLE(CONFIG_SND_MIXER_OSS)
2596         if (((cmd >> 8) & 0xff) == 'M') {       /* mixer ioctl - for OSS compatibility */
2597                 struct snd_pcm_substream *substream;
2598                 int idx;
2599                 for (idx = 0; idx < 2; ++idx) {
2600                         substream = pcm_oss_file->streams[idx];
2601                         if (substream != NULL)
2602                                 break;
2603                 }
2604                 if (snd_BUG_ON(idx >= 2))
2605                         return -ENXIO;
2606                 return snd_mixer_oss_ioctl_card(substream->pcm->card, cmd, arg);
2607         }
2608 #endif
2609         if (((cmd >> 8) & 0xff) != 'P')
2610                 return -EINVAL;
2611 #ifdef OSS_DEBUG
2612         pr_debug("pcm_oss: ioctl = 0x%x\n", cmd);
2613 #endif
2614         switch (cmd) {
2615         case SNDCTL_DSP_RESET:
2616                 return snd_pcm_oss_reset(pcm_oss_file);
2617         case SNDCTL_DSP_SYNC:
2618                 return snd_pcm_oss_sync(pcm_oss_file);
2619         case SNDCTL_DSP_SPEED:
2620                 if (get_user(res, p))
2621                         return -EFAULT;
2622                 if ((res = snd_pcm_oss_set_rate(pcm_oss_file, res))<0)
2623                         return res;
2624                 return put_user(res, p);
2625         case SOUND_PCM_READ_RATE:
2626                 res = snd_pcm_oss_get_rate(pcm_oss_file);
2627                 if (res < 0)
2628                         return res;
2629                 return put_user(res, p);
2630         case SNDCTL_DSP_STEREO:
2631                 if (get_user(res, p))
2632                         return -EFAULT;
2633                 res = res > 0 ? 2 : 1;
2634                 if ((res = snd_pcm_oss_set_channels(pcm_oss_file, res)) < 0)
2635                         return res;
2636                 return put_user(--res, p);
2637         case SNDCTL_DSP_GETBLKSIZE:
2638                 res = snd_pcm_oss_get_block_size(pcm_oss_file);
2639                 if (res < 0)
2640                         return res;
2641                 return put_user(res, p);
2642         case SNDCTL_DSP_SETFMT:
2643                 if (get_user(res, p))
2644                         return -EFAULT;
2645                 res = snd_pcm_oss_set_format(pcm_oss_file, res);
2646                 if (res < 0)
2647                         return res;
2648                 return put_user(res, p);
2649         case SOUND_PCM_READ_BITS:
2650                 res = snd_pcm_oss_get_format(pcm_oss_file);
2651                 if (res < 0)
2652                         return res;
2653                 return put_user(res, p);
2654         case SNDCTL_DSP_CHANNELS:
2655                 if (get_user(res, p))
2656                         return -EFAULT;
2657                 res = snd_pcm_oss_set_channels(pcm_oss_file, res);
2658                 if (res < 0)
2659                         return res;
2660                 return put_user(res, p);
2661         case SOUND_PCM_READ_CHANNELS:
2662                 res = snd_pcm_oss_get_channels(pcm_oss_file);
2663                 if (res < 0)
2664                         return res;
2665                 return put_user(res, p);
2666         case SOUND_PCM_WRITE_FILTER:
2667         case SOUND_PCM_READ_FILTER:
2668                 return -EIO;
2669         case SNDCTL_DSP_POST:
2670                 return snd_pcm_oss_post(pcm_oss_file);
2671         case SNDCTL_DSP_SUBDIVIDE:
2672                 if (get_user(res, p))
2673                         return -EFAULT;
2674                 res = snd_pcm_oss_set_subdivide(pcm_oss_file, res);
2675                 if (res < 0)
2676                         return res;
2677                 return put_user(res, p);
2678         case SNDCTL_DSP_SETFRAGMENT:
2679                 if (get_user(res, p))
2680                         return -EFAULT;
2681                 return snd_pcm_oss_set_fragment(pcm_oss_file, res);
2682         case SNDCTL_DSP_GETFMTS:
2683                 res = snd_pcm_oss_get_formats(pcm_oss_file);
2684                 if (res < 0)
2685                         return res;
2686                 return put_user(res, p);
2687         case SNDCTL_DSP_GETOSPACE:
2688         case SNDCTL_DSP_GETISPACE:
2689                 return snd_pcm_oss_get_space(pcm_oss_file,
2690                         cmd == SNDCTL_DSP_GETISPACE ?
2691                                 SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK,
2692                         (struct audio_buf_info __user *) arg);
2693         case SNDCTL_DSP_NONBLOCK:
2694                 return snd_pcm_oss_nonblock(file);
2695         case SNDCTL_DSP_GETCAPS:
2696                 res = snd_pcm_oss_get_caps(pcm_oss_file);
2697                 if (res < 0)
2698                         return res;
2699                 return put_user(res, p);
2700         case SNDCTL_DSP_GETTRIGGER:
2701                 res = snd_pcm_oss_get_trigger(pcm_oss_file);
2702                 if (res < 0)
2703                         return res;
2704                 return put_user(res, p);
2705         case SNDCTL_DSP_SETTRIGGER:
2706                 if (get_user(res, p))
2707                         return -EFAULT;
2708                 return snd_pcm_oss_set_trigger(pcm_oss_file, res);
2709         case SNDCTL_DSP_GETIPTR:
2710         case SNDCTL_DSP_GETOPTR:
2711                 return snd_pcm_oss_get_ptr(pcm_oss_file,
2712                         cmd == SNDCTL_DSP_GETIPTR ?
2713                                 SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK,
2714                         (struct count_info __user *) arg);
2715         case SNDCTL_DSP_MAPINBUF:
2716         case SNDCTL_DSP_MAPOUTBUF:
2717                 return snd_pcm_oss_get_mapbuf(pcm_oss_file,
2718                         cmd == SNDCTL_DSP_MAPINBUF ?
2719                                 SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK,
2720                         (struct buffmem_desc __user *) arg);
2721         case SNDCTL_DSP_SETSYNCRO:
2722                 /* stop DMA now.. */
2723                 return 0;
2724         case SNDCTL_DSP_SETDUPLEX:
2725                 if (snd_pcm_oss_get_caps(pcm_oss_file) & DSP_CAP_DUPLEX)
2726                         return 0;
2727                 return -EIO;
2728         case SNDCTL_DSP_GETODELAY:
2729                 res = snd_pcm_oss_get_odelay(pcm_oss_file);
2730                 if (res < 0) {
2731                         /* it's for sure, some broken apps don't check for error codes */
2732                         put_user(0, p);
2733                         return res;
2734                 }
2735                 return put_user(res, p);
2736         case SNDCTL_DSP_PROFILE:
2737                 return 0;       /* silently ignore */
2738         default:
2739                 pr_debug("pcm_oss: unknown command = 0x%x\n", cmd);
2740         }
2741         return -EINVAL;
2742 }
2743
2744 #ifdef CONFIG_COMPAT
2745 /* all compatible */
2746 static long snd_pcm_oss_ioctl_compat(struct file *file, unsigned int cmd,
2747                                      unsigned long arg)
2748 {
2749         /*
2750          * Everything is compatbile except SNDCTL_DSP_MAPINBUF/SNDCTL_DSP_MAPOUTBUF,
2751          * which are not implemented for the native case either
2752          */
2753         return snd_pcm_oss_ioctl(file, cmd, (unsigned long)compat_ptr(arg));
2754 }
2755 #else
2756 #define snd_pcm_oss_ioctl_compat        NULL
2757 #endif
2758
2759 static ssize_t snd_pcm_oss_read(struct file *file, char __user *buf, size_t count, loff_t *offset)
2760 {
2761         struct snd_pcm_oss_file *pcm_oss_file;
2762         struct snd_pcm_substream *substream;
2763
2764         pcm_oss_file = file->private_data;
2765         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2766         if (substream == NULL)
2767                 return -ENXIO;
2768         substream->f_flags = file->f_flags & O_NONBLOCK;
2769 #ifndef OSS_DEBUG
2770         return snd_pcm_oss_read1(substream, buf, count);
2771 #else
2772         {
2773                 ssize_t res = snd_pcm_oss_read1(substream, buf, count);
2774                 pcm_dbg(substream->pcm,
2775                         "pcm_oss: read %li bytes (returned %li bytes)\n",
2776                         (long)count, (long)res);
2777                 return res;
2778         }
2779 #endif
2780 }
2781
2782 static ssize_t snd_pcm_oss_write(struct file *file, const char __user *buf, size_t count, loff_t *offset)
2783 {
2784         struct snd_pcm_oss_file *pcm_oss_file;
2785         struct snd_pcm_substream *substream;
2786         long result;
2787
2788         pcm_oss_file = file->private_data;
2789         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2790         if (substream == NULL)
2791                 return -ENXIO;
2792         substream->f_flags = file->f_flags & O_NONBLOCK;
2793         result = snd_pcm_oss_write1(substream, buf, count);
2794 #ifdef OSS_DEBUG
2795         pcm_dbg(substream->pcm, "pcm_oss: write %li bytes (wrote %li bytes)\n",
2796                (long)count, (long)result);
2797 #endif
2798         return result;
2799 }
2800
2801 static int snd_pcm_oss_playback_ready(struct snd_pcm_substream *substream)
2802 {
2803         struct snd_pcm_runtime *runtime = substream->runtime;
2804         if (atomic_read(&substream->mmap_count))
2805                 return runtime->oss.prev_hw_ptr_period !=
2806                                                 get_hw_ptr_period(runtime);
2807         else
2808                 return snd_pcm_playback_avail(runtime) >=
2809                                                 runtime->oss.period_frames;
2810 }
2811
2812 static int snd_pcm_oss_capture_ready(struct snd_pcm_substream *substream)
2813 {
2814         struct snd_pcm_runtime *runtime = substream->runtime;
2815         if (atomic_read(&substream->mmap_count))
2816                 return runtime->oss.prev_hw_ptr_period !=
2817                                                 get_hw_ptr_period(runtime);
2818         else
2819                 return snd_pcm_capture_avail(runtime) >=
2820                                                 runtime->oss.period_frames;
2821 }
2822
2823 static __poll_t snd_pcm_oss_poll(struct file *file, poll_table * wait)
2824 {
2825         struct snd_pcm_oss_file *pcm_oss_file;
2826         __poll_t mask;
2827         struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL;
2828
2829         pcm_oss_file = file->private_data;
2830
2831         psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2832         csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2833
2834         mask = 0;
2835         if (psubstream != NULL) {
2836                 struct snd_pcm_runtime *runtime = psubstream->runtime;
2837                 poll_wait(file, &runtime->sleep, wait);
2838                 snd_pcm_stream_lock_irq(psubstream);
2839                 if (runtime->status->state != SNDRV_PCM_STATE_DRAINING &&
2840                     (runtime->status->state != SNDRV_PCM_STATE_RUNNING ||
2841                      snd_pcm_oss_playback_ready(psubstream)))
2842                         mask |= EPOLLOUT | EPOLLWRNORM;
2843                 snd_pcm_stream_unlock_irq(psubstream);
2844         }
2845         if (csubstream != NULL) {
2846                 struct snd_pcm_runtime *runtime = csubstream->runtime;
2847                 snd_pcm_state_t ostate;
2848                 poll_wait(file, &runtime->sleep, wait);
2849                 snd_pcm_stream_lock_irq(csubstream);
2850                 if ((ostate = runtime->status->state) != SNDRV_PCM_STATE_RUNNING ||
2851                     snd_pcm_oss_capture_ready(csubstream))
2852                         mask |= EPOLLIN | EPOLLRDNORM;
2853                 snd_pcm_stream_unlock_irq(csubstream);
2854                 if (ostate != SNDRV_PCM_STATE_RUNNING && runtime->oss.trigger) {
2855                         struct snd_pcm_oss_file ofile;
2856                         memset(&ofile, 0, sizeof(ofile));
2857                         ofile.streams[SNDRV_PCM_STREAM_CAPTURE] = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2858                         runtime->oss.trigger = 0;
2859                         snd_pcm_oss_set_trigger(&ofile, PCM_ENABLE_INPUT);
2860                 }
2861         }
2862
2863         return mask;
2864 }
2865
2866 static int snd_pcm_oss_mmap(struct file *file, struct vm_area_struct *area)
2867 {
2868         struct snd_pcm_oss_file *pcm_oss_file;
2869         struct snd_pcm_substream *substream = NULL;
2870         struct snd_pcm_runtime *runtime;
2871         int err;
2872
2873 #ifdef OSS_DEBUG
2874         pr_debug("pcm_oss: mmap begin\n");
2875 #endif
2876         pcm_oss_file = file->private_data;
2877         switch ((area->vm_flags & (VM_READ | VM_WRITE))) {
2878         case VM_READ | VM_WRITE:
2879                 substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2880                 if (substream)
2881                         break;
2882                 fallthrough;
2883         case VM_READ:
2884                 substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2885                 break;
2886         case VM_WRITE:
2887                 substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2888                 break;
2889         default:
2890                 return -EINVAL;
2891         }
2892         /* set VM_READ access as well to fix memset() routines that do
2893            reads before writes (to improve performance) */
2894         area->vm_flags |= VM_READ;
2895         if (substream == NULL)
2896                 return -ENXIO;
2897         runtime = substream->runtime;
2898         if (!(runtime->info & SNDRV_PCM_INFO_MMAP_VALID))
2899                 return -EIO;
2900         if (runtime->info & SNDRV_PCM_INFO_INTERLEAVED)
2901                 runtime->access = SNDRV_PCM_ACCESS_MMAP_INTERLEAVED;
2902         else
2903                 return -EIO;
2904
2905         if (runtime->oss.params) {
2906                 /* use mutex_trylock() for params_lock for avoiding a deadlock
2907                  * between mmap_lock and params_lock taken by
2908                  * copy_from/to_user() in snd_pcm_oss_write/read()
2909                  */
2910                 err = snd_pcm_oss_change_params(substream, true);
2911                 if (err < 0)
2912                         return err;
2913         }
2914 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
2915         if (runtime->oss.plugin_first != NULL)
2916                 return -EIO;
2917 #endif
2918
2919         if (area->vm_pgoff != 0)
2920                 return -EINVAL;
2921
2922         err = snd_pcm_mmap_data(substream, file, area);
2923         if (err < 0)
2924                 return err;
2925         runtime->oss.mmap_bytes = area->vm_end - area->vm_start;
2926         runtime->silence_threshold = 0;
2927         runtime->silence_size = 0;
2928 #ifdef OSS_DEBUG
2929         pr_debug("pcm_oss: mmap ok, bytes = 0x%x\n",
2930                runtime->oss.mmap_bytes);
2931 #endif
2932         /* In mmap mode we never stop */
2933         runtime->stop_threshold = runtime->boundary;
2934
2935         return 0;
2936 }
2937
2938 #ifdef CONFIG_SND_VERBOSE_PROCFS
2939 /*
2940  *  /proc interface
2941  */
2942
2943 static void snd_pcm_oss_proc_read(struct snd_info_entry *entry,
2944                                   struct snd_info_buffer *buffer)
2945 {
2946         struct snd_pcm_str *pstr = entry->private_data;
2947         struct snd_pcm_oss_setup *setup = pstr->oss.setup_list;
2948         mutex_lock(&pstr->oss.setup_mutex);
2949         while (setup) {
2950                 snd_iprintf(buffer, "%s %u %u%s%s%s%s%s%s\n",
2951                             setup->task_name,
2952                             setup->periods,
2953                             setup->period_size,
2954                             setup->disable ? " disable" : "",
2955                             setup->direct ? " direct" : "",
2956                             setup->block ? " block" : "",
2957                             setup->nonblock ? " non-block" : "",
2958                             setup->partialfrag ? " partial-frag" : "",
2959                             setup->nosilence ? " no-silence" : "");
2960                 setup = setup->next;
2961         }
2962         mutex_unlock(&pstr->oss.setup_mutex);
2963 }
2964
2965 static void snd_pcm_oss_proc_free_setup_list(struct snd_pcm_str * pstr)
2966 {
2967         struct snd_pcm_oss_setup *setup, *setupn;
2968
2969         for (setup = pstr->oss.setup_list, pstr->oss.setup_list = NULL;
2970              setup; setup = setupn) {
2971                 setupn = setup->next;
2972                 kfree(setup->task_name);
2973                 kfree(setup);
2974         }
2975         pstr->oss.setup_list = NULL;
2976 }
2977
2978 static void snd_pcm_oss_proc_write(struct snd_info_entry *entry,
2979                                    struct snd_info_buffer *buffer)
2980 {
2981         struct snd_pcm_str *pstr = entry->private_data;
2982         char line[128], str[32], task_name[32];
2983         const char *ptr;
2984         int idx1;
2985         struct snd_pcm_oss_setup *setup, *setup1, template;
2986
2987         while (!snd_info_get_line(buffer, line, sizeof(line))) {
2988                 mutex_lock(&pstr->oss.setup_mutex);
2989                 memset(&template, 0, sizeof(template));
2990                 ptr = snd_info_get_str(task_name, line, sizeof(task_name));
2991                 if (!strcmp(task_name, "clear") || !strcmp(task_name, "erase")) {
2992                         snd_pcm_oss_proc_free_setup_list(pstr);
2993                         mutex_unlock(&pstr->oss.setup_mutex);
2994                         continue;
2995                 }
2996                 for (setup = pstr->oss.setup_list; setup; setup = setup->next) {
2997                         if (!strcmp(setup->task_name, task_name)) {
2998                                 template = *setup;
2999                                 break;
3000                         }
3001                 }
3002                 ptr = snd_info_get_str(str, ptr, sizeof(str));
3003                 template.periods = simple_strtoul(str, NULL, 10);
3004                 ptr = snd_info_get_str(str, ptr, sizeof(str));
3005                 template.period_size = simple_strtoul(str, NULL, 10);
3006                 for (idx1 = 31; idx1 >= 0; idx1--)
3007                         if (template.period_size & (1 << idx1))
3008                                 break;
3009                 for (idx1--; idx1 >= 0; idx1--)
3010                         template.period_size &= ~(1 << idx1);
3011                 do {
3012                         ptr = snd_info_get_str(str, ptr, sizeof(str));
3013                         if (!strcmp(str, "disable")) {
3014                                 template.disable = 1;
3015                         } else if (!strcmp(str, "direct")) {
3016                                 template.direct = 1;
3017                         } else if (!strcmp(str, "block")) {
3018                                 template.block = 1;
3019                         } else if (!strcmp(str, "non-block")) {
3020                                 template.nonblock = 1;
3021                         } else if (!strcmp(str, "partial-frag")) {
3022                                 template.partialfrag = 1;
3023                         } else if (!strcmp(str, "no-silence")) {
3024                                 template.nosilence = 1;
3025                         } else if (!strcmp(str, "buggy-ptr")) {
3026                                 template.buggyptr = 1;
3027                         }
3028                 } while (*str);
3029                 if (setup == NULL) {
3030                         setup = kmalloc(sizeof(*setup), GFP_KERNEL);
3031                         if (! setup) {
3032                                 buffer->error = -ENOMEM;
3033                                 mutex_unlock(&pstr->oss.setup_mutex);
3034                                 return;
3035                         }
3036                         if (pstr->oss.setup_list == NULL)
3037                                 pstr->oss.setup_list = setup;
3038                         else {
3039                                 for (setup1 = pstr->oss.setup_list;
3040                                      setup1->next; setup1 = setup1->next);
3041                                 setup1->next = setup;
3042                         }
3043                         template.task_name = kstrdup(task_name, GFP_KERNEL);
3044                         if (! template.task_name) {
3045                                 kfree(setup);
3046                                 buffer->error = -ENOMEM;
3047                                 mutex_unlock(&pstr->oss.setup_mutex);
3048                                 return;
3049                         }
3050                 }
3051                 *setup = template;
3052                 mutex_unlock(&pstr->oss.setup_mutex);
3053         }
3054 }
3055
3056 static void snd_pcm_oss_proc_init(struct snd_pcm *pcm)
3057 {
3058         int stream;
3059         for (stream = 0; stream < 2; ++stream) {
3060                 struct snd_info_entry *entry;
3061                 struct snd_pcm_str *pstr = &pcm->streams[stream];
3062                 if (pstr->substream_count == 0)
3063                         continue;
3064                 if ((entry = snd_info_create_card_entry(pcm->card, "oss", pstr->proc_root)) != NULL) {
3065                         entry->content = SNDRV_INFO_CONTENT_TEXT;
3066                         entry->mode = S_IFREG | 0644;
3067                         entry->c.text.read = snd_pcm_oss_proc_read;
3068                         entry->c.text.write = snd_pcm_oss_proc_write;
3069                         entry->private_data = pstr;
3070                         if (snd_info_register(entry) < 0) {
3071                                 snd_info_free_entry(entry);
3072                                 entry = NULL;
3073                         }
3074                 }
3075                 pstr->oss.proc_entry = entry;
3076         }
3077 }
3078
3079 static void snd_pcm_oss_proc_done(struct snd_pcm *pcm)
3080 {
3081         int stream;
3082         for (stream = 0; stream < 2; ++stream) {
3083                 struct snd_pcm_str *pstr = &pcm->streams[stream];
3084                 snd_info_free_entry(pstr->oss.proc_entry);
3085                 pstr->oss.proc_entry = NULL;
3086                 snd_pcm_oss_proc_free_setup_list(pstr);
3087         }
3088 }
3089 #else /* !CONFIG_SND_VERBOSE_PROCFS */
3090 #define snd_pcm_oss_proc_init(pcm)
3091 #define snd_pcm_oss_proc_done(pcm)
3092 #endif /* CONFIG_SND_VERBOSE_PROCFS */
3093
3094 /*
3095  *  ENTRY functions
3096  */
3097
3098 static const struct file_operations snd_pcm_oss_f_reg =
3099 {
3100         .owner =        THIS_MODULE,
3101         .read =         snd_pcm_oss_read,
3102         .write =        snd_pcm_oss_write,
3103         .open =         snd_pcm_oss_open,
3104         .release =      snd_pcm_oss_release,
3105         .llseek =       no_llseek,
3106         .poll =         snd_pcm_oss_poll,
3107         .unlocked_ioctl =       snd_pcm_oss_ioctl,
3108         .compat_ioctl = snd_pcm_oss_ioctl_compat,
3109         .mmap =         snd_pcm_oss_mmap,
3110 };
3111
3112 static void register_oss_dsp(struct snd_pcm *pcm, int index)
3113 {
3114         if (snd_register_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM,
3115                                     pcm->card, index, &snd_pcm_oss_f_reg,
3116                                     pcm) < 0) {
3117                 pcm_err(pcm, "unable to register OSS PCM device %i:%i\n",
3118                            pcm->card->number, pcm->device);
3119         }
3120 }
3121
3122 static int snd_pcm_oss_register_minor(struct snd_pcm *pcm)
3123 {
3124         pcm->oss.reg = 0;
3125         if (dsp_map[pcm->card->number] == (int)pcm->device) {
3126                 char name[128];
3127                 int duplex;
3128                 register_oss_dsp(pcm, 0);
3129                 duplex = (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream_count > 0 &&
3130                               pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream_count &&
3131                               !(pcm->info_flags & SNDRV_PCM_INFO_HALF_DUPLEX));
3132                 sprintf(name, "%s%s", pcm->name, duplex ? " (DUPLEX)" : "");
3133 #ifdef SNDRV_OSS_INFO_DEV_AUDIO
3134                 snd_oss_info_register(SNDRV_OSS_INFO_DEV_AUDIO,
3135                                       pcm->card->number,
3136                                       name);
3137 #endif
3138                 pcm->oss.reg++;
3139                 pcm->oss.reg_mask |= 1;
3140         }
3141         if (adsp_map[pcm->card->number] == (int)pcm->device) {
3142                 register_oss_dsp(pcm, 1);
3143                 pcm->oss.reg++;
3144                 pcm->oss.reg_mask |= 2;
3145         }
3146
3147         if (pcm->oss.reg)
3148                 snd_pcm_oss_proc_init(pcm);
3149
3150         return 0;
3151 }
3152
3153 static int snd_pcm_oss_disconnect_minor(struct snd_pcm *pcm)
3154 {
3155         if (pcm->oss.reg) {
3156                 if (pcm->oss.reg_mask & 1) {
3157                         pcm->oss.reg_mask &= ~1;
3158                         snd_unregister_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM,
3159                                                   pcm->card, 0);
3160                 }
3161                 if (pcm->oss.reg_mask & 2) {
3162                         pcm->oss.reg_mask &= ~2;
3163                         snd_unregister_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM,
3164                                                   pcm->card, 1);
3165                 }
3166                 if (dsp_map[pcm->card->number] == (int)pcm->device) {
3167 #ifdef SNDRV_OSS_INFO_DEV_AUDIO
3168                         snd_oss_info_unregister(SNDRV_OSS_INFO_DEV_AUDIO, pcm->card->number);
3169 #endif
3170                 }
3171                 pcm->oss.reg = 0;
3172         }
3173         return 0;
3174 }
3175
3176 static int snd_pcm_oss_unregister_minor(struct snd_pcm *pcm)
3177 {
3178         snd_pcm_oss_disconnect_minor(pcm);
3179         snd_pcm_oss_proc_done(pcm);
3180         return 0;
3181 }
3182
3183 static struct snd_pcm_notify snd_pcm_oss_notify =
3184 {
3185         .n_register =   snd_pcm_oss_register_minor,
3186         .n_disconnect = snd_pcm_oss_disconnect_minor,
3187         .n_unregister = snd_pcm_oss_unregister_minor,
3188 };
3189
3190 static int __init alsa_pcm_oss_init(void)
3191 {
3192         int i;
3193         int err;
3194
3195         /* check device map table */
3196         for (i = 0; i < SNDRV_CARDS; i++) {
3197                 if (dsp_map[i] < 0 || dsp_map[i] >= SNDRV_PCM_DEVICES) {
3198                         pr_err("ALSA: pcm_oss: invalid dsp_map[%d] = %d\n",
3199                                    i, dsp_map[i]);
3200                         dsp_map[i] = 0;
3201                 }
3202                 if (adsp_map[i] < 0 || adsp_map[i] >= SNDRV_PCM_DEVICES) {
3203                         pr_err("ALSA: pcm_oss: invalid adsp_map[%d] = %d\n",
3204                                    i, adsp_map[i]);
3205                         adsp_map[i] = 1;
3206                 }
3207         }
3208         if ((err = snd_pcm_notify(&snd_pcm_oss_notify, 0)) < 0)
3209                 return err;
3210         return 0;
3211 }
3212
3213 static void __exit alsa_pcm_oss_exit(void)
3214 {
3215         snd_pcm_notify(&snd_pcm_oss_notify, 1);
3216 }
3217
3218 module_init(alsa_pcm_oss_init)
3219 module_exit(alsa_pcm_oss_exit)