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(sformat_mask, (__force int)sformat)) {
 912                 for (sformat = (__force snd_pcm_format_t)0;
 913                      (__force int)sformat <= (__force int)SNDRV_PCM_FORMAT_LAST;
 914                      sformat = (__force snd_pcm_format_t)((__force int)sformat + 1)) {
 915                         if (snd_mask_test(sformat_mask, (__force int)sformat) &&
 916                             snd_pcm_oss_format_to(sformat) >= 0)
 917                                 break;
 918                 }
 919                 if ((__force int)sformat > (__force int)SNDRV_PCM_FORMAT_LAST) {
 920                         pcm_dbg(substream->pcm, "Cannot find a format!!!\n");
 921                         err = -EINVAL;
 922                         goto failure;
 923                 }
 924         }
 925         err = _snd_pcm_hw_param_set(sparams, SNDRV_PCM_HW_PARAM_FORMAT, (__force int)sformat, 0);
 926         if (err < 0)
 927                 goto failure;
 928
 929         if (direct) {
 930                 memcpy(params, sparams, sizeof(*params));
 931         } else {
 932                 _snd_pcm_hw_params_any(params);
 933                 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_ACCESS,
 934                                       (__force int)SNDRV_PCM_ACCESS_RW_INTERLEAVED, 0);
 935                 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_FORMAT,
 936                                       (__force int)snd_pcm_oss_format_from(runtime->oss.format), 0);
 937                 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_CHANNELS,
 938                                       runtime->oss.channels, 0);
 939                 _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_RATE,
 940                                       runtime->oss.rate, 0);
 941                 pdprintf("client: access = %i, format = %i, channels = %i, rate = %i\n",
 942                          params_access(params), params_format(params),
 943                          params_channels(params), params_rate(params));
 944         }
 945         pdprintf("slave: access = %i, format = %i, channels = %i, rate = %i\n",
 946                  params_access(sparams), params_format(sparams),
 947                  params_channels(sparams), params_rate(sparams));
 948
 949         oss_frame_size = snd_pcm_format_physical_width(params_format(params)) *
 950                          params_channels(params) / 8;
 951
 952         err = snd_pcm_oss_period_size(substream, params, sparams);
 953         if (err < 0)
 954                 goto failure;
 955
 956         n = snd_pcm_plug_slave_size(substream, runtime->oss.period_bytes / oss_frame_size);
 957         err = snd_pcm_hw_param_near(substream, sparams, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, n, NULL);
 958         if (err < 0)
 959                 goto failure;
 960
 961         err = snd_pcm_hw_param_near(substream, sparams, SNDRV_PCM_HW_PARAM_PERIODS,
 962                                      runtime->oss.periods, NULL);
 963         if (err < 0)
 964                 goto failure;
 965
 966         snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
 967
 968         err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_HW_PARAMS, sparams);
 969         if (err < 0) {
 970                 pcm_dbg(substream->pcm, "HW_PARAMS failed: %i\n", err);
 971                 goto failure;
 972         }
 973
 974 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
 975         snd_pcm_oss_plugin_clear(substream);
 976         if (!direct) {
 977                 /* add necessary plugins */
 978                 snd_pcm_oss_plugin_clear(substream);
 979                 if ((err = snd_pcm_plug_format_plugins(substream,
 980                                                        params,
 981                                                        sparams)) < 0) {
 982                         pcm_dbg(substream->pcm,
 983                                 "snd_pcm_plug_format_plugins failed: %i\n", err);
 984                         snd_pcm_oss_plugin_clear(substream);
 985                         goto failure;
 986                 }
 987                 if (runtime->oss.plugin_first) {
 988                         struct snd_pcm_plugin *plugin;
 989                         if ((err = snd_pcm_plugin_build_io(substream, sparams, &plugin)) < 0) {
 990                                 pcm_dbg(substream->pcm,
 991                                         "snd_pcm_plugin_build_io failed: %i\n", err);
 992                                 snd_pcm_oss_plugin_clear(substream);
 993                                 goto failure;
 994                         }
 995                         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 996                                 err = snd_pcm_plugin_append(plugin);
 997                         } else {
 998                                 err = snd_pcm_plugin_insert(plugin);
 999                         }
1000                         if (err < 0) {
1001                                 snd_pcm_oss_plugin_clear(substream);
1002                                 goto failure;
1003                         }
1004                 }
1005         }
1006 #endif
1007
1008         if (runtime->oss.trigger) {
1009                 sw_params->start_threshold = 1;
1010         } else {
1011                 sw_params->start_threshold = runtime->boundary;
1012         }
1013         if (atomic_read(&substream->mmap_count) ||
1014             substream->stream == SNDRV_PCM_STREAM_CAPTURE)
1015                 sw_params->stop_threshold = runtime->boundary;
1016         else
1017                 sw_params->stop_threshold = runtime->buffer_size;
1018         sw_params->tstamp_mode = SNDRV_PCM_TSTAMP_NONE;
1019         sw_params->period_step = 1;
1020         sw_params->avail_min = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
1021                 1 : runtime->period_size;
1022         if (atomic_read(&substream->mmap_count) ||
1023             substream->oss.setup.nosilence) {
1024                 sw_params->silence_threshold = 0;
1025                 sw_params->silence_size = 0;
1026         } else {
1027                 snd_pcm_uframes_t frames;
1028                 frames = runtime->period_size + 16;
1029                 if (frames > runtime->buffer_size)
1030                         frames = runtime->buffer_size;
1031                 sw_params->silence_threshold = frames;
1032                 sw_params->silence_size = frames;
1033         }
1034
1035         if ((err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_SW_PARAMS, sw_params)) < 0) {
1036                 pcm_dbg(substream->pcm, "SW_PARAMS failed: %i\n", err);
1037                 goto failure;
1038         }
1039
1040         runtime->oss.periods = params_periods(sparams);
1041         oss_period_size = snd_pcm_plug_client_size(substream, params_period_size(sparams));
1042         if (oss_period_size < 0) {
1043                 err = -EINVAL;
1044                 goto failure;
1045         }
1046 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
1047         if (runtime->oss.plugin_first) {
1048                 err = snd_pcm_plug_alloc(substream, oss_period_size);
1049                 if (err < 0)
1050                         goto failure;
1051         }
1052 #endif
1053         oss_period_size = array_size(oss_period_size, oss_frame_size);
1054         oss_buffer_size = array_size(oss_period_size, runtime->oss.periods);
1055         if (oss_buffer_size <= 0) {
1056                 err = -EINVAL;
1057                 goto failure;
1058         }
1059
1060         runtime->oss.period_bytes = oss_period_size;
1061         runtime->oss.buffer_bytes = oss_buffer_size;
1062
1063         pdprintf("oss: period bytes = %i, buffer bytes = %i\n",
1064                  runtime->oss.period_bytes,
1065                  runtime->oss.buffer_bytes);
1066         pdprintf("slave: period_size = %i, buffer_size = %i\n",
1067                  params_period_size(sparams),
1068                  params_buffer_size(sparams));
1069
1070         runtime->oss.format = snd_pcm_oss_format_to(params_format(params));
1071         runtime->oss.channels = params_channels(params);
1072         runtime->oss.rate = params_rate(params);
1073
1074         kvfree(runtime->oss.buffer);
1075         runtime->oss.buffer = kvzalloc(runtime->oss.period_bytes, GFP_KERNEL);
1076         if (!runtime->oss.buffer) {
1077                 err = -ENOMEM;
1078                 goto failure;
1079         }
1080
1081         runtime->oss.params = 0;
1082         runtime->oss.prepare = 1;
1083         runtime->oss.buffer_used = 0;
1084         if (runtime->dma_area)
1085                 snd_pcm_format_set_silence(runtime->format, runtime->dma_area, bytes_to_samples(runtime, runtime->dma_bytes));
1086
1087         runtime->oss.period_frames = snd_pcm_alsa_frames(substream, oss_period_size);
1088
1089         err = 0;
1090 failure:
1091         kfree(sw_params);
1092         kfree(params);
1093         kfree(sparams);
1094         return err;
1095 }
1096
1097 /* this one takes the lock by itself */
1098 static int snd_pcm_oss_change_params(struct snd_pcm_substream *substream,
1099                                      bool trylock)
1100 {
1101         struct snd_pcm_runtime *runtime = substream->runtime;
1102         int err;
1103
1104         if (trylock) {
1105                 if (!(mutex_trylock(&runtime->oss.params_lock)))
1106                         return -EAGAIN;
1107         } else if (mutex_lock_interruptible(&runtime->oss.params_lock))
1108                 return -ERESTARTSYS;
1109
1110         err = snd_pcm_oss_change_params_locked(substream);
1111         mutex_unlock(&runtime->oss.params_lock);
1112         return err;
1113 }
1114
1115 static int snd_pcm_oss_get_active_substream(struct snd_pcm_oss_file *pcm_oss_file, struct snd_pcm_substream **r_substream)
1116 {
1117         int idx, err;
1118         struct snd_pcm_substream *asubstream = NULL, *substream;
1119
1120         for (idx = 0; idx < 2; idx++) {
1121                 substream = pcm_oss_file->streams[idx];
1122                 if (substream == NULL)
1123                         continue;
1124                 if (asubstream == NULL)
1125                         asubstream = substream;
1126                 if (substream->runtime->oss.params) {
1127                         err = snd_pcm_oss_change_params(substream, false);
1128                         if (err < 0)
1129                                 return err;
1130                 }
1131         }
1132         if (!asubstream)
1133                 return -EIO;
1134         if (r_substream)
1135                 *r_substream = asubstream;
1136         return 0;
1137 }
1138
1139 /* call with params_lock held */
1140 /* NOTE: this always call PREPARE unconditionally no matter whether
1141  * runtime->oss.prepare is set or not
1142  */
1143 static int snd_pcm_oss_prepare(struct snd_pcm_substream *substream)
1144 {
1145         int err;
1146         struct snd_pcm_runtime *runtime = substream->runtime;
1147
1148         err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_PREPARE, NULL);
1149         if (err < 0) {
1150                 pcm_dbg(substream->pcm,
1151                         "snd_pcm_oss_prepare: SNDRV_PCM_IOCTL_PREPARE failed\n");
1152                 return err;
1153         }
1154         runtime->oss.prepare = 0;
1155         runtime->oss.prev_hw_ptr_period = 0;
1156         runtime->oss.period_ptr = 0;
1157         runtime->oss.buffer_used = 0;
1158
1159         return 0;
1160 }
1161
1162 static int snd_pcm_oss_make_ready(struct snd_pcm_substream *substream)
1163 {
1164         struct snd_pcm_runtime *runtime;
1165         int err;
1166
1167         runtime = substream->runtime;
1168         if (runtime->oss.params) {
1169                 err = snd_pcm_oss_change_params(substream, false);
1170                 if (err < 0)
1171                         return err;
1172         }
1173         if (runtime->oss.prepare) {
1174                 if (mutex_lock_interruptible(&runtime->oss.params_lock))
1175                         return -ERESTARTSYS;
1176                 err = snd_pcm_oss_prepare(substream);
1177                 mutex_unlock(&runtime->oss.params_lock);
1178                 if (err < 0)
1179                         return err;
1180         }
1181         return 0;
1182 }
1183
1184 /* call with params_lock held */
1185 static int snd_pcm_oss_make_ready_locked(struct snd_pcm_substream *substream)
1186 {
1187         struct snd_pcm_runtime *runtime;
1188         int err;
1189
1190         runtime = substream->runtime;
1191         if (runtime->oss.params) {
1192                 err = snd_pcm_oss_change_params_locked(substream);
1193                 if (err < 0)
1194                         return err;
1195         }
1196         if (runtime->oss.prepare) {
1197                 err = snd_pcm_oss_prepare(substream);
1198                 if (err < 0)
1199                         return err;
1200         }
1201         return 0;
1202 }
1203
1204 static int snd_pcm_oss_capture_position_fixup(struct snd_pcm_substream *substream, snd_pcm_sframes_t *delay)
1205 {
1206         struct snd_pcm_runtime *runtime;
1207         snd_pcm_uframes_t frames;
1208         int err = 0;
1209
1210         while (1) {
1211                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, delay);
1212                 if (err < 0)
1213                         break;
1214                 runtime = substream->runtime;
1215                 if (*delay <= (snd_pcm_sframes_t)runtime->buffer_size)
1216                         break;
1217                 /* in case of overrun, skip whole periods like OSS/Linux driver does */
1218                 /* until avail(delay) <= buffer_size */
1219                 frames = (*delay - runtime->buffer_size) + runtime->period_size - 1;
1220                 frames /= runtime->period_size;
1221                 frames *= runtime->period_size;
1222                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_FORWARD, &frames);
1223                 if (err < 0)
1224                         break;
1225         }
1226         return err;
1227 }
1228
1229 snd_pcm_sframes_t snd_pcm_oss_write3(struct snd_pcm_substream *substream, const char *ptr, snd_pcm_uframes_t frames, int in_kernel)
1230 {
1231         struct snd_pcm_runtime *runtime = substream->runtime;
1232         int ret;
1233         while (1) {
1234                 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
1235                     runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1236 #ifdef OSS_DEBUG
1237                         pcm_dbg(substream->pcm,
1238                                 "pcm_oss: write: recovering from %s\n",
1239                                 runtime->status->state == SNDRV_PCM_STATE_XRUN ?
1240                                 "XRUN" : "SUSPEND");
1241 #endif
1242                         ret = snd_pcm_oss_prepare(substream);
1243                         if (ret < 0)
1244                                 break;
1245                 }
1246                 ret = __snd_pcm_lib_xfer(substream, (void *)ptr, true,
1247                                          frames, in_kernel);
1248                 if (ret != -EPIPE && ret != -ESTRPIPE)
1249                         break;
1250                 /* test, if we can't store new data, because the stream */
1251                 /* has not been started */
1252                 if (runtime->status->state == SNDRV_PCM_STATE_PREPARED)
1253                         return -EAGAIN;
1254         }
1255         return ret;
1256 }
1257
1258 snd_pcm_sframes_t snd_pcm_oss_read3(struct snd_pcm_substream *substream, char *ptr, snd_pcm_uframes_t frames, int in_kernel)
1259 {
1260         struct snd_pcm_runtime *runtime = substream->runtime;
1261         snd_pcm_sframes_t delay;
1262         int ret;
1263         while (1) {
1264                 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
1265                     runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1266 #ifdef OSS_DEBUG
1267                         pcm_dbg(substream->pcm,
1268                                 "pcm_oss: read: recovering from %s\n",
1269                                 runtime->status->state == SNDRV_PCM_STATE_XRUN ?
1270                                 "XRUN" : "SUSPEND");
1271 #endif
1272                         ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL);
1273                         if (ret < 0)
1274                                 break;
1275                 } else if (runtime->status->state == SNDRV_PCM_STATE_SETUP) {
1276                         ret = snd_pcm_oss_prepare(substream);
1277                         if (ret < 0)
1278                                 break;
1279                 }
1280                 ret = snd_pcm_oss_capture_position_fixup(substream, &delay);
1281                 if (ret < 0)
1282                         break;
1283                 ret = __snd_pcm_lib_xfer(substream, (void *)ptr, true,
1284                                          frames, in_kernel);
1285                 if (ret == -EPIPE) {
1286                         if (runtime->status->state == SNDRV_PCM_STATE_DRAINING) {
1287                                 ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
1288                                 if (ret < 0)
1289                                         break;
1290                         }
1291                         continue;
1292                 }
1293                 if (ret != -ESTRPIPE)
1294                         break;
1295         }
1296         return ret;
1297 }
1298
1299 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
1300 snd_pcm_sframes_t snd_pcm_oss_writev3(struct snd_pcm_substream *substream, void **bufs, snd_pcm_uframes_t frames)
1301 {
1302         struct snd_pcm_runtime *runtime = substream->runtime;
1303         int ret;
1304         while (1) {
1305                 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
1306                     runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1307 #ifdef OSS_DEBUG
1308                         pcm_dbg(substream->pcm,
1309                                 "pcm_oss: writev: recovering from %s\n",
1310                                 runtime->status->state == SNDRV_PCM_STATE_XRUN ?
1311                                 "XRUN" : "SUSPEND");
1312 #endif
1313                         ret = snd_pcm_oss_prepare(substream);
1314                         if (ret < 0)
1315                                 break;
1316                 }
1317                 ret = snd_pcm_kernel_writev(substream, bufs, frames);
1318                 if (ret != -EPIPE && ret != -ESTRPIPE)
1319                         break;
1320
1321                 /* test, if we can't store new data, because the stream */
1322                 /* has not been started */
1323                 if (runtime->status->state == SNDRV_PCM_STATE_PREPARED)
1324                         return -EAGAIN;
1325         }
1326         return ret;
1327 }
1328
1329 snd_pcm_sframes_t snd_pcm_oss_readv3(struct snd_pcm_substream *substream, void **bufs, snd_pcm_uframes_t frames)
1330 {
1331         struct snd_pcm_runtime *runtime = substream->runtime;
1332         int ret;
1333         while (1) {
1334                 if (runtime->status->state == SNDRV_PCM_STATE_XRUN ||
1335                     runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) {
1336 #ifdef OSS_DEBUG
1337                         pcm_dbg(substream->pcm,
1338                                 "pcm_oss: readv: recovering from %s\n",
1339                                 runtime->status->state == SNDRV_PCM_STATE_XRUN ?
1340                                 "XRUN" : "SUSPEND");
1341 #endif
1342                         ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL);
1343                         if (ret < 0)
1344                                 break;
1345                 } else if (runtime->status->state == SNDRV_PCM_STATE_SETUP) {
1346                         ret = snd_pcm_oss_prepare(substream);
1347                         if (ret < 0)
1348                                 break;
1349                 }
1350                 ret = snd_pcm_kernel_readv(substream, bufs, frames);
1351                 if (ret != -EPIPE && ret != -ESTRPIPE)
1352                         break;
1353         }
1354         return ret;
1355 }
1356 #endif /* CONFIG_SND_PCM_OSS_PLUGINS */
1357
1358 static ssize_t snd_pcm_oss_write2(struct snd_pcm_substream *substream, const char *buf, size_t bytes, int in_kernel)
1359 {
1360         struct snd_pcm_runtime *runtime = substream->runtime;
1361         snd_pcm_sframes_t frames, frames1;
1362 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
1363         if (runtime->oss.plugin_first) {
1364                 struct snd_pcm_plugin_channel *channels;
1365                 size_t oss_frame_bytes = (runtime->oss.plugin_first->src_width * runtime->oss.plugin_first->src_format.channels) / 8;
1366                 if (!in_kernel) {
1367                         if (copy_from_user(runtime->oss.buffer, (const char __force __user *)buf, bytes))
1368                                 return -EFAULT;
1369                         buf = runtime->oss.buffer;
1370                 }
1371                 frames = bytes / oss_frame_bytes;
1372                 frames1 = snd_pcm_plug_client_channels_buf(substream, (char *)buf, frames, &channels);
1373                 if (frames1 < 0)
1374                         return frames1;
1375                 frames1 = snd_pcm_plug_write_transfer(substream, channels, frames1);
1376                 if (frames1 <= 0)
1377                         return frames1;
1378                 bytes = frames1 * oss_frame_bytes;
1379         } else
1380 #endif
1381         {
1382                 frames = bytes_to_frames(runtime, bytes);
1383                 frames1 = snd_pcm_oss_write3(substream, buf, frames, in_kernel);
1384                 if (frames1 <= 0)
1385                         return frames1;
1386                 bytes = frames_to_bytes(runtime, frames1);
1387         }
1388         return bytes;
1389 }
1390
1391 static ssize_t snd_pcm_oss_write1(struct snd_pcm_substream *substream, const char __user *buf, size_t bytes)
1392 {
1393         size_t xfer = 0;
1394         ssize_t tmp = 0;
1395         struct snd_pcm_runtime *runtime = substream->runtime;
1396
1397         if (atomic_read(&substream->mmap_count))
1398                 return -ENXIO;
1399
1400         atomic_inc(&runtime->oss.rw_ref);
1401         while (bytes > 0) {
1402                 if (mutex_lock_interruptible(&runtime->oss.params_lock)) {
1403                         tmp = -ERESTARTSYS;
1404                         break;
1405                 }
1406                 tmp = snd_pcm_oss_make_ready_locked(substream);
1407                 if (tmp < 0)
1408                         goto err;
1409                 if (bytes < runtime->oss.period_bytes || runtime->oss.buffer_used > 0) {
1410                         tmp = bytes;
1411                         if (tmp + runtime->oss.buffer_used > runtime->oss.period_bytes)
1412                                 tmp = runtime->oss.period_bytes - runtime->oss.buffer_used;
1413                         if (tmp > 0) {
1414                                 if (copy_from_user(runtime->oss.buffer + runtime->oss.buffer_used, buf, tmp)) {
1415                                         tmp = -EFAULT;
1416                                         goto err;
1417                                 }
1418                         }
1419                         runtime->oss.buffer_used += tmp;
1420                         buf += tmp;
1421                         bytes -= tmp;
1422                         xfer += tmp;
1423                         if (substream->oss.setup.partialfrag ||
1424                             runtime->oss.buffer_used == runtime->oss.period_bytes) {
1425                                 tmp = snd_pcm_oss_write2(substream, runtime->oss.buffer + runtime->oss.period_ptr,
1426                                                          runtime->oss.buffer_used - runtime->oss.period_ptr, 1);
1427                                 if (tmp <= 0)
1428                                         goto err;
1429                                 runtime->oss.bytes += tmp;
1430                                 runtime->oss.period_ptr += tmp;
1431                                 runtime->oss.period_ptr %= runtime->oss.period_bytes;
1432                                 if (runtime->oss.period_ptr == 0 ||
1433                                     runtime->oss.period_ptr == runtime->oss.buffer_used)
1434                                         runtime->oss.buffer_used = 0;
1435                                 else if ((substream->f_flags & O_NONBLOCK) != 0) {
1436                                         tmp = -EAGAIN;
1437                                         goto err;
1438                                 }
1439                         }
1440                 } else {
1441                         tmp = snd_pcm_oss_write2(substream,
1442                                                  (const char __force *)buf,
1443                                                  runtime->oss.period_bytes, 0);
1444                         if (tmp <= 0)
1445                                 goto err;
1446                         runtime->oss.bytes += tmp;
1447                         buf += tmp;
1448                         bytes -= tmp;
1449                         xfer += tmp;
1450                         if ((substream->f_flags & O_NONBLOCK) != 0 &&
1451                             tmp != runtime->oss.period_bytes)
1452                                 tmp = -EAGAIN;
1453                 }
1454  err:
1455                 mutex_unlock(&runtime->oss.params_lock);
1456                 if (tmp < 0)
1457                         break;
1458                 if (signal_pending(current)) {
1459                         tmp = -ERESTARTSYS;
1460                         break;
1461                 }
1462                 tmp = 0;
1463         }
1464         atomic_dec(&runtime->oss.rw_ref);
1465         return xfer > 0 ? (snd_pcm_sframes_t)xfer : tmp;
1466 }
1467
1468 static ssize_t snd_pcm_oss_read2(struct snd_pcm_substream *substream, char *buf, size_t bytes, int in_kernel)
1469 {
1470         struct snd_pcm_runtime *runtime = substream->runtime;
1471         snd_pcm_sframes_t frames, frames1;
1472 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
1473         char __user *final_dst = (char __force __user *)buf;
1474         if (runtime->oss.plugin_first) {
1475                 struct snd_pcm_plugin_channel *channels;
1476                 size_t oss_frame_bytes = (runtime->oss.plugin_last->dst_width * runtime->oss.plugin_last->dst_format.channels) / 8;
1477                 if (!in_kernel)
1478                         buf = runtime->oss.buffer;
1479                 frames = bytes / oss_frame_bytes;
1480                 frames1 = snd_pcm_plug_client_channels_buf(substream, buf, frames, &channels);
1481                 if (frames1 < 0)
1482                         return frames1;
1483                 frames1 = snd_pcm_plug_read_transfer(substream, channels, frames1);
1484                 if (frames1 <= 0)
1485                         return frames1;
1486                 bytes = frames1 * oss_frame_bytes;
1487                 if (!in_kernel && copy_to_user(final_dst, buf, bytes))
1488                         return -EFAULT;
1489         } else
1490 #endif
1491         {
1492                 frames = bytes_to_frames(runtime, bytes);
1493                 frames1 = snd_pcm_oss_read3(substream, buf, frames, in_kernel);
1494                 if (frames1 <= 0)
1495                         return frames1;
1496                 bytes = frames_to_bytes(runtime, frames1);
1497         }
1498         return bytes;
1499 }
1500
1501 static ssize_t snd_pcm_oss_read1(struct snd_pcm_substream *substream, char __user *buf, size_t bytes)
1502 {
1503         size_t xfer = 0;
1504         ssize_t tmp = 0;
1505         struct snd_pcm_runtime *runtime = substream->runtime;
1506
1507         if (atomic_read(&substream->mmap_count))
1508                 return -ENXIO;
1509
1510         atomic_inc(&runtime->oss.rw_ref);
1511         while (bytes > 0) {
1512                 if (mutex_lock_interruptible(&runtime->oss.params_lock)) {
1513                         tmp = -ERESTARTSYS;
1514                         break;
1515                 }
1516                 tmp = snd_pcm_oss_make_ready_locked(substream);
1517                 if (tmp < 0)
1518                         goto err;
1519                 if (bytes < runtime->oss.period_bytes || runtime->oss.buffer_used > 0) {
1520                         if (runtime->oss.buffer_used == 0) {
1521                                 tmp = snd_pcm_oss_read2(substream, runtime->oss.buffer, runtime->oss.period_bytes, 1);
1522                                 if (tmp <= 0)
1523                                         goto err;
1524                                 runtime->oss.bytes += tmp;
1525                                 runtime->oss.period_ptr = tmp;
1526                                 runtime->oss.buffer_used = tmp;
1527                         }
1528                         tmp = bytes;
1529                         if ((size_t) tmp > runtime->oss.buffer_used)
1530                                 tmp = runtime->oss.buffer_used;
1531                         if (copy_to_user(buf, runtime->oss.buffer + (runtime->oss.period_ptr - runtime->oss.buffer_used), tmp)) {
1532                                 tmp = -EFAULT;
1533                                 goto err;
1534                         }
1535                         buf += tmp;
1536                         bytes -= tmp;
1537                         xfer += tmp;
1538                         runtime->oss.buffer_used -= tmp;
1539                 } else {
1540                         tmp = snd_pcm_oss_read2(substream, (char __force *)buf,
1541                                                 runtime->oss.period_bytes, 0);
1542                         if (tmp <= 0)
1543                                 goto err;
1544                         runtime->oss.bytes += tmp;
1545                         buf += tmp;
1546                         bytes -= tmp;
1547                         xfer += tmp;
1548                 }
1549  err:
1550                 mutex_unlock(&runtime->oss.params_lock);
1551                 if (tmp < 0)
1552                         break;
1553                 if (signal_pending(current)) {
1554                         tmp = -ERESTARTSYS;
1555                         break;
1556                 }
1557                 tmp = 0;
1558         }
1559         atomic_dec(&runtime->oss.rw_ref);
1560         return xfer > 0 ? (snd_pcm_sframes_t)xfer : tmp;
1561 }
1562
1563 static int snd_pcm_oss_reset(struct snd_pcm_oss_file *pcm_oss_file)
1564 {
1565         struct snd_pcm_substream *substream;
1566         struct snd_pcm_runtime *runtime;
1567         int i;
1568
1569         for (i = 0; i < 2; i++) {
1570                 substream = pcm_oss_file->streams[i];
1571                 if (!substream)
1572                         continue;
1573                 runtime = substream->runtime;
1574                 snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
1575                 mutex_lock(&runtime->oss.params_lock);
1576                 runtime->oss.prepare = 1;
1577                 runtime->oss.buffer_used = 0;
1578                 runtime->oss.prev_hw_ptr_period = 0;
1579                 runtime->oss.period_ptr = 0;
1580                 mutex_unlock(&runtime->oss.params_lock);
1581         }
1582         return 0;
1583 }
1584
1585 static int snd_pcm_oss_post(struct snd_pcm_oss_file *pcm_oss_file)
1586 {
1587         struct snd_pcm_substream *substream;
1588         int err;
1589
1590         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
1591         if (substream != NULL) {
1592                 if ((err = snd_pcm_oss_make_ready(substream)) < 0)
1593                         return err;
1594                 snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_START, NULL);
1595         }
1596         /* note: all errors from the start action are ignored */
1597         /* OSS apps do not know, how to handle them */
1598         return 0;
1599 }
1600
1601 static int snd_pcm_oss_sync1(struct snd_pcm_substream *substream, size_t size)
1602 {
1603         struct snd_pcm_runtime *runtime;
1604         ssize_t result = 0;
1605         snd_pcm_state_t state;
1606         long res;
1607         wait_queue_entry_t wait;
1608
1609         runtime = substream->runtime;
1610         init_waitqueue_entry(&wait, current);
1611         add_wait_queue(&runtime->sleep, &wait);
1612 #ifdef OSS_DEBUG
1613         pcm_dbg(substream->pcm, "sync1: size = %li\n", size);
1614 #endif
1615         while (1) {
1616                 result = snd_pcm_oss_write2(substream, runtime->oss.buffer, size, 1);
1617                 if (result > 0) {
1618                         runtime->oss.buffer_used = 0;
1619                         result = 0;
1620                         break;
1621                 }
1622                 if (result != 0 && result != -EAGAIN)
1623                         break;
1624                 result = 0;
1625                 set_current_state(TASK_INTERRUPTIBLE);
1626                 snd_pcm_stream_lock_irq(substream);
1627                 state = runtime->status->state;
1628                 snd_pcm_stream_unlock_irq(substream);
1629                 if (state != SNDRV_PCM_STATE_RUNNING) {
1630                         set_current_state(TASK_RUNNING);
1631                         break;
1632                 }
1633                 res = schedule_timeout(10 * HZ);
1634                 if (signal_pending(current)) {
1635                         result = -ERESTARTSYS;
1636                         break;
1637                 }
1638                 if (res == 0) {
1639                         pcm_err(substream->pcm,
1640                                 "OSS sync error - DMA timeout\n");
1641                         result = -EIO;
1642                         break;
1643                 }
1644         }
1645         remove_wait_queue(&runtime->sleep, &wait);
1646         return result;
1647 }
1648
1649 static int snd_pcm_oss_sync(struct snd_pcm_oss_file *pcm_oss_file)
1650 {
1651         int err = 0;
1652         unsigned int saved_f_flags;
1653         struct snd_pcm_substream *substream;
1654         struct snd_pcm_runtime *runtime;
1655         snd_pcm_format_t format;
1656         unsigned long width;
1657         size_t size;
1658
1659         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
1660         if (substream != NULL) {
1661                 runtime = substream->runtime;
1662                 if (atomic_read(&substream->mmap_count))
1663                         goto __direct;
1664                 atomic_inc(&runtime->oss.rw_ref);
1665                 if (mutex_lock_interruptible(&runtime->oss.params_lock)) {
1666                         atomic_dec(&runtime->oss.rw_ref);
1667                         return -ERESTARTSYS;
1668                 }
1669                 err = snd_pcm_oss_make_ready_locked(substream);
1670                 if (err < 0)
1671                         goto unlock;
1672                 format = snd_pcm_oss_format_from(runtime->oss.format);
1673                 width = snd_pcm_format_physical_width(format);
1674                 if (runtime->oss.buffer_used > 0) {
1675 #ifdef OSS_DEBUG
1676                         pcm_dbg(substream->pcm, "sync: buffer_used\n");
1677 #endif
1678                         size = (8 * (runtime->oss.period_bytes - runtime->oss.buffer_used) + 7) / width;
1679                         snd_pcm_format_set_silence(format,
1680                                                    runtime->oss.buffer + runtime->oss.buffer_used,
1681                                                    size);
1682                         err = snd_pcm_oss_sync1(substream, runtime->oss.period_bytes);
1683                         if (err < 0)
1684                                 goto unlock;
1685                 } else if (runtime->oss.period_ptr > 0) {
1686 #ifdef OSS_DEBUG
1687                         pcm_dbg(substream->pcm, "sync: period_ptr\n");
1688 #endif
1689                         size = runtime->oss.period_bytes - runtime->oss.period_ptr;
1690                         snd_pcm_format_set_silence(format,
1691                                                    runtime->oss.buffer,
1692                                                    size * 8 / width);
1693                         err = snd_pcm_oss_sync1(substream, size);
1694                         if (err < 0)
1695                                 goto unlock;
1696                 }
1697                 /*
1698                  * The ALSA's period might be a bit large than OSS one.
1699                  * Fill the remain portion of ALSA period with zeros.
1700                  */
1701                 size = runtime->control->appl_ptr % runtime->period_size;
1702                 if (size > 0) {
1703                         size = runtime->period_size - size;
1704                         if (runtime->access == SNDRV_PCM_ACCESS_RW_INTERLEAVED)
1705                                 snd_pcm_lib_write(substream, NULL, size);
1706                         else if (runtime->access == SNDRV_PCM_ACCESS_RW_NONINTERLEAVED)
1707                                 snd_pcm_lib_writev(substream, NULL, size);
1708                 }
1709 unlock:
1710                 mutex_unlock(&runtime->oss.params_lock);
1711                 atomic_dec(&runtime->oss.rw_ref);
1712                 if (err < 0)
1713                         return err;
1714                 /*
1715                  * finish sync: drain the buffer
1716                  */
1717               __direct:
1718                 saved_f_flags = substream->f_flags;
1719                 substream->f_flags &= ~O_NONBLOCK;
1720                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL);
1721                 substream->f_flags = saved_f_flags;
1722                 if (err < 0)
1723                         return err;
1724                 mutex_lock(&runtime->oss.params_lock);
1725                 runtime->oss.prepare = 1;
1726                 mutex_unlock(&runtime->oss.params_lock);
1727         }
1728
1729         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
1730         if (substream != NULL) {
1731                 if ((err = snd_pcm_oss_make_ready(substream)) < 0)
1732                         return err;
1733                 runtime = substream->runtime;
1734                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL);
1735                 if (err < 0)
1736                         return err;
1737                 mutex_lock(&runtime->oss.params_lock);
1738                 runtime->oss.buffer_used = 0;
1739                 runtime->oss.prepare = 1;
1740                 mutex_unlock(&runtime->oss.params_lock);
1741         }
1742         return 0;
1743 }
1744
1745 static int snd_pcm_oss_set_rate(struct snd_pcm_oss_file *pcm_oss_file, int rate)
1746 {
1747         int idx;
1748
1749         for (idx = 1; idx >= 0; --idx) {
1750                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1751                 struct snd_pcm_runtime *runtime;
1752                 int err;
1753
1754                 if (substream == NULL)
1755                         continue;
1756                 runtime = substream->runtime;
1757                 if (rate < 1000)
1758                         rate = 1000;
1759                 else if (rate > 192000)
1760                         rate = 192000;
1761                 err = lock_params(runtime);
1762                 if (err < 0)
1763                         return err;
1764                 if (runtime->oss.rate != rate) {
1765                         runtime->oss.params = 1;
1766                         runtime->oss.rate = rate;
1767                 }
1768                 unlock_params(runtime);
1769         }
1770         return snd_pcm_oss_get_rate(pcm_oss_file);
1771 }
1772
1773 static int snd_pcm_oss_get_rate(struct snd_pcm_oss_file *pcm_oss_file)
1774 {
1775         struct snd_pcm_substream *substream;
1776         int err;
1777
1778         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1779                 return err;
1780         return substream->runtime->oss.rate;
1781 }
1782
1783 static int snd_pcm_oss_set_channels(struct snd_pcm_oss_file *pcm_oss_file, unsigned int channels)
1784 {
1785         int idx;
1786         if (channels < 1)
1787                 channels = 1;
1788         if (channels > 128)
1789                 return -EINVAL;
1790         for (idx = 1; idx >= 0; --idx) {
1791                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1792                 struct snd_pcm_runtime *runtime;
1793                 int err;
1794
1795                 if (substream == NULL)
1796                         continue;
1797                 runtime = substream->runtime;
1798                 err = lock_params(runtime);
1799                 if (err < 0)
1800                         return err;
1801                 if (runtime->oss.channels != channels) {
1802                         runtime->oss.params = 1;
1803                         runtime->oss.channels = channels;
1804                 }
1805                 unlock_params(runtime);
1806         }
1807         return snd_pcm_oss_get_channels(pcm_oss_file);
1808 }
1809
1810 static int snd_pcm_oss_get_channels(struct snd_pcm_oss_file *pcm_oss_file)
1811 {
1812         struct snd_pcm_substream *substream;
1813         int err;
1814
1815         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1816                 return err;
1817         return substream->runtime->oss.channels;
1818 }
1819
1820 static int snd_pcm_oss_get_block_size(struct snd_pcm_oss_file *pcm_oss_file)
1821 {
1822         struct snd_pcm_substream *substream;
1823         int err;
1824
1825         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1826                 return err;
1827         return substream->runtime->oss.period_bytes;
1828 }
1829
1830 static int snd_pcm_oss_get_formats(struct snd_pcm_oss_file *pcm_oss_file)
1831 {
1832         struct snd_pcm_substream *substream;
1833         int err;
1834         int direct;
1835         struct snd_pcm_hw_params *params;
1836         unsigned int formats = 0;
1837         const struct snd_mask *format_mask;
1838         int fmt;
1839
1840         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1841                 return err;
1842         if (atomic_read(&substream->mmap_count))
1843                 direct = 1;
1844         else
1845                 direct = substream->oss.setup.direct;
1846         if (!direct)
1847                 return AFMT_MU_LAW | AFMT_U8 |
1848                        AFMT_S16_LE | AFMT_S16_BE |
1849                        AFMT_S8 | AFMT_U16_LE |
1850                        AFMT_U16_BE |
1851                         AFMT_S32_LE | AFMT_S32_BE |
1852                         AFMT_S24_LE | AFMT_S24_BE |
1853                         AFMT_S24_PACKED;
1854         params = kmalloc(sizeof(*params), GFP_KERNEL);
1855         if (!params)
1856                 return -ENOMEM;
1857         _snd_pcm_hw_params_any(params);
1858         err = snd_pcm_hw_refine(substream, params);
1859         if (err < 0)
1860                 goto error;
1861         format_mask = hw_param_mask_c(params, SNDRV_PCM_HW_PARAM_FORMAT);
1862         for (fmt = 0; fmt < 32; ++fmt) {
1863                 if (snd_mask_test(format_mask, fmt)) {
1864                         int f = snd_pcm_oss_format_to((__force snd_pcm_format_t)fmt);
1865                         if (f >= 0)
1866                                 formats |= f;
1867                 }
1868         }
1869
1870  error:
1871         kfree(params);
1872         return err < 0 ? err : formats;
1873 }
1874
1875 static int snd_pcm_oss_set_format(struct snd_pcm_oss_file *pcm_oss_file, int format)
1876 {
1877         int formats, idx;
1878         int err;
1879
1880         if (format != AFMT_QUERY) {
1881                 formats = snd_pcm_oss_get_formats(pcm_oss_file);
1882                 if (formats < 0)
1883                         return formats;
1884                 if (!(formats & format))
1885                         format = AFMT_U8;
1886                 for (idx = 1; idx >= 0; --idx) {
1887                         struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1888                         struct snd_pcm_runtime *runtime;
1889                         if (substream == NULL)
1890                                 continue;
1891                         runtime = substream->runtime;
1892                         err = lock_params(runtime);
1893                         if (err < 0)
1894                                 return err;
1895                         if (runtime->oss.format != format) {
1896                                 runtime->oss.params = 1;
1897                                 runtime->oss.format = format;
1898                         }
1899                         unlock_params(runtime);
1900                 }
1901         }
1902         return snd_pcm_oss_get_format(pcm_oss_file);
1903 }
1904
1905 static int snd_pcm_oss_get_format(struct snd_pcm_oss_file *pcm_oss_file)
1906 {
1907         struct snd_pcm_substream *substream;
1908         int err;
1909
1910         if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0)
1911                 return err;
1912         return substream->runtime->oss.format;
1913 }
1914
1915 static int snd_pcm_oss_set_subdivide1(struct snd_pcm_substream *substream, int subdivide)
1916 {
1917         struct snd_pcm_runtime *runtime;
1918
1919         runtime = substream->runtime;
1920         if (subdivide == 0) {
1921                 subdivide = runtime->oss.subdivision;
1922                 if (subdivide == 0)
1923                         subdivide = 1;
1924                 return subdivide;
1925         }
1926         if (runtime->oss.subdivision || runtime->oss.fragshift)
1927                 return -EINVAL;
1928         if (subdivide != 1 && subdivide != 2 && subdivide != 4 &&
1929             subdivide != 8 && subdivide != 16)
1930                 return -EINVAL;
1931         runtime->oss.subdivision = subdivide;
1932         runtime->oss.params = 1;
1933         return subdivide;
1934 }
1935
1936 static int snd_pcm_oss_set_subdivide(struct snd_pcm_oss_file *pcm_oss_file, int subdivide)
1937 {
1938         int err = -EINVAL, idx;
1939
1940         for (idx = 1; idx >= 0; --idx) {
1941                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1942                 struct snd_pcm_runtime *runtime;
1943
1944                 if (substream == NULL)
1945                         continue;
1946                 runtime = substream->runtime;
1947                 err = lock_params(runtime);
1948                 if (err < 0)
1949                         return err;
1950                 err = snd_pcm_oss_set_subdivide1(substream, subdivide);
1951                 unlock_params(runtime);
1952                 if (err < 0)
1953                         return err;
1954         }
1955         return err;
1956 }
1957
1958 static int snd_pcm_oss_set_fragment1(struct snd_pcm_substream *substream, unsigned int val)
1959 {
1960         struct snd_pcm_runtime *runtime;
1961         int fragshift;
1962
1963         runtime = substream->runtime;
1964         if (runtime->oss.subdivision || runtime->oss.fragshift)
1965                 return -EINVAL;
1966         fragshift = val & 0xffff;
1967         if (fragshift >= 25) /* should be large enough */
1968                 return -EINVAL;
1969         runtime->oss.fragshift = fragshift;
1970         runtime->oss.maxfrags = (val >> 16) & 0xffff;
1971         if (runtime->oss.fragshift < 4)         /* < 16 */
1972                 runtime->oss.fragshift = 4;
1973         if (runtime->oss.maxfrags < 2)
1974                 runtime->oss.maxfrags = 2;
1975         runtime->oss.params = 1;
1976         return 0;
1977 }
1978
1979 static int snd_pcm_oss_set_fragment(struct snd_pcm_oss_file *pcm_oss_file, unsigned int val)
1980 {
1981         int err = -EINVAL, idx;
1982
1983         for (idx = 1; idx >= 0; --idx) {
1984                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
1985                 struct snd_pcm_runtime *runtime;
1986
1987                 if (substream == NULL)
1988                         continue;
1989                 runtime = substream->runtime;
1990                 err = lock_params(runtime);
1991                 if (err < 0)
1992                         return err;
1993                 err = snd_pcm_oss_set_fragment1(substream, val);
1994                 unlock_params(runtime);
1995                 if (err < 0)
1996                         return err;
1997         }
1998         return err;
1999 }
2000
2001 static int snd_pcm_oss_nonblock(struct file * file)
2002 {
2003         spin_lock(&file->f_lock);
2004         file->f_flags |= O_NONBLOCK;
2005         spin_unlock(&file->f_lock);
2006         return 0;
2007 }
2008
2009 static int snd_pcm_oss_get_caps1(struct snd_pcm_substream *substream, int res)
2010 {
2011
2012         if (substream == NULL) {
2013                 res &= ~DSP_CAP_DUPLEX;
2014                 return res;
2015         }
2016 #ifdef DSP_CAP_MULTI
2017         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
2018                 if (substream->pstr->substream_count > 1)
2019                         res |= DSP_CAP_MULTI;
2020 #endif
2021         /* DSP_CAP_REALTIME is set all times: */
2022         /* all ALSA drivers can return actual pointer in ring buffer */
2023 #if defined(DSP_CAP_REALTIME) && 0
2024         {
2025                 struct snd_pcm_runtime *runtime = substream->runtime;
2026                 if (runtime->info & (SNDRV_PCM_INFO_BLOCK_TRANSFER|SNDRV_PCM_INFO_BATCH))
2027                         res &= ~DSP_CAP_REALTIME;
2028         }
2029 #endif
2030         return res;
2031 }
2032
2033 static int snd_pcm_oss_get_caps(struct snd_pcm_oss_file *pcm_oss_file)
2034 {
2035         int result, idx;
2036
2037         result = DSP_CAP_TRIGGER | DSP_CAP_MMAP | DSP_CAP_DUPLEX | DSP_CAP_REALTIME;
2038         for (idx = 0; idx < 2; idx++) {
2039                 struct snd_pcm_substream *substream = pcm_oss_file->streams[idx];
2040                 result = snd_pcm_oss_get_caps1(substream, result);
2041         }
2042         result |= 0x0001;       /* revision - same as SB AWE 64 */
2043         return result;
2044 }
2045
2046 static void snd_pcm_oss_simulate_fill(struct snd_pcm_substream *substream,
2047                                       snd_pcm_uframes_t hw_ptr)
2048 {
2049         struct snd_pcm_runtime *runtime = substream->runtime;
2050         snd_pcm_uframes_t appl_ptr;
2051         appl_ptr = hw_ptr + runtime->buffer_size;
2052         appl_ptr %= runtime->boundary;
2053         runtime->control->appl_ptr = appl_ptr;
2054 }
2055
2056 static int snd_pcm_oss_set_trigger(struct snd_pcm_oss_file *pcm_oss_file, int trigger)
2057 {
2058         struct snd_pcm_runtime *runtime;
2059         struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL;
2060         int err, cmd;
2061
2062 #ifdef OSS_DEBUG
2063         pr_debug("pcm_oss: trigger = 0x%x\n", trigger);
2064 #endif
2065
2066         psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2067         csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2068
2069         if (psubstream) {
2070                 if ((err = snd_pcm_oss_make_ready(psubstream)) < 0)
2071                         return err;
2072         }
2073         if (csubstream) {
2074                 if ((err = snd_pcm_oss_make_ready(csubstream)) < 0)
2075                         return err;
2076         }
2077         if (psubstream) {
2078                 runtime = psubstream->runtime;
2079                 cmd = 0;
2080                 if (mutex_lock_interruptible(&runtime->oss.params_lock))
2081                         return -ERESTARTSYS;
2082                 if (trigger & PCM_ENABLE_OUTPUT) {
2083                         if (runtime->oss.trigger)
2084                                 goto _skip1;
2085                         if (atomic_read(&psubstream->mmap_count))
2086                                 snd_pcm_oss_simulate_fill(psubstream,
2087                                                 get_hw_ptr_period(runtime));
2088                         runtime->oss.trigger = 1;
2089                         runtime->start_threshold = 1;
2090                         cmd = SNDRV_PCM_IOCTL_START;
2091                 } else {
2092                         if (!runtime->oss.trigger)
2093                                 goto _skip1;
2094                         runtime->oss.trigger = 0;
2095                         runtime->start_threshold = runtime->boundary;
2096                         cmd = SNDRV_PCM_IOCTL_DROP;
2097                         runtime->oss.prepare = 1;
2098                 }
2099  _skip1:
2100                 mutex_unlock(&runtime->oss.params_lock);
2101                 if (cmd) {
2102                         err = snd_pcm_kernel_ioctl(psubstream, cmd, NULL);
2103                         if (err < 0)
2104                                 return err;
2105                 }
2106         }
2107         if (csubstream) {
2108                 runtime = csubstream->runtime;
2109                 cmd = 0;
2110                 if (mutex_lock_interruptible(&runtime->oss.params_lock))
2111                         return -ERESTARTSYS;
2112                 if (trigger & PCM_ENABLE_INPUT) {
2113                         if (runtime->oss.trigger)
2114                                 goto _skip2;
2115                         runtime->oss.trigger = 1;
2116                         runtime->start_threshold = 1;
2117                         cmd = SNDRV_PCM_IOCTL_START;
2118                 } else {
2119                         if (!runtime->oss.trigger)
2120                                 goto _skip2;
2121                         runtime->oss.trigger = 0;
2122                         runtime->start_threshold = runtime->boundary;
2123                         cmd = SNDRV_PCM_IOCTL_DROP;
2124                         runtime->oss.prepare = 1;
2125                 }
2126  _skip2:
2127                 mutex_unlock(&runtime->oss.params_lock);
2128                 if (cmd) {
2129                         err = snd_pcm_kernel_ioctl(csubstream, cmd, NULL);
2130                         if (err < 0)
2131                                 return err;
2132                 }
2133         }
2134         return 0;
2135 }
2136
2137 static int snd_pcm_oss_get_trigger(struct snd_pcm_oss_file *pcm_oss_file)
2138 {
2139         struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL;
2140         int result = 0;
2141
2142         psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2143         csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2144         if (psubstream && psubstream->runtime && psubstream->runtime->oss.trigger)
2145                 result |= PCM_ENABLE_OUTPUT;
2146         if (csubstream && csubstream->runtime && csubstream->runtime->oss.trigger)
2147                 result |= PCM_ENABLE_INPUT;
2148         return result;
2149 }
2150
2151 static int snd_pcm_oss_get_odelay(struct snd_pcm_oss_file *pcm_oss_file)
2152 {
2153         struct snd_pcm_substream *substream;
2154         struct snd_pcm_runtime *runtime;
2155         snd_pcm_sframes_t delay;
2156         int err;
2157
2158         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2159         if (substream == NULL)
2160                 return -EINVAL;
2161         if ((err = snd_pcm_oss_make_ready(substream)) < 0)
2162                 return err;
2163         runtime = substream->runtime;
2164         if (runtime->oss.params || runtime->oss.prepare)
2165                 return 0;
2166         err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &delay);
2167         if (err == -EPIPE)
2168                 delay = 0;      /* hack for broken OSS applications */
2169         else if (err < 0)
2170                 return err;
2171         return snd_pcm_oss_bytes(substream, delay);
2172 }
2173
2174 static int snd_pcm_oss_get_ptr(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct count_info __user * _info)
2175 {
2176         struct snd_pcm_substream *substream;
2177         struct snd_pcm_runtime *runtime;
2178         snd_pcm_sframes_t delay;
2179         int fixup;
2180         struct count_info info;
2181         int err;
2182
2183         if (_info == NULL)
2184                 return -EFAULT;
2185         substream = pcm_oss_file->streams[stream];
2186         if (substream == NULL)
2187                 return -EINVAL;
2188         if ((err = snd_pcm_oss_make_ready(substream)) < 0)
2189                 return err;
2190         runtime = substream->runtime;
2191         if (runtime->oss.params || runtime->oss.prepare) {
2192                 memset(&info, 0, sizeof(info));
2193                 if (copy_to_user(_info, &info, sizeof(info)))
2194                         return -EFAULT;
2195                 return 0;
2196         }
2197         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
2198                 err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &delay);
2199                 if (err == -EPIPE || err == -ESTRPIPE || (! err && delay < 0)) {
2200                         err = 0;
2201                         delay = 0;
2202                         fixup = 0;
2203                 } else {
2204                         fixup = runtime->oss.buffer_used;
2205                 }
2206         } else {
2207                 err = snd_pcm_oss_capture_position_fixup(substream, &delay);
2208                 fixup = -runtime->oss.buffer_used;
2209         }
2210         if (err < 0)
2211                 return err;
2212         info.ptr = snd_pcm_oss_bytes(substream, runtime->status->hw_ptr % runtime->buffer_size);
2213         if (atomic_read(&substream->mmap_count)) {
2214                 snd_pcm_sframes_t n;
2215                 delay = get_hw_ptr_period(runtime);
2216                 n = delay - runtime->oss.prev_hw_ptr_period;
2217                 if (n < 0)
2218                         n += runtime->boundary;
2219                 info.blocks = n / runtime->period_size;
2220                 runtime->oss.prev_hw_ptr_period = delay;
2221                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
2222                         snd_pcm_oss_simulate_fill(substream, delay);
2223                 info.bytes = snd_pcm_oss_bytes(substream, runtime->status->hw_ptr) & INT_MAX;
2224         } else {
2225                 delay = snd_pcm_oss_bytes(substream, delay);
2226                 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
2227                         if (substream->oss.setup.buggyptr)
2228                                 info.blocks = (runtime->oss.buffer_bytes - delay - fixup) / runtime->oss.period_bytes;
2229                         else
2230                                 info.blocks = (delay + fixup) / runtime->oss.period_bytes;
2231                         info.bytes = (runtime->oss.bytes - delay) & INT_MAX;
2232                 } else {
2233                         delay += fixup;
2234                         info.blocks = delay / runtime->oss.period_bytes;
2235                         info.bytes = (runtime->oss.bytes + delay) & INT_MAX;
2236                 }
2237         }
2238         if (copy_to_user(_info, &info, sizeof(info)))
2239                 return -EFAULT;
2240         return 0;
2241 }
2242
2243 static int snd_pcm_oss_get_space(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct audio_buf_info __user *_info)
2244 {
2245         struct snd_pcm_substream *substream;
2246         struct snd_pcm_runtime *runtime;
2247         snd_pcm_sframes_t avail;
2248         int fixup;
2249         struct audio_buf_info info;
2250         int err;
2251
2252         if (_info == NULL)
2253                 return -EFAULT;
2254         substream = pcm_oss_file->streams[stream];
2255         if (substream == NULL)
2256                 return -EINVAL;
2257         runtime = substream->runtime;
2258
2259         if (runtime->oss.params &&
2260             (err = snd_pcm_oss_change_params(substream, false)) < 0)
2261                 return err;
2262
2263         info.fragsize = runtime->oss.period_bytes;
2264         info.fragstotal = runtime->periods;
2265         if (runtime->oss.prepare) {
2266                 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
2267                         info.bytes = runtime->oss.period_bytes * runtime->oss.periods;
2268                         info.fragments = runtime->oss.periods;
2269                 } else {
2270                         info.bytes = 0;
2271                         info.fragments = 0;
2272                 }
2273         } else {
2274                 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
2275                         err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &avail);
2276                         if (err == -EPIPE || err == -ESTRPIPE || (! err && avail < 0)) {
2277                                 avail = runtime->buffer_size;
2278                                 err = 0;
2279                                 fixup = 0;
2280                         } else {
2281                                 avail = runtime->buffer_size - avail;
2282                                 fixup = -runtime->oss.buffer_used;
2283                         }
2284                 } else {
2285                         err = snd_pcm_oss_capture_position_fixup(substream, &avail);
2286                         fixup = runtime->oss.buffer_used;
2287                 }
2288                 if (err < 0)
2289                         return err;
2290                 info.bytes = snd_pcm_oss_bytes(substream, avail) + fixup;
2291                 info.fragments = info.bytes / runtime->oss.period_bytes;
2292         }
2293
2294 #ifdef OSS_DEBUG
2295         pcm_dbg(substream->pcm,
2296                 "pcm_oss: space: bytes = %i, fragments = %i, fragstotal = %i, fragsize = %i\n",
2297                 info.bytes, info.fragments, info.fragstotal, info.fragsize);
2298 #endif
2299         if (copy_to_user(_info, &info, sizeof(info)))
2300                 return -EFAULT;
2301         return 0;
2302 }
2303
2304 static int snd_pcm_oss_get_mapbuf(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct buffmem_desc __user * _info)
2305 {
2306         // it won't be probably implemented
2307         // pr_debug("TODO: snd_pcm_oss_get_mapbuf\n");
2308         return -EINVAL;
2309 }
2310
2311 static const char *strip_task_path(const char *path)
2312 {
2313         const char *ptr, *ptrl = NULL;
2314         for (ptr = path; *ptr; ptr++) {
2315                 if (*ptr == '/')
2316                         ptrl = ptr + 1;
2317         }
2318         return ptrl;
2319 }
2320
2321 static void snd_pcm_oss_look_for_setup(struct snd_pcm *pcm, int stream,
2322                                       const char *task_name,
2323                                       struct snd_pcm_oss_setup *rsetup)
2324 {
2325         struct snd_pcm_oss_setup *setup;
2326
2327         mutex_lock(&pcm->streams[stream].oss.setup_mutex);
2328         do {
2329                 for (setup = pcm->streams[stream].oss.setup_list; setup;
2330                      setup = setup->next) {
2331                         if (!strcmp(setup->task_name, task_name))
2332                                 goto out;
2333                 }
2334         } while ((task_name = strip_task_path(task_name)) != NULL);
2335  out:
2336         if (setup)
2337                 *rsetup = *setup;
2338         mutex_unlock(&pcm->streams[stream].oss.setup_mutex);
2339 }
2340
2341 static void snd_pcm_oss_release_substream(struct snd_pcm_substream *substream)
2342 {
2343         struct snd_pcm_runtime *runtime;
2344         runtime = substream->runtime;
2345         kvfree(runtime->oss.buffer);
2346         runtime->oss.buffer = NULL;
2347 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
2348         snd_pcm_oss_plugin_clear(substream);
2349 #endif
2350         substream->oss.oss = 0;
2351 }
2352
2353 static void snd_pcm_oss_init_substream(struct snd_pcm_substream *substream,
2354                                        struct snd_pcm_oss_setup *setup,
2355                                        int minor)
2356 {
2357         struct snd_pcm_runtime *runtime;
2358
2359         substream->oss.oss = 1;
2360         substream->oss.setup = *setup;
2361         if (setup->nonblock)
2362                 substream->f_flags |= O_NONBLOCK;
2363         else if (setup->block)
2364                 substream->f_flags &= ~O_NONBLOCK;
2365         runtime = substream->runtime;
2366         runtime->oss.params = 1;
2367         runtime->oss.trigger = 1;
2368         runtime->oss.rate = 8000;
2369         mutex_init(&runtime->oss.params_lock);
2370         switch (SNDRV_MINOR_OSS_DEVICE(minor)) {
2371         case SNDRV_MINOR_OSS_PCM_8:
2372                 runtime->oss.format = AFMT_U8;
2373                 break;
2374         case SNDRV_MINOR_OSS_PCM_16:
2375                 runtime->oss.format = AFMT_S16_LE;
2376                 break;
2377         default:
2378                 runtime->oss.format = AFMT_MU_LAW;
2379         }
2380         runtime->oss.channels = 1;
2381         runtime->oss.fragshift = 0;
2382         runtime->oss.maxfrags = 0;
2383         runtime->oss.subdivision = 0;
2384         substream->pcm_release = snd_pcm_oss_release_substream;
2385         atomic_set(&runtime->oss.rw_ref, 0);
2386 }
2387
2388 static int snd_pcm_oss_release_file(struct snd_pcm_oss_file *pcm_oss_file)
2389 {
2390         int cidx;
2391         if (!pcm_oss_file)
2392                 return 0;
2393         for (cidx = 0; cidx < 2; ++cidx) {
2394                 struct snd_pcm_substream *substream = pcm_oss_file->streams[cidx];
2395                 if (substream)
2396                         snd_pcm_release_substream(substream);
2397         }
2398         kfree(pcm_oss_file);
2399         return 0;
2400 }
2401
2402 static int snd_pcm_oss_open_file(struct file *file,
2403                                  struct snd_pcm *pcm,
2404                                  struct snd_pcm_oss_file **rpcm_oss_file,
2405                                  int minor,
2406                                  struct snd_pcm_oss_setup *setup)
2407 {
2408         int idx, err;
2409         struct snd_pcm_oss_file *pcm_oss_file;
2410         struct snd_pcm_substream *substream;
2411         fmode_t f_mode = file->f_mode;
2412
2413         if (rpcm_oss_file)
2414                 *rpcm_oss_file = NULL;
2415
2416         pcm_oss_file = kzalloc(sizeof(*pcm_oss_file), GFP_KERNEL);
2417         if (pcm_oss_file == NULL)
2418                 return -ENOMEM;
2419
2420         if ((f_mode & (FMODE_WRITE|FMODE_READ)) == (FMODE_WRITE|FMODE_READ) &&
2421             (pcm->info_flags & SNDRV_PCM_INFO_HALF_DUPLEX))
2422                 f_mode = FMODE_WRITE;
2423
2424         file->f_flags &= ~O_APPEND;
2425         for (idx = 0; idx < 2; idx++) {
2426                 if (setup[idx].disable)
2427                         continue;
2428                 if (! pcm->streams[idx].substream_count)
2429                         continue; /* no matching substream */
2430                 if (idx == SNDRV_PCM_STREAM_PLAYBACK) {
2431                         if (! (f_mode & FMODE_WRITE))
2432                                 continue;
2433                 } else {
2434                         if (! (f_mode & FMODE_READ))
2435                                 continue;
2436                 }
2437                 err = snd_pcm_open_substream(pcm, idx, file, &substream);
2438                 if (err < 0) {
2439                         snd_pcm_oss_release_file(pcm_oss_file);
2440                         return err;
2441                 }
2442
2443                 pcm_oss_file->streams[idx] = substream;
2444                 snd_pcm_oss_init_substream(substream, &setup[idx], minor);
2445         }
2446
2447         if (!pcm_oss_file->streams[0] && !pcm_oss_file->streams[1]) {
2448                 snd_pcm_oss_release_file(pcm_oss_file);
2449                 return -EINVAL;
2450         }
2451
2452         file->private_data = pcm_oss_file;
2453         if (rpcm_oss_file)
2454                 *rpcm_oss_file = pcm_oss_file;
2455         return 0;
2456 }
2457
2458
2459 static int snd_task_name(struct task_struct *task, char *name, size_t size)
2460 {
2461         unsigned int idx;
2462
2463         if (snd_BUG_ON(!task || !name || size < 2))
2464                 return -EINVAL;
2465         for (idx = 0; idx < sizeof(task->comm) && idx + 1 < size; idx++)
2466                 name[idx] = task->comm[idx];
2467         name[idx] = '\0';
2468         return 0;
2469 }
2470
2471 static int snd_pcm_oss_open(struct inode *inode, struct file *file)
2472 {
2473         int err;
2474         char task_name[32];
2475         struct snd_pcm *pcm;
2476         struct snd_pcm_oss_file *pcm_oss_file;
2477         struct snd_pcm_oss_setup setup[2];
2478         int nonblock;
2479         wait_queue_entry_t wait;
2480
2481         err = nonseekable_open(inode, file);
2482         if (err < 0)
2483                 return err;
2484
2485         pcm = snd_lookup_oss_minor_data(iminor(inode),
2486                                         SNDRV_OSS_DEVICE_TYPE_PCM);
2487         if (pcm == NULL) {
2488                 err = -ENODEV;
2489                 goto __error1;
2490         }
2491         err = snd_card_file_add(pcm->card, file);
2492         if (err < 0)
2493                 goto __error1;
2494         if (!try_module_get(pcm->card->module)) {
2495                 err = -EFAULT;
2496                 goto __error2;
2497         }
2498         if (snd_task_name(current, task_name, sizeof(task_name)) < 0) {
2499                 err = -EFAULT;
2500                 goto __error;
2501         }
2502         memset(setup, 0, sizeof(setup));
2503         if (file->f_mode & FMODE_WRITE)
2504                 snd_pcm_oss_look_for_setup(pcm, SNDRV_PCM_STREAM_PLAYBACK,
2505                                            task_name, &setup[0]);
2506         if (file->f_mode & FMODE_READ)
2507                 snd_pcm_oss_look_for_setup(pcm, SNDRV_PCM_STREAM_CAPTURE,
2508                                            task_name, &setup[1]);
2509
2510         nonblock = !!(file->f_flags & O_NONBLOCK);
2511         if (!nonblock)
2512                 nonblock = nonblock_open;
2513
2514         init_waitqueue_entry(&wait, current);
2515         add_wait_queue(&pcm->open_wait, &wait);
2516         mutex_lock(&pcm->open_mutex);
2517         while (1) {
2518                 err = snd_pcm_oss_open_file(file, pcm, &pcm_oss_file,
2519                                             iminor(inode), setup);
2520                 if (err >= 0)
2521                         break;
2522                 if (err == -EAGAIN) {
2523                         if (nonblock) {
2524                                 err = -EBUSY;
2525                                 break;
2526                         }
2527                 } else
2528                         break;
2529                 set_current_state(TASK_INTERRUPTIBLE);
2530                 mutex_unlock(&pcm->open_mutex);
2531                 schedule();
2532                 mutex_lock(&pcm->open_mutex);
2533                 if (pcm->card->shutdown) {
2534                         err = -ENODEV;
2535                         break;
2536                 }
2537                 if (signal_pending(current)) {
2538                         err = -ERESTARTSYS;
2539                         break;
2540                 }
2541         }
2542         remove_wait_queue(&pcm->open_wait, &wait);
2543         mutex_unlock(&pcm->open_mutex);
2544         if (err < 0)
2545                 goto __error;
2546         snd_card_unref(pcm->card);
2547         return err;
2548
2549       __error:
2550         module_put(pcm->card->module);
2551       __error2:
2552         snd_card_file_remove(pcm->card, file);
2553       __error1:
2554         if (pcm)
2555                 snd_card_unref(pcm->card);
2556         return err;
2557 }
2558
2559 static int snd_pcm_oss_release(struct inode *inode, struct file *file)
2560 {
2561         struct snd_pcm *pcm;
2562         struct snd_pcm_substream *substream;
2563         struct snd_pcm_oss_file *pcm_oss_file;
2564
2565         pcm_oss_file = file->private_data;
2566         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2567         if (substream == NULL)
2568                 substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2569         if (snd_BUG_ON(!substream))
2570                 return -ENXIO;
2571         pcm = substream->pcm;
2572         if (!pcm->card->shutdown)
2573                 snd_pcm_oss_sync(pcm_oss_file);
2574         mutex_lock(&pcm->open_mutex);
2575         snd_pcm_oss_release_file(pcm_oss_file);
2576         mutex_unlock(&pcm->open_mutex);
2577         wake_up(&pcm->open_wait);
2578         module_put(pcm->card->module);
2579         snd_card_file_remove(pcm->card, file);
2580         return 0;
2581 }
2582
2583 static long snd_pcm_oss_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
2584 {
2585         struct snd_pcm_oss_file *pcm_oss_file;
2586         int __user *p = (int __user *)arg;
2587         int res;
2588
2589         pcm_oss_file = file->private_data;
2590         if (cmd == OSS_GETVERSION)
2591                 return put_user(SNDRV_OSS_VERSION, p);
2592         if (cmd == OSS_ALSAEMULVER)
2593                 return put_user(1, p);
2594 #if IS_REACHABLE(CONFIG_SND_MIXER_OSS)
2595         if (((cmd >> 8) & 0xff) == 'M') {       /* mixer ioctl - for OSS compatibility */
2596                 struct snd_pcm_substream *substream;
2597                 int idx;
2598                 for (idx = 0; idx < 2; ++idx) {
2599                         substream = pcm_oss_file->streams[idx];
2600                         if (substream != NULL)
2601                                 break;
2602                 }
2603                 if (snd_BUG_ON(idx >= 2))
2604                         return -ENXIO;
2605                 return snd_mixer_oss_ioctl_card(substream->pcm->card, cmd, arg);
2606         }
2607 #endif
2608         if (((cmd >> 8) & 0xff) != 'P')
2609                 return -EINVAL;
2610 #ifdef OSS_DEBUG
2611         pr_debug("pcm_oss: ioctl = 0x%x\n", cmd);
2612 #endif
2613         switch (cmd) {
2614         case SNDCTL_DSP_RESET:
2615                 return snd_pcm_oss_reset(pcm_oss_file);
2616         case SNDCTL_DSP_SYNC:
2617                 return snd_pcm_oss_sync(pcm_oss_file);
2618         case SNDCTL_DSP_SPEED:
2619                 if (get_user(res, p))
2620                         return -EFAULT;
2621                 if ((res = snd_pcm_oss_set_rate(pcm_oss_file, res))<0)
2622                         return res;
2623                 return put_user(res, p);
2624         case SOUND_PCM_READ_RATE:
2625                 res = snd_pcm_oss_get_rate(pcm_oss_file);
2626                 if (res < 0)
2627                         return res;
2628                 return put_user(res, p);
2629         case SNDCTL_DSP_STEREO:
2630                 if (get_user(res, p))
2631                         return -EFAULT;
2632                 res = res > 0 ? 2 : 1;
2633                 if ((res = snd_pcm_oss_set_channels(pcm_oss_file, res)) < 0)
2634                         return res;
2635                 return put_user(--res, p);
2636         case SNDCTL_DSP_GETBLKSIZE:
2637                 res = snd_pcm_oss_get_block_size(pcm_oss_file);
2638                 if (res < 0)
2639                         return res;
2640                 return put_user(res, p);
2641         case SNDCTL_DSP_SETFMT:
2642                 if (get_user(res, p))
2643                         return -EFAULT;
2644                 res = snd_pcm_oss_set_format(pcm_oss_file, res);
2645                 if (res < 0)
2646                         return res;
2647                 return put_user(res, p);
2648         case SOUND_PCM_READ_BITS:
2649                 res = snd_pcm_oss_get_format(pcm_oss_file);
2650                 if (res < 0)
2651                         return res;
2652                 return put_user(res, p);
2653         case SNDCTL_DSP_CHANNELS:
2654                 if (get_user(res, p))
2655                         return -EFAULT;
2656                 res = snd_pcm_oss_set_channels(pcm_oss_file, res);
2657                 if (res < 0)
2658                         return res;
2659                 return put_user(res, p);
2660         case SOUND_PCM_READ_CHANNELS:
2661                 res = snd_pcm_oss_get_channels(pcm_oss_file);
2662                 if (res < 0)
2663                         return res;
2664                 return put_user(res, p);
2665         case SOUND_PCM_WRITE_FILTER:
2666         case SOUND_PCM_READ_FILTER:
2667                 return -EIO;
2668         case SNDCTL_DSP_POST:
2669                 return snd_pcm_oss_post(pcm_oss_file);
2670         case SNDCTL_DSP_SUBDIVIDE:
2671                 if (get_user(res, p))
2672                         return -EFAULT;
2673                 res = snd_pcm_oss_set_subdivide(pcm_oss_file, res);
2674                 if (res < 0)
2675                         return res;
2676                 return put_user(res, p);
2677         case SNDCTL_DSP_SETFRAGMENT:
2678                 if (get_user(res, p))
2679                         return -EFAULT;
2680                 return snd_pcm_oss_set_fragment(pcm_oss_file, res);
2681         case SNDCTL_DSP_GETFMTS:
2682                 res = snd_pcm_oss_get_formats(pcm_oss_file);
2683                 if (res < 0)
2684                         return res;
2685                 return put_user(res, p);
2686         case SNDCTL_DSP_GETOSPACE:
2687         case SNDCTL_DSP_GETISPACE:
2688                 return snd_pcm_oss_get_space(pcm_oss_file,
2689                         cmd == SNDCTL_DSP_GETISPACE ?
2690                                 SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK,
2691                         (struct audio_buf_info __user *) arg);
2692         case SNDCTL_DSP_NONBLOCK:
2693                 return snd_pcm_oss_nonblock(file);
2694         case SNDCTL_DSP_GETCAPS:
2695                 res = snd_pcm_oss_get_caps(pcm_oss_file);
2696                 if (res < 0)
2697                         return res;
2698                 return put_user(res, p);
2699         case SNDCTL_DSP_GETTRIGGER:
2700                 res = snd_pcm_oss_get_trigger(pcm_oss_file);
2701                 if (res < 0)
2702                         return res;
2703                 return put_user(res, p);
2704         case SNDCTL_DSP_SETTRIGGER:
2705                 if (get_user(res, p))
2706                         return -EFAULT;
2707                 return snd_pcm_oss_set_trigger(pcm_oss_file, res);
2708         case SNDCTL_DSP_GETIPTR:
2709         case SNDCTL_DSP_GETOPTR:
2710                 return snd_pcm_oss_get_ptr(pcm_oss_file,
2711                         cmd == SNDCTL_DSP_GETIPTR ?
2712                                 SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK,
2713                         (struct count_info __user *) arg);
2714         case SNDCTL_DSP_MAPINBUF:
2715         case SNDCTL_DSP_MAPOUTBUF:
2716                 return snd_pcm_oss_get_mapbuf(pcm_oss_file,
2717                         cmd == SNDCTL_DSP_MAPINBUF ?
2718                                 SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK,
2719                         (struct buffmem_desc __user *) arg);
2720         case SNDCTL_DSP_SETSYNCRO:
2721                 /* stop DMA now.. */
2722                 return 0;
2723         case SNDCTL_DSP_SETDUPLEX:
2724                 if (snd_pcm_oss_get_caps(pcm_oss_file) & DSP_CAP_DUPLEX)
2725                         return 0;
2726                 return -EIO;
2727         case SNDCTL_DSP_GETODELAY:
2728                 res = snd_pcm_oss_get_odelay(pcm_oss_file);
2729                 if (res < 0) {
2730                         /* it's for sure, some broken apps don't check for error codes */
2731                         put_user(0, p);
2732                         return res;
2733                 }
2734                 return put_user(res, p);
2735         case SNDCTL_DSP_PROFILE:
2736                 return 0;       /* silently ignore */
2737         default:
2738                 pr_debug("pcm_oss: unknown command = 0x%x\n", cmd);
2739         }
2740         return -EINVAL;
2741 }
2742
2743 #ifdef CONFIG_COMPAT
2744 /* all compatible */
2745 static long snd_pcm_oss_ioctl_compat(struct file *file, unsigned int cmd,
2746                                      unsigned long arg)
2747 {
2748         return snd_pcm_oss_ioctl(file, cmd, (unsigned long)compat_ptr(arg));
2749 }
2750 #else
2751 #define snd_pcm_oss_ioctl_compat        NULL
2752 #endif
2753
2754 static ssize_t snd_pcm_oss_read(struct file *file, char __user *buf, size_t count, loff_t *offset)
2755 {
2756         struct snd_pcm_oss_file *pcm_oss_file;
2757         struct snd_pcm_substream *substream;
2758
2759         pcm_oss_file = file->private_data;
2760         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2761         if (substream == NULL)
2762                 return -ENXIO;
2763         substream->f_flags = file->f_flags & O_NONBLOCK;
2764 #ifndef OSS_DEBUG
2765         return snd_pcm_oss_read1(substream, buf, count);
2766 #else
2767         {
2768                 ssize_t res = snd_pcm_oss_read1(substream, buf, count);
2769                 pcm_dbg(substream->pcm,
2770                         "pcm_oss: read %li bytes (returned %li bytes)\n",
2771                         (long)count, (long)res);
2772                 return res;
2773         }
2774 #endif
2775 }
2776
2777 static ssize_t snd_pcm_oss_write(struct file *file, const char __user *buf, size_t count, loff_t *offset)
2778 {
2779         struct snd_pcm_oss_file *pcm_oss_file;
2780         struct snd_pcm_substream *substream;
2781         long result;
2782
2783         pcm_oss_file = file->private_data;
2784         substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2785         if (substream == NULL)
2786                 return -ENXIO;
2787         substream->f_flags = file->f_flags & O_NONBLOCK;
2788         result = snd_pcm_oss_write1(substream, buf, count);
2789 #ifdef OSS_DEBUG
2790         pcm_dbg(substream->pcm, "pcm_oss: write %li bytes (wrote %li bytes)\n",
2791                (long)count, (long)result);
2792 #endif
2793         return result;
2794 }
2795
2796 static int snd_pcm_oss_playback_ready(struct snd_pcm_substream *substream)
2797 {
2798         struct snd_pcm_runtime *runtime = substream->runtime;
2799         if (atomic_read(&substream->mmap_count))
2800                 return runtime->oss.prev_hw_ptr_period !=
2801                                                 get_hw_ptr_period(runtime);
2802         else
2803                 return snd_pcm_playback_avail(runtime) >=
2804                                                 runtime->oss.period_frames;
2805 }
2806
2807 static int snd_pcm_oss_capture_ready(struct snd_pcm_substream *substream)
2808 {
2809         struct snd_pcm_runtime *runtime = substream->runtime;
2810         if (atomic_read(&substream->mmap_count))
2811                 return runtime->oss.prev_hw_ptr_period !=
2812                                                 get_hw_ptr_period(runtime);
2813         else
2814                 return snd_pcm_capture_avail(runtime) >=
2815                                                 runtime->oss.period_frames;
2816 }
2817
2818 static __poll_t snd_pcm_oss_poll(struct file *file, poll_table * wait)
2819 {
2820         struct snd_pcm_oss_file *pcm_oss_file;
2821         __poll_t mask;
2822         struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL;
2823
2824         pcm_oss_file = file->private_data;
2825
2826         psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2827         csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2828
2829         mask = 0;
2830         if (psubstream != NULL) {
2831                 struct snd_pcm_runtime *runtime = psubstream->runtime;
2832                 poll_wait(file, &runtime->sleep, wait);
2833                 snd_pcm_stream_lock_irq(psubstream);
2834                 if (runtime->status->state != SNDRV_PCM_STATE_DRAINING &&
2835                     (runtime->status->state != SNDRV_PCM_STATE_RUNNING ||
2836                      snd_pcm_oss_playback_ready(psubstream)))
2837                         mask |= EPOLLOUT | EPOLLWRNORM;
2838                 snd_pcm_stream_unlock_irq(psubstream);
2839         }
2840         if (csubstream != NULL) {
2841                 struct snd_pcm_runtime *runtime = csubstream->runtime;
2842                 snd_pcm_state_t ostate;
2843                 poll_wait(file, &runtime->sleep, wait);
2844                 snd_pcm_stream_lock_irq(csubstream);
2845                 if ((ostate = runtime->status->state) != SNDRV_PCM_STATE_RUNNING ||
2846                     snd_pcm_oss_capture_ready(csubstream))
2847                         mask |= EPOLLIN | EPOLLRDNORM;
2848                 snd_pcm_stream_unlock_irq(csubstream);
2849                 if (ostate != SNDRV_PCM_STATE_RUNNING && runtime->oss.trigger) {
2850                         struct snd_pcm_oss_file ofile;
2851                         memset(&ofile, 0, sizeof(ofile));
2852                         ofile.streams[SNDRV_PCM_STREAM_CAPTURE] = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2853                         runtime->oss.trigger = 0;
2854                         snd_pcm_oss_set_trigger(&ofile, PCM_ENABLE_INPUT);
2855                 }
2856         }
2857
2858         return mask;
2859 }
2860
2861 static int snd_pcm_oss_mmap(struct file *file, struct vm_area_struct *area)
2862 {
2863         struct snd_pcm_oss_file *pcm_oss_file;
2864         struct snd_pcm_substream *substream = NULL;
2865         struct snd_pcm_runtime *runtime;
2866         int err;
2867
2868 #ifdef OSS_DEBUG
2869         pr_debug("pcm_oss: mmap begin\n");
2870 #endif
2871         pcm_oss_file = file->private_data;
2872         switch ((area->vm_flags & (VM_READ | VM_WRITE))) {
2873         case VM_READ | VM_WRITE:
2874                 substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2875                 if (substream)
2876                         break;
2877                 /* Fall through */
2878         case VM_READ:
2879                 substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE];
2880                 break;
2881         case VM_WRITE:
2882                 substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK];
2883                 break;
2884         default:
2885                 return -EINVAL;
2886         }
2887         /* set VM_READ access as well to fix memset() routines that do
2888            reads before writes (to improve performance) */
2889         area->vm_flags |= VM_READ;
2890         if (substream == NULL)
2891                 return -ENXIO;
2892         runtime = substream->runtime;
2893         if (!(runtime->info & SNDRV_PCM_INFO_MMAP_VALID))
2894                 return -EIO;
2895         if (runtime->info & SNDRV_PCM_INFO_INTERLEAVED)
2896                 runtime->access = SNDRV_PCM_ACCESS_MMAP_INTERLEAVED;
2897         else
2898                 return -EIO;
2899
2900         if (runtime->oss.params) {
2901                 /* use mutex_trylock() for params_lock for avoiding a deadlock
2902                  * between mmap_sem and params_lock taken by
2903                  * copy_from/to_user() in snd_pcm_oss_write/read()
2904                  */
2905                 err = snd_pcm_oss_change_params(substream, true);
2906                 if (err < 0)
2907                         return err;
2908         }
2909 #ifdef CONFIG_SND_PCM_OSS_PLUGINS
2910         if (runtime->oss.plugin_first != NULL)
2911                 return -EIO;
2912 #endif
2913
2914         if (area->vm_pgoff != 0)
2915                 return -EINVAL;
2916
2917         err = snd_pcm_mmap_data(substream, file, area);
2918         if (err < 0)
2919                 return err;
2920         runtime->oss.mmap_bytes = area->vm_end - area->vm_start;
2921         runtime->silence_threshold = 0;
2922         runtime->silence_size = 0;
2923 #ifdef OSS_DEBUG
2924         pr_debug("pcm_oss: mmap ok, bytes = 0x%x\n",
2925                runtime->oss.mmap_bytes);
2926 #endif
2927         /* In mmap mode we never stop */
2928         runtime->stop_threshold = runtime->boundary;
2929
2930         return 0;
2931 }
2932
2933 #ifdef CONFIG_SND_VERBOSE_PROCFS
2934 /*
2935  *  /proc interface
2936  */
2937
2938 static void snd_pcm_oss_proc_read(struct snd_info_entry *entry,
2939                                   struct snd_info_buffer *buffer)
2940 {
2941         struct snd_pcm_str *pstr = entry->private_data;
2942         struct snd_pcm_oss_setup *setup = pstr->oss.setup_list;
2943         mutex_lock(&pstr->oss.setup_mutex);
2944         while (setup) {
2945                 snd_iprintf(buffer, "%s %u %u%s%s%s%s%s%s\n",
2946                             setup->task_name,
2947                             setup->periods,
2948                             setup->period_size,
2949                             setup->disable ? " disable" : "",
2950                             setup->direct ? " direct" : "",
2951                             setup->block ? " block" : "",
2952                             setup->nonblock ? " non-block" : "",
2953                             setup->partialfrag ? " partial-frag" : "",
2954                             setup->nosilence ? " no-silence" : "");
2955                 setup = setup->next;
2956         }
2957         mutex_unlock(&pstr->oss.setup_mutex);
2958 }
2959
2960 static void snd_pcm_oss_proc_free_setup_list(struct snd_pcm_str * pstr)
2961 {
2962         struct snd_pcm_oss_setup *setup, *setupn;
2963
2964         for (setup = pstr->oss.setup_list, pstr->oss.setup_list = NULL;
2965              setup; setup = setupn) {
2966                 setupn = setup->next;
2967                 kfree(setup->task_name);
2968                 kfree(setup);
2969         }
2970         pstr->oss.setup_list = NULL;
2971 }
2972
2973 static void snd_pcm_oss_proc_write(struct snd_info_entry *entry,
2974                                    struct snd_info_buffer *buffer)
2975 {
2976         struct snd_pcm_str *pstr = entry->private_data;
2977         char line[128], str[32], task_name[32];
2978         const char *ptr;
2979         int idx1;
2980         struct snd_pcm_oss_setup *setup, *setup1, template;
2981
2982         while (!snd_info_get_line(buffer, line, sizeof(line))) {
2983                 mutex_lock(&pstr->oss.setup_mutex);
2984                 memset(&template, 0, sizeof(template));
2985                 ptr = snd_info_get_str(task_name, line, sizeof(task_name));
2986                 if (!strcmp(task_name, "clear") || !strcmp(task_name, "erase")) {
2987                         snd_pcm_oss_proc_free_setup_list(pstr);
2988                         mutex_unlock(&pstr->oss.setup_mutex);
2989                         continue;
2990                 }
2991                 for (setup = pstr->oss.setup_list; setup; setup = setup->next) {
2992                         if (!strcmp(setup->task_name, task_name)) {
2993                                 template = *setup;
2994                                 break;
2995                         }
2996                 }
2997                 ptr = snd_info_get_str(str, ptr, sizeof(str));
2998                 template.periods = simple_strtoul(str, NULL, 10);
2999                 ptr = snd_info_get_str(str, ptr, sizeof(str));
3000                 template.period_size = simple_strtoul(str, NULL, 10);
3001                 for (idx1 = 31; idx1 >= 0; idx1--)
3002                         if (template.period_size & (1 << idx1))
3003                                 break;
3004                 for (idx1--; idx1 >= 0; idx1--)
3005                         template.period_size &= ~(1 << idx1);
3006                 do {
3007                         ptr = snd_info_get_str(str, ptr, sizeof(str));
3008                         if (!strcmp(str, "disable")) {
3009                                 template.disable = 1;
3010                         } else if (!strcmp(str, "direct")) {
3011                                 template.direct = 1;
3012                         } else if (!strcmp(str, "block")) {
3013                                 template.block = 1;
3014                         } else if (!strcmp(str, "non-block")) {
3015                                 template.nonblock = 1;
3016                         } else if (!strcmp(str, "partial-frag")) {
3017                                 template.partialfrag = 1;
3018                         } else if (!strcmp(str, "no-silence")) {
3019                                 template.nosilence = 1;
3020                         } else if (!strcmp(str, "buggy-ptr")) {
3021                                 template.buggyptr = 1;
3022                         }
3023                 } while (*str);
3024                 if (setup == NULL) {
3025                         setup = kmalloc(sizeof(*setup), GFP_KERNEL);
3026                         if (! setup) {
3027                                 buffer->error = -ENOMEM;
3028                                 mutex_unlock(&pstr->oss.setup_mutex);
3029                                 return;
3030                         }
3031                         if (pstr->oss.setup_list == NULL)
3032                                 pstr->oss.setup_list = setup;
3033                         else {
3034                                 for (setup1 = pstr->oss.setup_list;
3035                                      setup1->next; setup1 = setup1->next);
3036                                 setup1->next = setup;
3037                         }
3038                         template.task_name = kstrdup(task_name, GFP_KERNEL);
3039                         if (! template.task_name) {
3040                                 kfree(setup);
3041                                 buffer->error = -ENOMEM;
3042                                 mutex_unlock(&pstr->oss.setup_mutex);
3043                                 return;
3044                         }
3045                 }
3046                 *setup = template;
3047                 mutex_unlock(&pstr->oss.setup_mutex);
3048         }
3049 }
3050
3051 static void snd_pcm_oss_proc_init(struct snd_pcm *pcm)
3052 {
3053         int stream;
3054         for (stream = 0; stream < 2; ++stream) {
3055                 struct snd_info_entry *entry;
3056                 struct snd_pcm_str *pstr = &pcm->streams[stream];
3057                 if (pstr->substream_count == 0)
3058                         continue;
3059                 if ((entry = snd_info_create_card_entry(pcm->card, "oss", pstr->proc_root)) != NULL) {
3060                         entry->content = SNDRV_INFO_CONTENT_TEXT;
3061                         entry->mode = S_IFREG | 0644;
3062                         entry->c.text.read = snd_pcm_oss_proc_read;
3063                         entry->c.text.write = snd_pcm_oss_proc_write;
3064                         entry->private_data = pstr;
3065                         if (snd_info_register(entry) < 0) {
3066                                 snd_info_free_entry(entry);
3067                                 entry = NULL;
3068                         }
3069                 }
3070                 pstr->oss.proc_entry = entry;
3071         }
3072 }
3073
3074 static void snd_pcm_oss_proc_done(struct snd_pcm *pcm)
3075 {
3076         int stream;
3077         for (stream = 0; stream < 2; ++stream) {
3078                 struct snd_pcm_str *pstr = &pcm->streams[stream];
3079                 snd_info_free_entry(pstr->oss.proc_entry);
3080                 pstr->oss.proc_entry = NULL;
3081                 snd_pcm_oss_proc_free_setup_list(pstr);
3082         }
3083 }
3084 #else /* !CONFIG_SND_VERBOSE_PROCFS */
3085 #define snd_pcm_oss_proc_init(pcm)
3086 #define snd_pcm_oss_proc_done(pcm)
3087 #endif /* CONFIG_SND_VERBOSE_PROCFS */
3088
3089 /*
3090  *  ENTRY functions
3091  */
3092
3093 static const struct file_operations snd_pcm_oss_f_reg =
3094 {
3095         .owner =        THIS_MODULE,
3096         .read =         snd_pcm_oss_read,
3097         .write =        snd_pcm_oss_write,
3098         .open =         snd_pcm_oss_open,
3099         .release =      snd_pcm_oss_release,
3100         .llseek =       no_llseek,
3101         .poll =         snd_pcm_oss_poll,
3102         .unlocked_ioctl =       snd_pcm_oss_ioctl,
3103         .compat_ioctl = snd_pcm_oss_ioctl_compat,
3104         .mmap =         snd_pcm_oss_mmap,
3105 };
3106
3107 static void register_oss_dsp(struct snd_pcm *pcm, int index)
3108 {
3109         if (snd_register_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM,
3110                                     pcm->card, index, &snd_pcm_oss_f_reg,
3111                                     pcm) < 0) {
3112                 pcm_err(pcm, "unable to register OSS PCM device %i:%i\n",
3113                            pcm->card->number, pcm->device);
3114         }
3115 }
3116
3117 static int snd_pcm_oss_register_minor(struct snd_pcm *pcm)
3118 {
3119         pcm->oss.reg = 0;
3120         if (dsp_map[pcm->card->number] == (int)pcm->device) {
3121                 char name[128];
3122                 int duplex;
3123                 register_oss_dsp(pcm, 0);
3124                 duplex = (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream_count > 0 &&
3125                               pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream_count &&
3126                               !(pcm->info_flags & SNDRV_PCM_INFO_HALF_DUPLEX));
3127                 sprintf(name, "%s%s", pcm->name, duplex ? " (DUPLEX)" : "");
3128 #ifdef SNDRV_OSS_INFO_DEV_AUDIO
3129                 snd_oss_info_register(SNDRV_OSS_INFO_DEV_AUDIO,
3130                                       pcm->card->number,
3131                                       name);
3132 #endif
3133                 pcm->oss.reg++;
3134                 pcm->oss.reg_mask |= 1;
3135         }
3136         if (adsp_map[pcm->card->number] == (int)pcm->device) {
3137                 register_oss_dsp(pcm, 1);
3138                 pcm->oss.reg++;
3139                 pcm->oss.reg_mask |= 2;
3140         }
3141
3142         if (pcm->oss.reg)
3143                 snd_pcm_oss_proc_init(pcm);
3144
3145         return 0;
3146 }
3147
3148 static int snd_pcm_oss_disconnect_minor(struct snd_pcm *pcm)
3149 {
3150         if (pcm->oss.reg) {
3151                 if (pcm->oss.reg_mask & 1) {
3152                         pcm->oss.reg_mask &= ~1;
3153                         snd_unregister_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM,
3154                                                   pcm->card, 0);
3155                 }
3156                 if (pcm->oss.reg_mask & 2) {
3157                         pcm->oss.reg_mask &= ~2;
3158                         snd_unregister_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM,
3159                                                   pcm->card, 1);
3160                 }
3161                 if (dsp_map[pcm->card->number] == (int)pcm->device) {
3162 #ifdef SNDRV_OSS_INFO_DEV_AUDIO
3163                         snd_oss_info_unregister(SNDRV_OSS_INFO_DEV_AUDIO, pcm->card->number);
3164 #endif
3165                 }
3166                 pcm->oss.reg = 0;
3167         }
3168         return 0;
3169 }
3170
3171 static int snd_pcm_oss_unregister_minor(struct snd_pcm *pcm)
3172 {
3173         snd_pcm_oss_disconnect_minor(pcm);
3174         snd_pcm_oss_proc_done(pcm);
3175         return 0;
3176 }
3177
3178 static struct snd_pcm_notify snd_pcm_oss_notify =
3179 {
3180         .n_register =   snd_pcm_oss_register_minor,
3181         .n_disconnect = snd_pcm_oss_disconnect_minor,
3182         .n_unregister = snd_pcm_oss_unregister_minor,
3183 };
3184
3185 static int __init alsa_pcm_oss_init(void)
3186 {
3187         int i;
3188         int err;
3189
3190         /* check device map table */
3191         for (i = 0; i < SNDRV_CARDS; i++) {
3192                 if (dsp_map[i] < 0 || dsp_map[i] >= SNDRV_PCM_DEVICES) {
3193                         pr_err("ALSA: pcm_oss: invalid dsp_map[%d] = %d\n",
3194                                    i, dsp_map[i]);
3195                         dsp_map[i] = 0;
3196                 }
3197                 if (adsp_map[i] < 0 || adsp_map[i] >= SNDRV_PCM_DEVICES) {
3198                         pr_err("ALSA: pcm_oss: invalid adsp_map[%d] = %d\n",
3199                                    i, adsp_map[i]);
3200                         adsp_map[i] = 1;
3201                 }
3202         }
3203         if ((err = snd_pcm_notify(&snd_pcm_oss_notify, 0)) < 0)
3204                 return err;
3205         return 0;
3206 }
3207
3208 static void __exit alsa_pcm_oss_exit(void)
3209 {
3210         snd_pcm_notify(&snd_pcm_oss_notify, 1);
3211 }
3212
3213 module_init(alsa_pcm_oss_init)
3214 module_exit(alsa_pcm_oss_exit)