| /* |
| * Digital Audio (PCM) abstract layer / OSS compatible |
| * Copyright (c) by Jaroslav Kysela <perex@perex.cz> |
| * |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| * |
| */ |
| |
| #if 0 |
| #define PLUGIN_DEBUG |
| #endif |
| #if 0 |
| #define OSS_DEBUG |
| #endif |
| |
| #include <linux/init.h> |
| #include <linux/slab.h> |
| #include <linux/time.h> |
| #include <linux/vmalloc.h> |
| #include <linux/module.h> |
| #include <linux/math64.h> |
| #include <linux/string.h> |
| #include <sound/core.h> |
| #include <sound/minors.h> |
| #include <sound/pcm.h> |
| #include <sound/pcm_params.h> |
| #include "pcm_plugin.h" |
| #include <sound/info.h> |
| #include <linux/soundcard.h> |
| #include <sound/initval.h> |
| #include <sound/mixer_oss.h> |
| |
| #define OSS_ALSAEMULVER _SIOR ('M', 249, int) |
| |
| static int dsp_map[SNDRV_CARDS]; |
| static int adsp_map[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS-1)] = 1}; |
| static bool nonblock_open = 1; |
| |
| MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>, Abramo Bagnara <abramo@alsa-project.org>"); |
| MODULE_DESCRIPTION("PCM OSS emulation for ALSA."); |
| MODULE_LICENSE("GPL"); |
| module_param_array(dsp_map, int, NULL, 0444); |
| MODULE_PARM_DESC(dsp_map, "PCM device number assigned to 1st OSS device."); |
| module_param_array(adsp_map, int, NULL, 0444); |
| MODULE_PARM_DESC(adsp_map, "PCM device number assigned to 2nd OSS device."); |
| module_param(nonblock_open, bool, 0644); |
| MODULE_PARM_DESC(nonblock_open, "Don't block opening busy PCM devices."); |
| MODULE_ALIAS_SNDRV_MINOR(SNDRV_MINOR_OSS_PCM); |
| MODULE_ALIAS_SNDRV_MINOR(SNDRV_MINOR_OSS_PCM1); |
| |
| static int snd_pcm_oss_get_rate(struct snd_pcm_oss_file *pcm_oss_file); |
| static int snd_pcm_oss_get_channels(struct snd_pcm_oss_file *pcm_oss_file); |
| static int snd_pcm_oss_get_format(struct snd_pcm_oss_file *pcm_oss_file); |
| |
| static inline mm_segment_t snd_enter_user(void) |
| { |
| mm_segment_t fs = get_fs(); |
| set_fs(get_ds()); |
| return fs; |
| } |
| |
| static inline void snd_leave_user(mm_segment_t fs) |
| { |
| set_fs(fs); |
| } |
| |
| /* |
| * helper functions to process hw_params |
| */ |
| static int snd_interval_refine_min(struct snd_interval *i, unsigned int min, int openmin) |
| { |
| int changed = 0; |
| if (i->min < min) { |
| i->min = min; |
| i->openmin = openmin; |
| changed = 1; |
| } else if (i->min == min && !i->openmin && openmin) { |
| i->openmin = 1; |
| changed = 1; |
| } |
| if (i->integer) { |
| if (i->openmin) { |
| i->min++; |
| i->openmin = 0; |
| } |
| } |
| if (snd_interval_checkempty(i)) { |
| snd_interval_none(i); |
| return -EINVAL; |
| } |
| return changed; |
| } |
| |
| static int snd_interval_refine_max(struct snd_interval *i, unsigned int max, int openmax) |
| { |
| int changed = 0; |
| if (i->max > max) { |
| i->max = max; |
| i->openmax = openmax; |
| changed = 1; |
| } else if (i->max == max && !i->openmax && openmax) { |
| i->openmax = 1; |
| changed = 1; |
| } |
| if (i->integer) { |
| if (i->openmax) { |
| i->max--; |
| i->openmax = 0; |
| } |
| } |
| if (snd_interval_checkempty(i)) { |
| snd_interval_none(i); |
| return -EINVAL; |
| } |
| return changed; |
| } |
| |
| static int snd_interval_refine_set(struct snd_interval *i, unsigned int val) |
| { |
| struct snd_interval t; |
| t.empty = 0; |
| t.min = t.max = val; |
| t.openmin = t.openmax = 0; |
| t.integer = 1; |
| return snd_interval_refine(i, &t); |
| } |
| |
| /** |
| * snd_pcm_hw_param_value_min |
| * @params: the hw_params instance |
| * @var: parameter to retrieve |
| * @dir: pointer to the direction (-1,0,1) or NULL |
| * |
| * Return the minimum value for field PAR. |
| */ |
| static unsigned int |
| snd_pcm_hw_param_value_min(const struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, int *dir) |
| { |
| if (hw_is_mask(var)) { |
| if (dir) |
| *dir = 0; |
| return snd_mask_min(hw_param_mask_c(params, var)); |
| } |
| if (hw_is_interval(var)) { |
| const struct snd_interval *i = hw_param_interval_c(params, var); |
| if (dir) |
| *dir = i->openmin; |
| return snd_interval_min(i); |
| } |
| return -EINVAL; |
| } |
| |
| /** |
| * snd_pcm_hw_param_value_max |
| * @params: the hw_params instance |
| * @var: parameter to retrieve |
| * @dir: pointer to the direction (-1,0,1) or NULL |
| * |
| * Return the maximum value for field PAR. |
| */ |
| static unsigned int |
| snd_pcm_hw_param_value_max(const struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, int *dir) |
| { |
| if (hw_is_mask(var)) { |
| if (dir) |
| *dir = 0; |
| return snd_mask_max(hw_param_mask_c(params, var)); |
| } |
| if (hw_is_interval(var)) { |
| const struct snd_interval *i = hw_param_interval_c(params, var); |
| if (dir) |
| *dir = - (int) i->openmax; |
| return snd_interval_max(i); |
| } |
| return -EINVAL; |
| } |
| |
| static int _snd_pcm_hw_param_mask(struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, |
| const struct snd_mask *val) |
| { |
| int changed; |
| changed = snd_mask_refine(hw_param_mask(params, var), val); |
| if (changed) { |
| params->cmask |= 1 << var; |
| params->rmask |= 1 << var; |
| } |
| return changed; |
| } |
| |
| static int snd_pcm_hw_param_mask(struct snd_pcm_substream *pcm, |
| struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, |
| const struct snd_mask *val) |
| { |
| int changed = _snd_pcm_hw_param_mask(params, var, val); |
| if (changed < 0) |
| return changed; |
| if (params->rmask) { |
| int err = snd_pcm_hw_refine(pcm, params); |
| if (err < 0) |
| return err; |
| } |
| return 0; |
| } |
| |
| static int _snd_pcm_hw_param_min(struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, unsigned int val, |
| int dir) |
| { |
| int changed; |
| int open = 0; |
| if (dir) { |
| if (dir > 0) { |
| open = 1; |
| } else if (dir < 0) { |
| if (val > 0) { |
| open = 1; |
| val--; |
| } |
| } |
| } |
| if (hw_is_mask(var)) |
| changed = snd_mask_refine_min(hw_param_mask(params, var), |
| val + !!open); |
| else if (hw_is_interval(var)) |
| changed = snd_interval_refine_min(hw_param_interval(params, var), |
| val, open); |
| else |
| return -EINVAL; |
| if (changed) { |
| params->cmask |= 1 << var; |
| params->rmask |= 1 << var; |
| } |
| return changed; |
| } |
| |
| /** |
| * snd_pcm_hw_param_min |
| * @pcm: PCM instance |
| * @params: the hw_params instance |
| * @var: parameter to retrieve |
| * @val: minimal value |
| * @dir: pointer to the direction (-1,0,1) or NULL |
| * |
| * Inside configuration space defined by PARAMS remove from PAR all |
| * values < VAL. Reduce configuration space accordingly. |
| * Return new minimum or -EINVAL if the configuration space is empty |
| */ |
| static int snd_pcm_hw_param_min(struct snd_pcm_substream *pcm, |
| struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, unsigned int val, |
| int *dir) |
| { |
| int changed = _snd_pcm_hw_param_min(params, var, val, dir ? *dir : 0); |
| if (changed < 0) |
| return changed; |
| if (params->rmask) { |
| int err = snd_pcm_hw_refine(pcm, params); |
| if (err < 0) |
| return err; |
| } |
| return snd_pcm_hw_param_value_min(params, var, dir); |
| } |
| |
| static int _snd_pcm_hw_param_max(struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, unsigned int val, |
| int dir) |
| { |
| int changed; |
| int open = 0; |
| if (dir) { |
| if (dir < 0) { |
| open = 1; |
| } else if (dir > 0) { |
| open = 1; |
| val++; |
| } |
| } |
| if (hw_is_mask(var)) { |
| if (val == 0 && open) { |
| snd_mask_none(hw_param_mask(params, var)); |
| changed = -EINVAL; |
| } else |
| changed = snd_mask_refine_max(hw_param_mask(params, var), |
| val - !!open); |
| } else if (hw_is_interval(var)) |
| changed = snd_interval_refine_max(hw_param_interval(params, var), |
| val, open); |
| else |
| return -EINVAL; |
| if (changed) { |
| params->cmask |= 1 << var; |
| params->rmask |= 1 << var; |
| } |
| return changed; |
| } |
| |
| /** |
| * snd_pcm_hw_param_max |
| * @pcm: PCM instance |
| * @params: the hw_params instance |
| * @var: parameter to retrieve |
| * @val: maximal value |
| * @dir: pointer to the direction (-1,0,1) or NULL |
| * |
| * Inside configuration space defined by PARAMS remove from PAR all |
| * values >= VAL + 1. Reduce configuration space accordingly. |
| * Return new maximum or -EINVAL if the configuration space is empty |
| */ |
| static int snd_pcm_hw_param_max(struct snd_pcm_substream *pcm, |
| struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, unsigned int val, |
| int *dir) |
| { |
| int changed = _snd_pcm_hw_param_max(params, var, val, dir ? *dir : 0); |
| if (changed < 0) |
| return changed; |
| if (params->rmask) { |
| int err = snd_pcm_hw_refine(pcm, params); |
| if (err < 0) |
| return err; |
| } |
| return snd_pcm_hw_param_value_max(params, var, dir); |
| } |
| |
| static int boundary_sub(int a, int adir, |
| int b, int bdir, |
| int *c, int *cdir) |
| { |
| adir = adir < 0 ? -1 : (adir > 0 ? 1 : 0); |
| bdir = bdir < 0 ? -1 : (bdir > 0 ? 1 : 0); |
| *c = a - b; |
| *cdir = adir - bdir; |
| if (*cdir == -2) { |
| (*c)--; |
| } else if (*cdir == 2) { |
| (*c)++; |
| } |
| return 0; |
| } |
| |
| static int boundary_lt(unsigned int a, int adir, |
| unsigned int b, int bdir) |
| { |
| if (adir < 0) { |
| a--; |
| adir = 1; |
| } else if (adir > 0) |
| adir = 1; |
| if (bdir < 0) { |
| b--; |
| bdir = 1; |
| } else if (bdir > 0) |
| bdir = 1; |
| return a < b || (a == b && adir < bdir); |
| } |
| |
| /* Return 1 if min is nearer to best than max */ |
| static int boundary_nearer(int min, int mindir, |
| int best, int bestdir, |
| int max, int maxdir) |
| { |
| int dmin, dmindir; |
| int dmax, dmaxdir; |
| boundary_sub(best, bestdir, min, mindir, &dmin, &dmindir); |
| boundary_sub(max, maxdir, best, bestdir, &dmax, &dmaxdir); |
| return boundary_lt(dmin, dmindir, dmax, dmaxdir); |
| } |
| |
| /** |
| * snd_pcm_hw_param_near |
| * @pcm: PCM instance |
| * @params: the hw_params instance |
| * @var: parameter to retrieve |
| * @best: value to set |
| * @dir: pointer to the direction (-1,0,1) or NULL |
| * |
| * Inside configuration space defined by PARAMS set PAR to the available value |
| * nearest to VAL. Reduce configuration space accordingly. |
| * This function cannot be called for SNDRV_PCM_HW_PARAM_ACCESS, |
| * SNDRV_PCM_HW_PARAM_FORMAT, SNDRV_PCM_HW_PARAM_SUBFORMAT. |
| * Return the value found. |
| */ |
| static int snd_pcm_hw_param_near(struct snd_pcm_substream *pcm, |
| struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, unsigned int best, |
| int *dir) |
| { |
| struct snd_pcm_hw_params *save = NULL; |
| int v; |
| unsigned int saved_min; |
| int last = 0; |
| int min, max; |
| int mindir, maxdir; |
| int valdir = dir ? *dir : 0; |
| /* FIXME */ |
| if (best > INT_MAX) |
| best = INT_MAX; |
| min = max = best; |
| mindir = maxdir = valdir; |
| if (maxdir > 0) |
| maxdir = 0; |
| else if (maxdir == 0) |
| maxdir = -1; |
| else { |
| maxdir = 1; |
| max--; |
| } |
| save = kmalloc(sizeof(*save), GFP_KERNEL); |
| if (save == NULL) |
| return -ENOMEM; |
| *save = *params; |
| saved_min = min; |
| min = snd_pcm_hw_param_min(pcm, params, var, min, &mindir); |
| if (min >= 0) { |
| struct snd_pcm_hw_params *params1; |
| if (max < 0) |
| goto _end; |
| if ((unsigned int)min == saved_min && mindir == valdir) |
| goto _end; |
| params1 = kmalloc(sizeof(*params1), GFP_KERNEL); |
| if (params1 == NULL) { |
| kfree(save); |
| return -ENOMEM; |
| } |
| *params1 = *save; |
| max = snd_pcm_hw_param_max(pcm, params1, var, max, &maxdir); |
| if (max < 0) { |
| kfree(params1); |
| goto _end; |
| } |
| if (boundary_nearer(max, maxdir, best, valdir, min, mindir)) { |
| *params = *params1; |
| last = 1; |
| } |
| kfree(params1); |
| } else { |
| *params = *save; |
| max = snd_pcm_hw_param_max(pcm, params, var, max, &maxdir); |
| if (max < 0) { |
| kfree(save); |
| return max; |
| } |
| last = 1; |
| } |
| _end: |
| kfree(save); |
| if (last) |
| v = snd_pcm_hw_param_last(pcm, params, var, dir); |
| else |
| v = snd_pcm_hw_param_first(pcm, params, var, dir); |
| snd_BUG_ON(v < 0); |
| return v; |
| } |
| |
| static int _snd_pcm_hw_param_set(struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, unsigned int val, |
| int dir) |
| { |
| int changed; |
| if (hw_is_mask(var)) { |
| struct snd_mask *m = hw_param_mask(params, var); |
| if (val == 0 && dir < 0) { |
| changed = -EINVAL; |
| snd_mask_none(m); |
| } else { |
| if (dir > 0) |
| val++; |
| else if (dir < 0) |
| val--; |
| changed = snd_mask_refine_set(hw_param_mask(params, var), val); |
| } |
| } else if (hw_is_interval(var)) { |
| struct snd_interval *i = hw_param_interval(params, var); |
| if (val == 0 && dir < 0) { |
| changed = -EINVAL; |
| snd_interval_none(i); |
| } else if (dir == 0) |
| changed = snd_interval_refine_set(i, val); |
| else { |
| struct snd_interval t; |
| t.openmin = 1; |
| t.openmax = 1; |
| t.empty = 0; |
| t.integer = 0; |
| if (dir < 0) { |
| t.min = val - 1; |
| t.max = val; |
| } else { |
| t.min = val; |
| t.max = val+1; |
| } |
| changed = snd_interval_refine(i, &t); |
| } |
| } else |
| return -EINVAL; |
| if (changed) { |
| params->cmask |= 1 << var; |
| params->rmask |= 1 << var; |
| } |
| return changed; |
| } |
| |
| /** |
| * snd_pcm_hw_param_set |
| * @pcm: PCM instance |
| * @params: the hw_params instance |
| * @var: parameter to retrieve |
| * @val: value to set |
| * @dir: pointer to the direction (-1,0,1) or NULL |
| * |
| * Inside configuration space defined by PARAMS remove from PAR all |
| * values != VAL. Reduce configuration space accordingly. |
| * Return VAL or -EINVAL if the configuration space is empty |
| */ |
| static int snd_pcm_hw_param_set(struct snd_pcm_substream *pcm, |
| struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var, unsigned int val, |
| int dir) |
| { |
| int changed = _snd_pcm_hw_param_set(params, var, val, dir); |
| if (changed < 0) |
| return changed; |
| if (params->rmask) { |
| int err = snd_pcm_hw_refine(pcm, params); |
| if (err < 0) |
| return err; |
| } |
| return snd_pcm_hw_param_value(params, var, NULL); |
| } |
| |
| static int _snd_pcm_hw_param_setinteger(struct snd_pcm_hw_params *params, |
| snd_pcm_hw_param_t var) |
| { |
| int changed; |
| changed = snd_interval_setinteger(hw_param_interval(params, var)); |
| if (changed) { |
| params->cmask |= 1 << var; |
| params->rmask |= 1 << var; |
| } |
| return changed; |
| } |
| |
| /* |
| * plugin |
| */ |
| |
| #ifdef CONFIG_SND_PCM_OSS_PLUGINS |
| static int snd_pcm_oss_plugin_clear(struct snd_pcm_substream *substream) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| struct snd_pcm_plugin *plugin, *next; |
| |
| plugin = runtime->oss.plugin_first; |
| while (plugin) { |
| next = plugin->next; |
| snd_pcm_plugin_free(plugin); |
| plugin = next; |
| } |
| runtime->oss.plugin_first = runtime->oss.plugin_last = NULL; |
| return 0; |
| } |
| |
| static int snd_pcm_plugin_insert(struct snd_pcm_plugin *plugin) |
| { |
| struct snd_pcm_runtime *runtime = plugin->plug->runtime; |
| plugin->next = runtime->oss.plugin_first; |
| plugin->prev = NULL; |
| if (runtime->oss.plugin_first) { |
| runtime->oss.plugin_first->prev = plugin; |
| runtime->oss.plugin_first = plugin; |
| } else { |
| runtime->oss.plugin_last = |
| runtime->oss.plugin_first = plugin; |
| } |
| return 0; |
| } |
| |
| int snd_pcm_plugin_append(struct snd_pcm_plugin *plugin) |
| { |
| struct snd_pcm_runtime *runtime = plugin->plug->runtime; |
| plugin->next = NULL; |
| plugin->prev = runtime->oss.plugin_last; |
| if (runtime->oss.plugin_last) { |
| runtime->oss.plugin_last->next = plugin; |
| runtime->oss.plugin_last = plugin; |
| } else { |
| runtime->oss.plugin_last = |
| runtime->oss.plugin_first = plugin; |
| } |
| return 0; |
| } |
| #endif /* CONFIG_SND_PCM_OSS_PLUGINS */ |
| |
| static long snd_pcm_oss_bytes(struct snd_pcm_substream *substream, long frames) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| long buffer_size = snd_pcm_lib_buffer_bytes(substream); |
| long bytes = frames_to_bytes(runtime, frames); |
| if (buffer_size == runtime->oss.buffer_bytes) |
| return bytes; |
| #if BITS_PER_LONG >= 64 |
| return runtime->oss.buffer_bytes * bytes / buffer_size; |
| #else |
| { |
| u64 bsize = (u64)runtime->oss.buffer_bytes * (u64)bytes; |
| return div_u64(bsize, buffer_size); |
| } |
| #endif |
| } |
| |
| static long snd_pcm_alsa_frames(struct snd_pcm_substream *substream, long bytes) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| long buffer_size = snd_pcm_lib_buffer_bytes(substream); |
| if (buffer_size == runtime->oss.buffer_bytes) |
| return bytes_to_frames(runtime, bytes); |
| return bytes_to_frames(runtime, (buffer_size * bytes) / runtime->oss.buffer_bytes); |
| } |
| |
| static inline |
| snd_pcm_uframes_t get_hw_ptr_period(struct snd_pcm_runtime *runtime) |
| { |
| return runtime->hw_ptr_interrupt; |
| } |
| |
| /* define extended formats in the recent OSS versions (if any) */ |
| /* linear formats */ |
| #define AFMT_S32_LE 0x00001000 |
| #define AFMT_S32_BE 0x00002000 |
| #define AFMT_S24_LE 0x00008000 |
| #define AFMT_S24_BE 0x00010000 |
| #define AFMT_S24_PACKED 0x00040000 |
| |
| /* other supported formats */ |
| #define AFMT_FLOAT 0x00004000 |
| #define AFMT_SPDIF_RAW 0x00020000 |
| |
| /* unsupported formats */ |
| #define AFMT_AC3 0x00000400 |
| #define AFMT_VORBIS 0x00000800 |
| |
| static snd_pcm_format_t snd_pcm_oss_format_from(int format) |
| { |
| switch (format) { |
| case AFMT_MU_LAW: return SNDRV_PCM_FORMAT_MU_LAW; |
| case AFMT_A_LAW: return SNDRV_PCM_FORMAT_A_LAW; |
| case AFMT_IMA_ADPCM: return SNDRV_PCM_FORMAT_IMA_ADPCM; |
| case AFMT_U8: return SNDRV_PCM_FORMAT_U8; |
| case AFMT_S16_LE: return SNDRV_PCM_FORMAT_S16_LE; |
| case AFMT_S16_BE: return SNDRV_PCM_FORMAT_S16_BE; |
| case AFMT_S8: return SNDRV_PCM_FORMAT_S8; |
| case AFMT_U16_LE: return SNDRV_PCM_FORMAT_U16_LE; |
| case AFMT_U16_BE: return SNDRV_PCM_FORMAT_U16_BE; |
| case AFMT_MPEG: return SNDRV_PCM_FORMAT_MPEG; |
| case AFMT_S32_LE: return SNDRV_PCM_FORMAT_S32_LE; |
| case AFMT_S32_BE: return SNDRV_PCM_FORMAT_S32_BE; |
| case AFMT_S24_LE: return SNDRV_PCM_FORMAT_S24_LE; |
| case AFMT_S24_BE: return SNDRV_PCM_FORMAT_S24_BE; |
| case AFMT_S24_PACKED: return SNDRV_PCM_FORMAT_S24_3LE; |
| case AFMT_FLOAT: return SNDRV_PCM_FORMAT_FLOAT; |
| case AFMT_SPDIF_RAW: return SNDRV_PCM_FORMAT_IEC958_SUBFRAME; |
| default: return SNDRV_PCM_FORMAT_U8; |
| } |
| } |
| |
| static int snd_pcm_oss_format_to(snd_pcm_format_t format) |
| { |
| switch (format) { |
| case SNDRV_PCM_FORMAT_MU_LAW: return AFMT_MU_LAW; |
| case SNDRV_PCM_FORMAT_A_LAW: return AFMT_A_LAW; |
| case SNDRV_PCM_FORMAT_IMA_ADPCM: return AFMT_IMA_ADPCM; |
| case SNDRV_PCM_FORMAT_U8: return AFMT_U8; |
| case SNDRV_PCM_FORMAT_S16_LE: return AFMT_S16_LE; |
| case SNDRV_PCM_FORMAT_S16_BE: return AFMT_S16_BE; |
| case SNDRV_PCM_FORMAT_S8: return AFMT_S8; |
| case SNDRV_PCM_FORMAT_U16_LE: return AFMT_U16_LE; |
| case SNDRV_PCM_FORMAT_U16_BE: return AFMT_U16_BE; |
| case SNDRV_PCM_FORMAT_MPEG: return AFMT_MPEG; |
| case SNDRV_PCM_FORMAT_S32_LE: return AFMT_S32_LE; |
| case SNDRV_PCM_FORMAT_S32_BE: return AFMT_S32_BE; |
| case SNDRV_PCM_FORMAT_S24_LE: return AFMT_S24_LE; |
| case SNDRV_PCM_FORMAT_S24_BE: return AFMT_S24_BE; |
| case SNDRV_PCM_FORMAT_S24_3LE: return AFMT_S24_PACKED; |
| case SNDRV_PCM_FORMAT_FLOAT: return AFMT_FLOAT; |
| case SNDRV_PCM_FORMAT_IEC958_SUBFRAME: return AFMT_SPDIF_RAW; |
| default: return -EINVAL; |
| } |
| } |
| |
| static int snd_pcm_oss_period_size(struct snd_pcm_substream *substream, |
| struct snd_pcm_hw_params *oss_params, |
| struct snd_pcm_hw_params *slave_params) |
| { |
| size_t s; |
| size_t oss_buffer_size, oss_period_size, oss_periods; |
| size_t min_period_size, max_period_size; |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| size_t oss_frame_size; |
| |
| oss_frame_size = snd_pcm_format_physical_width(params_format(oss_params)) * |
| params_channels(oss_params) / 8; |
| |
| oss_buffer_size = snd_pcm_plug_client_size(substream, |
| snd_pcm_hw_param_value_max(slave_params, SNDRV_PCM_HW_PARAM_BUFFER_SIZE, NULL)) * oss_frame_size; |
| oss_buffer_size = rounddown_pow_of_two(oss_buffer_size); |
| if (atomic_read(&substream->mmap_count)) { |
| if (oss_buffer_size > runtime->oss.mmap_bytes) |
| oss_buffer_size = runtime->oss.mmap_bytes; |
| } |
| |
| if (substream->oss.setup.period_size > 16) |
| oss_period_size = substream->oss.setup.period_size; |
| else if (runtime->oss.fragshift) { |
| oss_period_size = 1 << runtime->oss.fragshift; |
| if (oss_period_size > oss_buffer_size / 2) |
| oss_period_size = oss_buffer_size / 2; |
| } else { |
| int sd; |
| size_t bytes_per_sec = params_rate(oss_params) * snd_pcm_format_physical_width(params_format(oss_params)) * params_channels(oss_params) / 8; |
| |
| oss_period_size = oss_buffer_size; |
| do { |
| oss_period_size /= 2; |
| } while (oss_period_size > bytes_per_sec); |
| if (runtime->oss.subdivision == 0) { |
| sd = 4; |
| if (oss_period_size / sd > 4096) |
| sd *= 2; |
| if (oss_period_size / sd < 4096) |
| sd = 1; |
| } else |
| sd = runtime->oss.subdivision; |
| oss_period_size /= sd; |
| if (oss_period_size < 16) |
| oss_period_size = 16; |
| } |
| |
| min_period_size = snd_pcm_plug_client_size(substream, |
| snd_pcm_hw_param_value_min(slave_params, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, NULL)); |
| min_period_size *= oss_frame_size; |
| min_period_size = roundup_pow_of_two(min_period_size); |
| if (oss_period_size < min_period_size) |
| oss_period_size = min_period_size; |
| |
| max_period_size = snd_pcm_plug_client_size(substream, |
| snd_pcm_hw_param_value_max(slave_params, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, NULL)); |
| max_period_size *= oss_frame_size; |
| max_period_size = rounddown_pow_of_two(max_period_size); |
| if (oss_period_size > max_period_size) |
| oss_period_size = max_period_size; |
| |
| oss_periods = oss_buffer_size / oss_period_size; |
| |
| if (substream->oss.setup.periods > 1) |
| oss_periods = substream->oss.setup.periods; |
| |
| s = snd_pcm_hw_param_value_max(slave_params, SNDRV_PCM_HW_PARAM_PERIODS, NULL); |
| if (runtime->oss.maxfrags && s > runtime->oss.maxfrags) |
| s = runtime->oss.maxfrags; |
| if (oss_periods > s) |
| oss_periods = s; |
| |
| s = snd_pcm_hw_param_value_min(slave_params, SNDRV_PCM_HW_PARAM_PERIODS, NULL); |
| if (s < 2) |
| s = 2; |
| if (oss_periods < s) |
| oss_periods = s; |
| |
| while (oss_period_size * oss_periods > oss_buffer_size) |
| oss_period_size /= 2; |
| |
| if (oss_period_size < 16) |
| return -EINVAL; |
| runtime->oss.period_bytes = oss_period_size; |
| runtime->oss.period_frames = 1; |
| runtime->oss.periods = oss_periods; |
| return 0; |
| } |
| |
| static int choose_rate(struct snd_pcm_substream *substream, |
| struct snd_pcm_hw_params *params, unsigned int best_rate) |
| { |
| struct snd_interval *it; |
| struct snd_pcm_hw_params *save; |
| unsigned int rate, prev; |
| |
| save = kmalloc(sizeof(*save), GFP_KERNEL); |
| if (save == NULL) |
| return -ENOMEM; |
| *save = *params; |
| it = hw_param_interval(save, SNDRV_PCM_HW_PARAM_RATE); |
| |
| /* try multiples of the best rate */ |
| rate = best_rate; |
| for (;;) { |
| if (it->max < rate || (it->max == rate && it->openmax)) |
| break; |
| if (it->min < rate || (it->min == rate && !it->openmin)) { |
| int ret; |
| ret = snd_pcm_hw_param_set(substream, params, |
| SNDRV_PCM_HW_PARAM_RATE, |
| rate, 0); |
| if (ret == (int)rate) { |
| kfree(save); |
| return rate; |
| } |
| *params = *save; |
| } |
| prev = rate; |
| rate += best_rate; |
| if (rate <= prev) |
| break; |
| } |
| |
| /* not found, use the nearest rate */ |
| kfree(save); |
| return snd_pcm_hw_param_near(substream, params, SNDRV_PCM_HW_PARAM_RATE, best_rate, NULL); |
| } |
| |
| static int snd_pcm_oss_change_params(struct snd_pcm_substream *substream) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| struct snd_pcm_hw_params *params, *sparams; |
| struct snd_pcm_sw_params *sw_params; |
| ssize_t oss_buffer_size, oss_period_size; |
| size_t oss_frame_size; |
| int err; |
| int direct; |
| snd_pcm_format_t format, sformat; |
| int n; |
| struct snd_mask sformat_mask; |
| struct snd_mask mask; |
| |
| if (mutex_lock_interruptible(&runtime->oss.params_lock)) |
| return -EINTR; |
| sw_params = kmalloc(sizeof(*sw_params), GFP_KERNEL); |
| params = kmalloc(sizeof(*params), GFP_KERNEL); |
| sparams = kmalloc(sizeof(*sparams), GFP_KERNEL); |
| if (!sw_params || !params || !sparams) { |
| pcm_dbg(substream->pcm, "No memory\n"); |
| err = -ENOMEM; |
| goto failure; |
| } |
| |
| if (atomic_read(&substream->mmap_count)) |
| direct = 1; |
| else |
| direct = substream->oss.setup.direct; |
| |
| _snd_pcm_hw_params_any(sparams); |
| _snd_pcm_hw_param_setinteger(sparams, SNDRV_PCM_HW_PARAM_PERIODS); |
| _snd_pcm_hw_param_min(sparams, SNDRV_PCM_HW_PARAM_PERIODS, 2, 0); |
| snd_mask_none(&mask); |
| if (atomic_read(&substream->mmap_count)) |
| snd_mask_set(&mask, (__force int)SNDRV_PCM_ACCESS_MMAP_INTERLEAVED); |
| else { |
| snd_mask_set(&mask, (__force int)SNDRV_PCM_ACCESS_RW_INTERLEAVED); |
| if (!direct) |
| snd_mask_set(&mask, (__force int)SNDRV_PCM_ACCESS_RW_NONINTERLEAVED); |
| } |
| err = snd_pcm_hw_param_mask(substream, sparams, SNDRV_PCM_HW_PARAM_ACCESS, &mask); |
| if (err < 0) { |
| pcm_dbg(substream->pcm, "No usable accesses\n"); |
| err = -EINVAL; |
| goto failure; |
| } |
| choose_rate(substream, sparams, runtime->oss.rate); |
| snd_pcm_hw_param_near(substream, sparams, SNDRV_PCM_HW_PARAM_CHANNELS, runtime->oss.channels, NULL); |
| |
| format = snd_pcm_oss_format_from(runtime->oss.format); |
| |
| sformat_mask = *hw_param_mask(sparams, SNDRV_PCM_HW_PARAM_FORMAT); |
| if (direct) |
| sformat = format; |
| else |
| sformat = snd_pcm_plug_slave_format(format, &sformat_mask); |
| |
| if ((__force int)sformat < 0 || |
| !snd_mask_test(&sformat_mask, (__force int)sformat)) { |
| for (sformat = (__force snd_pcm_format_t)0; |
| (__force int)sformat <= (__force int)SNDRV_PCM_FORMAT_LAST; |
| sformat = (__force snd_pcm_format_t)((__force int)sformat + 1)) { |
| if (snd_mask_test(&sformat_mask, (__force int)sformat) && |
| snd_pcm_oss_format_to(sformat) >= 0) |
| break; |
| } |
| if ((__force int)sformat > (__force int)SNDRV_PCM_FORMAT_LAST) { |
| pcm_dbg(substream->pcm, "Cannot find a format!!!\n"); |
| err = -EINVAL; |
| goto failure; |
| } |
| } |
| err = _snd_pcm_hw_param_set(sparams, SNDRV_PCM_HW_PARAM_FORMAT, (__force int)sformat, 0); |
| if (err < 0) |
| goto failure; |
| |
| if (direct) { |
| memcpy(params, sparams, sizeof(*params)); |
| } else { |
| _snd_pcm_hw_params_any(params); |
| _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_ACCESS, |
| (__force int)SNDRV_PCM_ACCESS_RW_INTERLEAVED, 0); |
| _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_FORMAT, |
| (__force int)snd_pcm_oss_format_from(runtime->oss.format), 0); |
| _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_CHANNELS, |
| runtime->oss.channels, 0); |
| _snd_pcm_hw_param_set(params, SNDRV_PCM_HW_PARAM_RATE, |
| runtime->oss.rate, 0); |
| pdprintf("client: access = %i, format = %i, channels = %i, rate = %i\n", |
| params_access(params), params_format(params), |
| params_channels(params), params_rate(params)); |
| } |
| pdprintf("slave: access = %i, format = %i, channels = %i, rate = %i\n", |
| params_access(sparams), params_format(sparams), |
| params_channels(sparams), params_rate(sparams)); |
| |
| oss_frame_size = snd_pcm_format_physical_width(params_format(params)) * |
| params_channels(params) / 8; |
| |
| #ifdef CONFIG_SND_PCM_OSS_PLUGINS |
| snd_pcm_oss_plugin_clear(substream); |
| if (!direct) { |
| /* add necessary plugins */ |
| snd_pcm_oss_plugin_clear(substream); |
| if ((err = snd_pcm_plug_format_plugins(substream, |
| params, |
| sparams)) < 0) { |
| pcm_dbg(substream->pcm, |
| "snd_pcm_plug_format_plugins failed: %i\n", err); |
| snd_pcm_oss_plugin_clear(substream); |
| goto failure; |
| } |
| if (runtime->oss.plugin_first) { |
| struct snd_pcm_plugin *plugin; |
| if ((err = snd_pcm_plugin_build_io(substream, sparams, &plugin)) < 0) { |
| pcm_dbg(substream->pcm, |
| "snd_pcm_plugin_build_io failed: %i\n", err); |
| snd_pcm_oss_plugin_clear(substream); |
| goto failure; |
| } |
| if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { |
| err = snd_pcm_plugin_append(plugin); |
| } else { |
| err = snd_pcm_plugin_insert(plugin); |
| } |
| if (err < 0) { |
| snd_pcm_oss_plugin_clear(substream); |
| goto failure; |
| } |
| } |
| } |
| #endif |
| |
| err = snd_pcm_oss_period_size(substream, params, sparams); |
| if (err < 0) |
| goto failure; |
| |
| n = snd_pcm_plug_slave_size(substream, runtime->oss.period_bytes / oss_frame_size); |
| err = snd_pcm_hw_param_near(substream, sparams, SNDRV_PCM_HW_PARAM_PERIOD_SIZE, n, NULL); |
| if (err < 0) |
| goto failure; |
| |
| err = snd_pcm_hw_param_near(substream, sparams, SNDRV_PCM_HW_PARAM_PERIODS, |
| runtime->oss.periods, NULL); |
| if (err < 0) |
| goto failure; |
| |
| snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL); |
| |
| if ((err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_HW_PARAMS, sparams)) < 0) { |
| pcm_dbg(substream->pcm, "HW_PARAMS failed: %i\n", err); |
| goto failure; |
| } |
| |
| memset(sw_params, 0, sizeof(*sw_params)); |
| if (runtime->oss.trigger) { |
| sw_params->start_threshold = 1; |
| } else { |
| sw_params->start_threshold = runtime->boundary; |
| } |
| if (atomic_read(&substream->mmap_count) || |
| substream->stream == SNDRV_PCM_STREAM_CAPTURE) |
| sw_params->stop_threshold = runtime->boundary; |
| else |
| sw_params->stop_threshold = runtime->buffer_size; |
| sw_params->tstamp_mode = SNDRV_PCM_TSTAMP_NONE; |
| sw_params->period_step = 1; |
| sw_params->avail_min = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ? |
| 1 : runtime->period_size; |
| if (atomic_read(&substream->mmap_count) || |
| substream->oss.setup.nosilence) { |
| sw_params->silence_threshold = 0; |
| sw_params->silence_size = 0; |
| } else { |
| snd_pcm_uframes_t frames; |
| frames = runtime->period_size + 16; |
| if (frames > runtime->buffer_size) |
| frames = runtime->buffer_size; |
| sw_params->silence_threshold = frames; |
| sw_params->silence_size = frames; |
| } |
| |
| if ((err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_SW_PARAMS, sw_params)) < 0) { |
| pcm_dbg(substream->pcm, "SW_PARAMS failed: %i\n", err); |
| goto failure; |
| } |
| |
| runtime->oss.periods = params_periods(sparams); |
| oss_period_size = snd_pcm_plug_client_size(substream, params_period_size(sparams)); |
| if (oss_period_size < 0) { |
| err = -EINVAL; |
| goto failure; |
| } |
| #ifdef CONFIG_SND_PCM_OSS_PLUGINS |
| if (runtime->oss.plugin_first) { |
| err = snd_pcm_plug_alloc(substream, oss_period_size); |
| if (err < 0) |
| goto failure; |
| } |
| #endif |
| oss_period_size *= oss_frame_size; |
| |
| oss_buffer_size = oss_period_size * runtime->oss.periods; |
| if (oss_buffer_size < 0) { |
| err = -EINVAL; |
| goto failure; |
| } |
| |
| runtime->oss.period_bytes = oss_period_size; |
| runtime->oss.buffer_bytes = oss_buffer_size; |
| |
| pdprintf("oss: period bytes = %i, buffer bytes = %i\n", |
| runtime->oss.period_bytes, |
| runtime->oss.buffer_bytes); |
| pdprintf("slave: period_size = %i, buffer_size = %i\n", |
| params_period_size(sparams), |
| params_buffer_size(sparams)); |
| |
| runtime->oss.format = snd_pcm_oss_format_to(params_format(params)); |
| runtime->oss.channels = params_channels(params); |
| runtime->oss.rate = params_rate(params); |
| |
| vfree(runtime->oss.buffer); |
| runtime->oss.buffer = vmalloc(runtime->oss.period_bytes); |
| if (!runtime->oss.buffer) { |
| err = -ENOMEM; |
| goto failure; |
| } |
| |
| runtime->oss.params = 0; |
| runtime->oss.prepare = 1; |
| runtime->oss.buffer_used = 0; |
| if (runtime->dma_area) |
| snd_pcm_format_set_silence(runtime->format, runtime->dma_area, bytes_to_samples(runtime, runtime->dma_bytes)); |
| |
| runtime->oss.period_frames = snd_pcm_alsa_frames(substream, oss_period_size); |
| |
| err = 0; |
| failure: |
| kfree(sw_params); |
| kfree(params); |
| kfree(sparams); |
| mutex_unlock(&runtime->oss.params_lock); |
| return err; |
| } |
| |
| static int snd_pcm_oss_get_active_substream(struct snd_pcm_oss_file *pcm_oss_file, struct snd_pcm_substream **r_substream) |
| { |
| int idx, err; |
| struct snd_pcm_substream *asubstream = NULL, *substream; |
| |
| for (idx = 0; idx < 2; idx++) { |
| substream = pcm_oss_file->streams[idx]; |
| if (substream == NULL) |
| continue; |
| if (asubstream == NULL) |
| asubstream = substream; |
| if (substream->runtime->oss.params) { |
| err = snd_pcm_oss_change_params(substream); |
| if (err < 0) |
| return err; |
| } |
| } |
| if (!asubstream) |
| return -EIO; |
| if (r_substream) |
| *r_substream = asubstream; |
| return 0; |
| } |
| |
| static int snd_pcm_oss_prepare(struct snd_pcm_substream *substream) |
| { |
| int err; |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| |
| err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_PREPARE, NULL); |
| if (err < 0) { |
| pcm_dbg(substream->pcm, |
| "snd_pcm_oss_prepare: SNDRV_PCM_IOCTL_PREPARE failed\n"); |
| return err; |
| } |
| runtime->oss.prepare = 0; |
| runtime->oss.prev_hw_ptr_period = 0; |
| runtime->oss.period_ptr = 0; |
| runtime->oss.buffer_used = 0; |
| |
| return 0; |
| } |
| |
| static int snd_pcm_oss_make_ready(struct snd_pcm_substream *substream) |
| { |
| struct snd_pcm_runtime *runtime; |
| int err; |
| |
| if (substream == NULL) |
| return 0; |
| runtime = substream->runtime; |
| if (runtime->oss.params) { |
| err = snd_pcm_oss_change_params(substream); |
| if (err < 0) |
| return err; |
| } |
| if (runtime->oss.prepare) { |
| err = snd_pcm_oss_prepare(substream); |
| if (err < 0) |
| return err; |
| } |
| return 0; |
| } |
| |
| static int snd_pcm_oss_capture_position_fixup(struct snd_pcm_substream *substream, snd_pcm_sframes_t *delay) |
| { |
| struct snd_pcm_runtime *runtime; |
| snd_pcm_uframes_t frames; |
| int err = 0; |
| |
| while (1) { |
| err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, delay); |
| if (err < 0) |
| break; |
| runtime = substream->runtime; |
| if (*delay <= (snd_pcm_sframes_t)runtime->buffer_size) |
| break; |
| /* in case of overrun, skip whole periods like OSS/Linux driver does */ |
| /* until avail(delay) <= buffer_size */ |
| frames = (*delay - runtime->buffer_size) + runtime->period_size - 1; |
| frames /= runtime->period_size; |
| frames *= runtime->period_size; |
| err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_FORWARD, &frames); |
| if (err < 0) |
| break; |
| } |
| return err; |
| } |
| |
| snd_pcm_sframes_t snd_pcm_oss_write3(struct snd_pcm_substream *substream, const char *ptr, snd_pcm_uframes_t frames, int in_kernel) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| int ret; |
| while (1) { |
| if (runtime->status->state == SNDRV_PCM_STATE_XRUN || |
| runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) { |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, |
| "pcm_oss: write: recovering from %s\n", |
| runtime->status->state == SNDRV_PCM_STATE_XRUN ? |
| "XRUN" : "SUSPEND"); |
| #endif |
| ret = snd_pcm_oss_prepare(substream); |
| if (ret < 0) |
| break; |
| } |
| if (in_kernel) { |
| mm_segment_t fs; |
| fs = snd_enter_user(); |
| ret = snd_pcm_lib_write(substream, (void __force __user *)ptr, frames); |
| snd_leave_user(fs); |
| } else { |
| ret = snd_pcm_lib_write(substream, (void __force __user *)ptr, frames); |
| } |
| if (ret != -EPIPE && ret != -ESTRPIPE) |
| break; |
| /* test, if we can't store new data, because the stream */ |
| /* has not been started */ |
| if (runtime->status->state == SNDRV_PCM_STATE_PREPARED) |
| return -EAGAIN; |
| } |
| return ret; |
| } |
| |
| snd_pcm_sframes_t snd_pcm_oss_read3(struct snd_pcm_substream *substream, char *ptr, snd_pcm_uframes_t frames, int in_kernel) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| snd_pcm_sframes_t delay; |
| int ret; |
| while (1) { |
| if (runtime->status->state == SNDRV_PCM_STATE_XRUN || |
| runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) { |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, |
| "pcm_oss: read: recovering from %s\n", |
| runtime->status->state == SNDRV_PCM_STATE_XRUN ? |
| "XRUN" : "SUSPEND"); |
| #endif |
| ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL); |
| if (ret < 0) |
| break; |
| } else if (runtime->status->state == SNDRV_PCM_STATE_SETUP) { |
| ret = snd_pcm_oss_prepare(substream); |
| if (ret < 0) |
| break; |
| } |
| ret = snd_pcm_oss_capture_position_fixup(substream, &delay); |
| if (ret < 0) |
| break; |
| if (in_kernel) { |
| mm_segment_t fs; |
| fs = snd_enter_user(); |
| ret = snd_pcm_lib_read(substream, (void __force __user *)ptr, frames); |
| snd_leave_user(fs); |
| } else { |
| ret = snd_pcm_lib_read(substream, (void __force __user *)ptr, frames); |
| } |
| if (ret == -EPIPE) { |
| if (runtime->status->state == SNDRV_PCM_STATE_DRAINING) { |
| ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL); |
| if (ret < 0) |
| break; |
| } |
| continue; |
| } |
| if (ret != -ESTRPIPE) |
| break; |
| } |
| return ret; |
| } |
| |
| snd_pcm_sframes_t snd_pcm_oss_writev3(struct snd_pcm_substream *substream, void **bufs, snd_pcm_uframes_t frames, int in_kernel) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| int ret; |
| while (1) { |
| if (runtime->status->state == SNDRV_PCM_STATE_XRUN || |
| runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) { |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, |
| "pcm_oss: writev: recovering from %s\n", |
| runtime->status->state == SNDRV_PCM_STATE_XRUN ? |
| "XRUN" : "SUSPEND"); |
| #endif |
| ret = snd_pcm_oss_prepare(substream); |
| if (ret < 0) |
| break; |
| } |
| if (in_kernel) { |
| mm_segment_t fs; |
| fs = snd_enter_user(); |
| ret = snd_pcm_lib_writev(substream, (void __user **)bufs, frames); |
| snd_leave_user(fs); |
| } else { |
| ret = snd_pcm_lib_writev(substream, (void __user **)bufs, frames); |
| } |
| if (ret != -EPIPE && ret != -ESTRPIPE) |
| break; |
| |
| /* test, if we can't store new data, because the stream */ |
| /* has not been started */ |
| if (runtime->status->state == SNDRV_PCM_STATE_PREPARED) |
| return -EAGAIN; |
| } |
| return ret; |
| } |
| |
| snd_pcm_sframes_t snd_pcm_oss_readv3(struct snd_pcm_substream *substream, void **bufs, snd_pcm_uframes_t frames, int in_kernel) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| int ret; |
| while (1) { |
| if (runtime->status->state == SNDRV_PCM_STATE_XRUN || |
| runtime->status->state == SNDRV_PCM_STATE_SUSPENDED) { |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, |
| "pcm_oss: readv: recovering from %s\n", |
| runtime->status->state == SNDRV_PCM_STATE_XRUN ? |
| "XRUN" : "SUSPEND"); |
| #endif |
| ret = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL); |
| if (ret < 0) |
| break; |
| } else if (runtime->status->state == SNDRV_PCM_STATE_SETUP) { |
| ret = snd_pcm_oss_prepare(substream); |
| if (ret < 0) |
| break; |
| } |
| if (in_kernel) { |
| mm_segment_t fs; |
| fs = snd_enter_user(); |
| ret = snd_pcm_lib_readv(substream, (void __user **)bufs, frames); |
| snd_leave_user(fs); |
| } else { |
| ret = snd_pcm_lib_readv(substream, (void __user **)bufs, frames); |
| } |
| if (ret != -EPIPE && ret != -ESTRPIPE) |
| break; |
| } |
| return ret; |
| } |
| |
| static ssize_t snd_pcm_oss_write2(struct snd_pcm_substream *substream, const char *buf, size_t bytes, int in_kernel) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| snd_pcm_sframes_t frames, frames1; |
| #ifdef CONFIG_SND_PCM_OSS_PLUGINS |
| if (runtime->oss.plugin_first) { |
| struct snd_pcm_plugin_channel *channels; |
| size_t oss_frame_bytes = (runtime->oss.plugin_first->src_width * runtime->oss.plugin_first->src_format.channels) / 8; |
| if (!in_kernel) { |
| if (copy_from_user(runtime->oss.buffer, (const char __force __user *)buf, bytes)) |
| return -EFAULT; |
| buf = runtime->oss.buffer; |
| } |
| frames = bytes / oss_frame_bytes; |
| frames1 = snd_pcm_plug_client_channels_buf(substream, (char *)buf, frames, &channels); |
| if (frames1 < 0) |
| return frames1; |
| frames1 = snd_pcm_plug_write_transfer(substream, channels, frames1); |
| if (frames1 <= 0) |
| return frames1; |
| bytes = frames1 * oss_frame_bytes; |
| } else |
| #endif |
| { |
| frames = bytes_to_frames(runtime, bytes); |
| frames1 = snd_pcm_oss_write3(substream, buf, frames, in_kernel); |
| if (frames1 <= 0) |
| return frames1; |
| bytes = frames_to_bytes(runtime, frames1); |
| } |
| return bytes; |
| } |
| |
| static ssize_t snd_pcm_oss_write1(struct snd_pcm_substream *substream, const char __user *buf, size_t bytes) |
| { |
| size_t xfer = 0; |
| ssize_t tmp; |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| |
| if (atomic_read(&substream->mmap_count)) |
| return -ENXIO; |
| |
| if ((tmp = snd_pcm_oss_make_ready(substream)) < 0) |
| return tmp; |
| mutex_lock(&runtime->oss.params_lock); |
| while (bytes > 0) { |
| if (bytes < runtime->oss.period_bytes || runtime->oss.buffer_used > 0) { |
| tmp = bytes; |
| if (tmp + runtime->oss.buffer_used > runtime->oss.period_bytes) |
| tmp = runtime->oss.period_bytes - runtime->oss.buffer_used; |
| if (tmp > 0) { |
| if (copy_from_user(runtime->oss.buffer + runtime->oss.buffer_used, buf, tmp)) { |
| tmp = -EFAULT; |
| goto err; |
| } |
| } |
| runtime->oss.buffer_used += tmp; |
| buf += tmp; |
| bytes -= tmp; |
| xfer += tmp; |
| if (substream->oss.setup.partialfrag || |
| runtime->oss.buffer_used == runtime->oss.period_bytes) { |
| tmp = snd_pcm_oss_write2(substream, runtime->oss.buffer + runtime->oss.period_ptr, |
| runtime->oss.buffer_used - runtime->oss.period_ptr, 1); |
| if (tmp <= 0) |
| goto err; |
| runtime->oss.bytes += tmp; |
| runtime->oss.period_ptr += tmp; |
| runtime->oss.period_ptr %= runtime->oss.period_bytes; |
| if (runtime->oss.period_ptr == 0 || |
| runtime->oss.period_ptr == runtime->oss.buffer_used) |
| runtime->oss.buffer_used = 0; |
| else if ((substream->f_flags & O_NONBLOCK) != 0) { |
| tmp = -EAGAIN; |
| goto err; |
| } |
| } |
| } else { |
| tmp = snd_pcm_oss_write2(substream, |
| (const char __force *)buf, |
| runtime->oss.period_bytes, 0); |
| if (tmp <= 0) |
| goto err; |
| runtime->oss.bytes += tmp; |
| buf += tmp; |
| bytes -= tmp; |
| xfer += tmp; |
| if ((substream->f_flags & O_NONBLOCK) != 0 && |
| tmp != runtime->oss.period_bytes) |
| break; |
| } |
| } |
| mutex_unlock(&runtime->oss.params_lock); |
| return xfer; |
| |
| err: |
| mutex_unlock(&runtime->oss.params_lock); |
| return xfer > 0 ? (snd_pcm_sframes_t)xfer : tmp; |
| } |
| |
| static ssize_t snd_pcm_oss_read2(struct snd_pcm_substream *substream, char *buf, size_t bytes, int in_kernel) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| snd_pcm_sframes_t frames, frames1; |
| #ifdef CONFIG_SND_PCM_OSS_PLUGINS |
| char __user *final_dst = (char __force __user *)buf; |
| if (runtime->oss.plugin_first) { |
| struct snd_pcm_plugin_channel *channels; |
| size_t oss_frame_bytes = (runtime->oss.plugin_last->dst_width * runtime->oss.plugin_last->dst_format.channels) / 8; |
| if (!in_kernel) |
| buf = runtime->oss.buffer; |
| frames = bytes / oss_frame_bytes; |
| frames1 = snd_pcm_plug_client_channels_buf(substream, buf, frames, &channels); |
| if (frames1 < 0) |
| return frames1; |
| frames1 = snd_pcm_plug_read_transfer(substream, channels, frames1); |
| if (frames1 <= 0) |
| return frames1; |
| bytes = frames1 * oss_frame_bytes; |
| if (!in_kernel && copy_to_user(final_dst, buf, bytes)) |
| return -EFAULT; |
| } else |
| #endif |
| { |
| frames = bytes_to_frames(runtime, bytes); |
| frames1 = snd_pcm_oss_read3(substream, buf, frames, in_kernel); |
| if (frames1 <= 0) |
| return frames1; |
| bytes = frames_to_bytes(runtime, frames1); |
| } |
| return bytes; |
| } |
| |
| static ssize_t snd_pcm_oss_read1(struct snd_pcm_substream *substream, char __user *buf, size_t bytes) |
| { |
| size_t xfer = 0; |
| ssize_t tmp; |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| |
| if (atomic_read(&substream->mmap_count)) |
| return -ENXIO; |
| |
| if ((tmp = snd_pcm_oss_make_ready(substream)) < 0) |
| return tmp; |
| mutex_lock(&runtime->oss.params_lock); |
| while (bytes > 0) { |
| if (bytes < runtime->oss.period_bytes || runtime->oss.buffer_used > 0) { |
| if (runtime->oss.buffer_used == 0) { |
| tmp = snd_pcm_oss_read2(substream, runtime->oss.buffer, runtime->oss.period_bytes, 1); |
| if (tmp <= 0) |
| goto err; |
| runtime->oss.bytes += tmp; |
| runtime->oss.period_ptr = tmp; |
| runtime->oss.buffer_used = tmp; |
| } |
| tmp = bytes; |
| if ((size_t) tmp > runtime->oss.buffer_used) |
| tmp = runtime->oss.buffer_used; |
| if (copy_to_user(buf, runtime->oss.buffer + (runtime->oss.period_ptr - runtime->oss.buffer_used), tmp)) { |
| tmp = -EFAULT; |
| goto err; |
| } |
| buf += tmp; |
| bytes -= tmp; |
| xfer += tmp; |
| runtime->oss.buffer_used -= tmp; |
| } else { |
| tmp = snd_pcm_oss_read2(substream, (char __force *)buf, |
| runtime->oss.period_bytes, 0); |
| if (tmp <= 0) |
| goto err; |
| runtime->oss.bytes += tmp; |
| buf += tmp; |
| bytes -= tmp; |
| xfer += tmp; |
| } |
| } |
| mutex_unlock(&runtime->oss.params_lock); |
| return xfer; |
| |
| err: |
| mutex_unlock(&runtime->oss.params_lock); |
| return xfer > 0 ? (snd_pcm_sframes_t)xfer : tmp; |
| } |
| |
| static int snd_pcm_oss_reset(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *substream; |
| struct snd_pcm_runtime *runtime; |
| int i; |
| |
| for (i = 0; i < 2; i++) { |
| substream = pcm_oss_file->streams[i]; |
| if (!substream) |
| continue; |
| runtime = substream->runtime; |
| snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL); |
| runtime->oss.prepare = 1; |
| runtime->oss.buffer_used = 0; |
| runtime->oss.prev_hw_ptr_period = 0; |
| runtime->oss.period_ptr = 0; |
| } |
| return 0; |
| } |
| |
| static int snd_pcm_oss_post(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *substream; |
| int err; |
| |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| if (substream != NULL) { |
| if ((err = snd_pcm_oss_make_ready(substream)) < 0) |
| return err; |
| snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_START, NULL); |
| } |
| /* note: all errors from the start action are ignored */ |
| /* OSS apps do not know, how to handle them */ |
| return 0; |
| } |
| |
| static int snd_pcm_oss_sync1(struct snd_pcm_substream *substream, size_t size) |
| { |
| struct snd_pcm_runtime *runtime; |
| ssize_t result = 0; |
| snd_pcm_state_t state; |
| long res; |
| wait_queue_t wait; |
| |
| runtime = substream->runtime; |
| init_waitqueue_entry(&wait, current); |
| add_wait_queue(&runtime->sleep, &wait); |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, "sync1: size = %li\n", size); |
| #endif |
| while (1) { |
| result = snd_pcm_oss_write2(substream, runtime->oss.buffer, size, 1); |
| if (result > 0) { |
| runtime->oss.buffer_used = 0; |
| result = 0; |
| break; |
| } |
| if (result != 0 && result != -EAGAIN) |
| break; |
| result = 0; |
| set_current_state(TASK_INTERRUPTIBLE); |
| snd_pcm_stream_lock_irq(substream); |
| state = runtime->status->state; |
| snd_pcm_stream_unlock_irq(substream); |
| if (state != SNDRV_PCM_STATE_RUNNING) { |
| set_current_state(TASK_RUNNING); |
| break; |
| } |
| res = schedule_timeout(10 * HZ); |
| if (signal_pending(current)) { |
| result = -ERESTARTSYS; |
| break; |
| } |
| if (res == 0) { |
| pcm_err(substream->pcm, |
| "OSS sync error - DMA timeout\n"); |
| result = -EIO; |
| break; |
| } |
| } |
| remove_wait_queue(&runtime->sleep, &wait); |
| return result; |
| } |
| |
| static int snd_pcm_oss_sync(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| int err = 0; |
| unsigned int saved_f_flags; |
| struct snd_pcm_substream *substream; |
| struct snd_pcm_runtime *runtime; |
| snd_pcm_format_t format; |
| unsigned long width; |
| size_t size; |
| |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| if (substream != NULL) { |
| runtime = substream->runtime; |
| if (atomic_read(&substream->mmap_count)) |
| goto __direct; |
| if ((err = snd_pcm_oss_make_ready(substream)) < 0) |
| return err; |
| format = snd_pcm_oss_format_from(runtime->oss.format); |
| width = snd_pcm_format_physical_width(format); |
| mutex_lock(&runtime->oss.params_lock); |
| if (runtime->oss.buffer_used > 0) { |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, "sync: buffer_used\n"); |
| #endif |
| size = (8 * (runtime->oss.period_bytes - runtime->oss.buffer_used) + 7) / width; |
| snd_pcm_format_set_silence(format, |
| runtime->oss.buffer + runtime->oss.buffer_used, |
| size); |
| err = snd_pcm_oss_sync1(substream, runtime->oss.period_bytes); |
| if (err < 0) { |
| mutex_unlock(&runtime->oss.params_lock); |
| return err; |
| } |
| } else if (runtime->oss.period_ptr > 0) { |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, "sync: period_ptr\n"); |
| #endif |
| size = runtime->oss.period_bytes - runtime->oss.period_ptr; |
| snd_pcm_format_set_silence(format, |
| runtime->oss.buffer, |
| size * 8 / width); |
| err = snd_pcm_oss_sync1(substream, size); |
| if (err < 0) { |
| mutex_unlock(&runtime->oss.params_lock); |
| return err; |
| } |
| } |
| /* |
| * The ALSA's period might be a bit large than OSS one. |
| * Fill the remain portion of ALSA period with zeros. |
| */ |
| size = runtime->control->appl_ptr % runtime->period_size; |
| if (size > 0) { |
| size = runtime->period_size - size; |
| if (runtime->access == SNDRV_PCM_ACCESS_RW_INTERLEAVED) { |
| size = (runtime->frame_bits * size) / 8; |
| while (size > 0) { |
| mm_segment_t fs; |
| size_t size1 = size < runtime->oss.period_bytes ? size : runtime->oss.period_bytes; |
| size -= size1; |
| size1 *= 8; |
| size1 /= runtime->sample_bits; |
| snd_pcm_format_set_silence(runtime->format, |
| runtime->oss.buffer, |
| size1); |
| size1 /= runtime->channels; /* frames */ |
| fs = snd_enter_user(); |
| snd_pcm_lib_write(substream, (void __force __user *)runtime->oss.buffer, size1); |
| snd_leave_user(fs); |
| } |
| } else if (runtime->access == SNDRV_PCM_ACCESS_RW_NONINTERLEAVED) { |
| void __user *buffers[runtime->channels]; |
| memset(buffers, 0, runtime->channels * sizeof(void *)); |
| snd_pcm_lib_writev(substream, buffers, size); |
| } |
| } |
| mutex_unlock(&runtime->oss.params_lock); |
| /* |
| * finish sync: drain the buffer |
| */ |
| __direct: |
| saved_f_flags = substream->f_flags; |
| substream->f_flags &= ~O_NONBLOCK; |
| err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DRAIN, NULL); |
| substream->f_flags = saved_f_flags; |
| if (err < 0) |
| return err; |
| runtime->oss.prepare = 1; |
| } |
| |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE]; |
| if (substream != NULL) { |
| if ((err = snd_pcm_oss_make_ready(substream)) < 0) |
| return err; |
| runtime = substream->runtime; |
| err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DROP, NULL); |
| if (err < 0) |
| return err; |
| runtime->oss.buffer_used = 0; |
| runtime->oss.prepare = 1; |
| } |
| return 0; |
| } |
| |
| static int snd_pcm_oss_set_rate(struct snd_pcm_oss_file *pcm_oss_file, int rate) |
| { |
| int idx; |
| |
| for (idx = 1; idx >= 0; --idx) { |
| struct snd_pcm_substream *substream = pcm_oss_file->streams[idx]; |
| struct snd_pcm_runtime *runtime; |
| if (substream == NULL) |
| continue; |
| runtime = substream->runtime; |
| if (rate < 1000) |
| rate = 1000; |
| else if (rate > 192000) |
| rate = 192000; |
| if (runtime->oss.rate != rate) { |
| runtime->oss.params = 1; |
| runtime->oss.rate = rate; |
| } |
| } |
| return snd_pcm_oss_get_rate(pcm_oss_file); |
| } |
| |
| static int snd_pcm_oss_get_rate(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *substream; |
| int err; |
| |
| if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0) |
| return err; |
| return substream->runtime->oss.rate; |
| } |
| |
| static int snd_pcm_oss_set_channels(struct snd_pcm_oss_file *pcm_oss_file, unsigned int channels) |
| { |
| int idx; |
| if (channels < 1) |
| channels = 1; |
| if (channels > 128) |
| return -EINVAL; |
| for (idx = 1; idx >= 0; --idx) { |
| struct snd_pcm_substream *substream = pcm_oss_file->streams[idx]; |
| struct snd_pcm_runtime *runtime; |
| if (substream == NULL) |
| continue; |
| runtime = substream->runtime; |
| if (runtime->oss.channels != channels) { |
| runtime->oss.params = 1; |
| runtime->oss.channels = channels; |
| } |
| } |
| return snd_pcm_oss_get_channels(pcm_oss_file); |
| } |
| |
| static int snd_pcm_oss_get_channels(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *substream; |
| int err; |
| |
| if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0) |
| return err; |
| return substream->runtime->oss.channels; |
| } |
| |
| static int snd_pcm_oss_get_block_size(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *substream; |
| int err; |
| |
| if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0) |
| return err; |
| return substream->runtime->oss.period_bytes; |
| } |
| |
| static int snd_pcm_oss_get_formats(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *substream; |
| int err; |
| int direct; |
| struct snd_pcm_hw_params *params; |
| unsigned int formats = 0; |
| struct snd_mask format_mask; |
| int fmt; |
| |
| if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0) |
| return err; |
| if (atomic_read(&substream->mmap_count)) |
| direct = 1; |
| else |
| direct = substream->oss.setup.direct; |
| if (!direct) |
| return AFMT_MU_LAW | AFMT_U8 | |
| AFMT_S16_LE | AFMT_S16_BE | |
| AFMT_S8 | AFMT_U16_LE | |
| AFMT_U16_BE | |
| AFMT_S32_LE | AFMT_S32_BE | |
| AFMT_S24_LE | AFMT_S24_BE | |
| AFMT_S24_PACKED; |
| params = kmalloc(sizeof(*params), GFP_KERNEL); |
| if (!params) |
| return -ENOMEM; |
| _snd_pcm_hw_params_any(params); |
| err = snd_pcm_hw_refine(substream, params); |
| format_mask = *hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT); |
| kfree(params); |
| if (err < 0) |
| return err; |
| for (fmt = 0; fmt < 32; ++fmt) { |
| if (snd_mask_test(&format_mask, fmt)) { |
| int f = snd_pcm_oss_format_to(fmt); |
| if (f >= 0) |
| formats |= f; |
| } |
| } |
| return formats; |
| } |
| |
| static int snd_pcm_oss_set_format(struct snd_pcm_oss_file *pcm_oss_file, int format) |
| { |
| int formats, idx; |
| |
| if (format != AFMT_QUERY) { |
| formats = snd_pcm_oss_get_formats(pcm_oss_file); |
| if (formats < 0) |
| return formats; |
| if (!(formats & format)) |
| format = AFMT_U8; |
| for (idx = 1; idx >= 0; --idx) { |
| struct snd_pcm_substream *substream = pcm_oss_file->streams[idx]; |
| struct snd_pcm_runtime *runtime; |
| if (substream == NULL) |
| continue; |
| runtime = substream->runtime; |
| if (runtime->oss.format != format) { |
| runtime->oss.params = 1; |
| runtime->oss.format = format; |
| } |
| } |
| } |
| return snd_pcm_oss_get_format(pcm_oss_file); |
| } |
| |
| static int snd_pcm_oss_get_format(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *substream; |
| int err; |
| |
| if ((err = snd_pcm_oss_get_active_substream(pcm_oss_file, &substream)) < 0) |
| return err; |
| return substream->runtime->oss.format; |
| } |
| |
| static int snd_pcm_oss_set_subdivide1(struct snd_pcm_substream *substream, int subdivide) |
| { |
| struct snd_pcm_runtime *runtime; |
| |
| if (substream == NULL) |
| return 0; |
| runtime = substream->runtime; |
| if (subdivide == 0) { |
| subdivide = runtime->oss.subdivision; |
| if (subdivide == 0) |
| subdivide = 1; |
| return subdivide; |
| } |
| if (runtime->oss.subdivision || runtime->oss.fragshift) |
| return -EINVAL; |
| if (subdivide != 1 && subdivide != 2 && subdivide != 4 && |
| subdivide != 8 && subdivide != 16) |
| return -EINVAL; |
| runtime->oss.subdivision = subdivide; |
| runtime->oss.params = 1; |
| return subdivide; |
| } |
| |
| static int snd_pcm_oss_set_subdivide(struct snd_pcm_oss_file *pcm_oss_file, int subdivide) |
| { |
| int err = -EINVAL, idx; |
| |
| for (idx = 1; idx >= 0; --idx) { |
| struct snd_pcm_substream *substream = pcm_oss_file->streams[idx]; |
| if (substream == NULL) |
| continue; |
| if ((err = snd_pcm_oss_set_subdivide1(substream, subdivide)) < 0) |
| return err; |
| } |
| return err; |
| } |
| |
| static int snd_pcm_oss_set_fragment1(struct snd_pcm_substream *substream, unsigned int val) |
| { |
| struct snd_pcm_runtime *runtime; |
| |
| if (substream == NULL) |
| return 0; |
| runtime = substream->runtime; |
| if (runtime->oss.subdivision || runtime->oss.fragshift) |
| return -EINVAL; |
| runtime->oss.fragshift = val & 0xffff; |
| runtime->oss.maxfrags = (val >> 16) & 0xffff; |
| if (runtime->oss.fragshift < 4) /* < 16 */ |
| runtime->oss.fragshift = 4; |
| if (runtime->oss.maxfrags < 2) |
| runtime->oss.maxfrags = 2; |
| runtime->oss.params = 1; |
| return 0; |
| } |
| |
| static int snd_pcm_oss_set_fragment(struct snd_pcm_oss_file *pcm_oss_file, unsigned int val) |
| { |
| int err = -EINVAL, idx; |
| |
| for (idx = 1; idx >= 0; --idx) { |
| struct snd_pcm_substream *substream = pcm_oss_file->streams[idx]; |
| if (substream == NULL) |
| continue; |
| if ((err = snd_pcm_oss_set_fragment1(substream, val)) < 0) |
| return err; |
| } |
| return err; |
| } |
| |
| static int snd_pcm_oss_nonblock(struct file * file) |
| { |
| spin_lock(&file->f_lock); |
| file->f_flags |= O_NONBLOCK; |
| spin_unlock(&file->f_lock); |
| return 0; |
| } |
| |
| static int snd_pcm_oss_get_caps1(struct snd_pcm_substream *substream, int res) |
| { |
| |
| if (substream == NULL) { |
| res &= ~DSP_CAP_DUPLEX; |
| return res; |
| } |
| #ifdef DSP_CAP_MULTI |
| if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
| if (substream->pstr->substream_count > 1) |
| res |= DSP_CAP_MULTI; |
| #endif |
| /* DSP_CAP_REALTIME is set all times: */ |
| /* all ALSA drivers can return actual pointer in ring buffer */ |
| #if defined(DSP_CAP_REALTIME) && 0 |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| if (runtime->info & (SNDRV_PCM_INFO_BLOCK_TRANSFER|SNDRV_PCM_INFO_BATCH)) |
| res &= ~DSP_CAP_REALTIME; |
| } |
| #endif |
| return res; |
| } |
| |
| static int snd_pcm_oss_get_caps(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| int result, idx; |
| |
| result = DSP_CAP_TRIGGER | DSP_CAP_MMAP | DSP_CAP_DUPLEX | DSP_CAP_REALTIME; |
| for (idx = 0; idx < 2; idx++) { |
| struct snd_pcm_substream *substream = pcm_oss_file->streams[idx]; |
| result = snd_pcm_oss_get_caps1(substream, result); |
| } |
| result |= 0x0001; /* revision - same as SB AWE 64 */ |
| return result; |
| } |
| |
| static void snd_pcm_oss_simulate_fill(struct snd_pcm_substream *substream, |
| snd_pcm_uframes_t hw_ptr) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| snd_pcm_uframes_t appl_ptr; |
| appl_ptr = hw_ptr + runtime->buffer_size; |
| appl_ptr %= runtime->boundary; |
| runtime->control->appl_ptr = appl_ptr; |
| } |
| |
| static int snd_pcm_oss_set_trigger(struct snd_pcm_oss_file *pcm_oss_file, int trigger) |
| { |
| struct snd_pcm_runtime *runtime; |
| struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL; |
| int err, cmd; |
| |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, "pcm_oss: trigger = 0x%x\n", trigger); |
| #endif |
| |
| psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE]; |
| |
| if (psubstream) { |
| if ((err = snd_pcm_oss_make_ready(psubstream)) < 0) |
| return err; |
| } |
| if (csubstream) { |
| if ((err = snd_pcm_oss_make_ready(csubstream)) < 0) |
| return err; |
| } |
| if (psubstream) { |
| runtime = psubstream->runtime; |
| if (trigger & PCM_ENABLE_OUTPUT) { |
| if (runtime->oss.trigger) |
| goto _skip1; |
| if (atomic_read(&psubstream->mmap_count)) |
| snd_pcm_oss_simulate_fill(psubstream, |
| get_hw_ptr_period(runtime)); |
| runtime->oss.trigger = 1; |
| runtime->start_threshold = 1; |
| cmd = SNDRV_PCM_IOCTL_START; |
| } else { |
| if (!runtime->oss.trigger) |
| goto _skip1; |
| runtime->oss.trigger = 0; |
| runtime->start_threshold = runtime->boundary; |
| cmd = SNDRV_PCM_IOCTL_DROP; |
| runtime->oss.prepare = 1; |
| } |
| err = snd_pcm_kernel_ioctl(psubstream, cmd, NULL); |
| if (err < 0) |
| return err; |
| } |
| _skip1: |
| if (csubstream) { |
| runtime = csubstream->runtime; |
| if (trigger & PCM_ENABLE_INPUT) { |
| if (runtime->oss.trigger) |
| goto _skip2; |
| runtime->oss.trigger = 1; |
| runtime->start_threshold = 1; |
| cmd = SNDRV_PCM_IOCTL_START; |
| } else { |
| if (!runtime->oss.trigger) |
| goto _skip2; |
| runtime->oss.trigger = 0; |
| runtime->start_threshold = runtime->boundary; |
| cmd = SNDRV_PCM_IOCTL_DROP; |
| runtime->oss.prepare = 1; |
| } |
| err = snd_pcm_kernel_ioctl(csubstream, cmd, NULL); |
| if (err < 0) |
| return err; |
| } |
| _skip2: |
| return 0; |
| } |
| |
| static int snd_pcm_oss_get_trigger(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL; |
| int result = 0; |
| |
| psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE]; |
| if (psubstream && psubstream->runtime && psubstream->runtime->oss.trigger) |
| result |= PCM_ENABLE_OUTPUT; |
| if (csubstream && csubstream->runtime && csubstream->runtime->oss.trigger) |
| result |= PCM_ENABLE_INPUT; |
| return result; |
| } |
| |
| static int snd_pcm_oss_get_odelay(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| struct snd_pcm_substream *substream; |
| struct snd_pcm_runtime *runtime; |
| snd_pcm_sframes_t delay; |
| int err; |
| |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| if (substream == NULL) |
| return -EINVAL; |
| if ((err = snd_pcm_oss_make_ready(substream)) < 0) |
| return err; |
| runtime = substream->runtime; |
| if (runtime->oss.params || runtime->oss.prepare) |
| return 0; |
| err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &delay); |
| if (err == -EPIPE) |
| delay = 0; /* hack for broken OSS applications */ |
| else if (err < 0) |
| return err; |
| return snd_pcm_oss_bytes(substream, delay); |
| } |
| |
| static int snd_pcm_oss_get_ptr(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct count_info __user * _info) |
| { |
| struct snd_pcm_substream *substream; |
| struct snd_pcm_runtime *runtime; |
| snd_pcm_sframes_t delay; |
| int fixup; |
| struct count_info info; |
| int err; |
| |
| if (_info == NULL) |
| return -EFAULT; |
| substream = pcm_oss_file->streams[stream]; |
| if (substream == NULL) |
| return -EINVAL; |
| if ((err = snd_pcm_oss_make_ready(substream)) < 0) |
| return err; |
| runtime = substream->runtime; |
| if (runtime->oss.params || runtime->oss.prepare) { |
| memset(&info, 0, sizeof(info)); |
| if (copy_to_user(_info, &info, sizeof(info))) |
| return -EFAULT; |
| return 0; |
| } |
| if (stream == SNDRV_PCM_STREAM_PLAYBACK) { |
| err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &delay); |
| if (err == -EPIPE || err == -ESTRPIPE || (! err && delay < 0)) { |
| err = 0; |
| delay = 0; |
| fixup = 0; |
| } else { |
| fixup = runtime->oss.buffer_used; |
| } |
| } else { |
| err = snd_pcm_oss_capture_position_fixup(substream, &delay); |
| fixup = -runtime->oss.buffer_used; |
| } |
| if (err < 0) |
| return err; |
| info.ptr = snd_pcm_oss_bytes(substream, runtime->status->hw_ptr % runtime->buffer_size); |
| if (atomic_read(&substream->mmap_count)) { |
| snd_pcm_sframes_t n; |
| delay = get_hw_ptr_period(runtime); |
| n = delay - runtime->oss.prev_hw_ptr_period; |
| if (n < 0) |
| n += runtime->boundary; |
| info.blocks = n / runtime->period_size; |
| runtime->oss.prev_hw_ptr_period = delay; |
| if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
| snd_pcm_oss_simulate_fill(substream, delay); |
| info.bytes = snd_pcm_oss_bytes(substream, runtime->status->hw_ptr) & INT_MAX; |
| } else { |
| delay = snd_pcm_oss_bytes(substream, delay); |
| if (stream == SNDRV_PCM_STREAM_PLAYBACK) { |
| if (substream->oss.setup.buggyptr) |
| info.blocks = (runtime->oss.buffer_bytes - delay - fixup) / runtime->oss.period_bytes; |
| else |
| info.blocks = (delay + fixup) / runtime->oss.period_bytes; |
| info.bytes = (runtime->oss.bytes - delay) & INT_MAX; |
| } else { |
| delay += fixup; |
| info.blocks = delay / runtime->oss.period_bytes; |
| info.bytes = (runtime->oss.bytes + delay) & INT_MAX; |
| } |
| } |
| if (copy_to_user(_info, &info, sizeof(info))) |
| return -EFAULT; |
| return 0; |
| } |
| |
| static int snd_pcm_oss_get_space(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct audio_buf_info __user *_info) |
| { |
| struct snd_pcm_substream *substream; |
| struct snd_pcm_runtime *runtime; |
| snd_pcm_sframes_t avail; |
| int fixup; |
| struct audio_buf_info info; |
| int err; |
| |
| if (_info == NULL) |
| return -EFAULT; |
| substream = pcm_oss_file->streams[stream]; |
| if (substream == NULL) |
| return -EINVAL; |
| runtime = substream->runtime; |
| |
| if (runtime->oss.params && |
| (err = snd_pcm_oss_change_params(substream)) < 0) |
| return err; |
| |
| info.fragsize = runtime->oss.period_bytes; |
| info.fragstotal = runtime->periods; |
| if (runtime->oss.prepare) { |
| if (stream == SNDRV_PCM_STREAM_PLAYBACK) { |
| info.bytes = runtime->oss.period_bytes * runtime->oss.periods; |
| info.fragments = runtime->oss.periods; |
| } else { |
| info.bytes = 0; |
| info.fragments = 0; |
| } |
| } else { |
| if (stream == SNDRV_PCM_STREAM_PLAYBACK) { |
| err = snd_pcm_kernel_ioctl(substream, SNDRV_PCM_IOCTL_DELAY, &avail); |
| if (err == -EPIPE || err == -ESTRPIPE || (! err && avail < 0)) { |
| avail = runtime->buffer_size; |
| err = 0; |
| fixup = 0; |
| } else { |
| avail = runtime->buffer_size - avail; |
| fixup = -runtime->oss.buffer_used; |
| } |
| } else { |
| err = snd_pcm_oss_capture_position_fixup(substream, &avail); |
| fixup = runtime->oss.buffer_used; |
| } |
| if (err < 0) |
| return err; |
| info.bytes = snd_pcm_oss_bytes(substream, avail) + fixup; |
| info.fragments = info.bytes / runtime->oss.period_bytes; |
| } |
| |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, |
| "pcm_oss: space: bytes = %i, fragments = %i, fragstotal = %i, fragsize = %i\n", |
| info.bytes, info.fragments, info.fragstotal, info.fragsize); |
| #endif |
| if (copy_to_user(_info, &info, sizeof(info))) |
| return -EFAULT; |
| return 0; |
| } |
| |
| static int snd_pcm_oss_get_mapbuf(struct snd_pcm_oss_file *pcm_oss_file, int stream, struct buffmem_desc __user * _info) |
| { |
| // it won't be probably implemented |
| // pr_debug("TODO: snd_pcm_oss_get_mapbuf\n"); |
| return -EINVAL; |
| } |
| |
| static const char *strip_task_path(const char *path) |
| { |
| const char *ptr, *ptrl = NULL; |
| for (ptr = path; *ptr; ptr++) { |
| if (*ptr == '/') |
| ptrl = ptr + 1; |
| } |
| return ptrl; |
| } |
| |
| static void snd_pcm_oss_look_for_setup(struct snd_pcm *pcm, int stream, |
| const char *task_name, |
| struct snd_pcm_oss_setup *rsetup) |
| { |
| struct snd_pcm_oss_setup *setup; |
| |
| mutex_lock(&pcm->streams[stream].oss.setup_mutex); |
| do { |
| for (setup = pcm->streams[stream].oss.setup_list; setup; |
| setup = setup->next) { |
| if (!strcmp(setup->task_name, task_name)) |
| goto out; |
| } |
| } while ((task_name = strip_task_path(task_name)) != NULL); |
| out: |
| if (setup) |
| *rsetup = *setup; |
| mutex_unlock(&pcm->streams[stream].oss.setup_mutex); |
| } |
| |
| static void snd_pcm_oss_release_substream(struct snd_pcm_substream *substream) |
| { |
| struct snd_pcm_runtime *runtime; |
| runtime = substream->runtime; |
| vfree(runtime->oss.buffer); |
| runtime->oss.buffer = NULL; |
| #ifdef CONFIG_SND_PCM_OSS_PLUGINS |
| snd_pcm_oss_plugin_clear(substream); |
| #endif |
| substream->oss.oss = 0; |
| } |
| |
| static void snd_pcm_oss_init_substream(struct snd_pcm_substream *substream, |
| struct snd_pcm_oss_setup *setup, |
| int minor) |
| { |
| struct snd_pcm_runtime *runtime; |
| |
| substream->oss.oss = 1; |
| substream->oss.setup = *setup; |
| if (setup->nonblock) |
| substream->f_flags |= O_NONBLOCK; |
| else if (setup->block) |
| substream->f_flags &= ~O_NONBLOCK; |
| runtime = substream->runtime; |
| runtime->oss.params = 1; |
| runtime->oss.trigger = 1; |
| runtime->oss.rate = 8000; |
| mutex_init(&runtime->oss.params_lock); |
| switch (SNDRV_MINOR_OSS_DEVICE(minor)) { |
| case SNDRV_MINOR_OSS_PCM_8: |
| runtime->oss.format = AFMT_U8; |
| break; |
| case SNDRV_MINOR_OSS_PCM_16: |
| runtime->oss.format = AFMT_S16_LE; |
| break; |
| default: |
| runtime->oss.format = AFMT_MU_LAW; |
| } |
| runtime->oss.channels = 1; |
| runtime->oss.fragshift = 0; |
| runtime->oss.maxfrags = 0; |
| runtime->oss.subdivision = 0; |
| substream->pcm_release = snd_pcm_oss_release_substream; |
| } |
| |
| static int snd_pcm_oss_release_file(struct snd_pcm_oss_file *pcm_oss_file) |
| { |
| int cidx; |
| if (!pcm_oss_file) |
| return 0; |
| for (cidx = 0; cidx < 2; ++cidx) { |
| struct snd_pcm_substream *substream = pcm_oss_file->streams[cidx]; |
| if (substream) |
| snd_pcm_release_substream(substream); |
| } |
| kfree(pcm_oss_file); |
| return 0; |
| } |
| |
| static int snd_pcm_oss_open_file(struct file *file, |
| struct snd_pcm *pcm, |
| struct snd_pcm_oss_file **rpcm_oss_file, |
| int minor, |
| struct snd_pcm_oss_setup *setup) |
| { |
| int idx, err; |
| struct snd_pcm_oss_file *pcm_oss_file; |
| struct snd_pcm_substream *substream; |
| fmode_t f_mode = file->f_mode; |
| |
| if (rpcm_oss_file) |
| *rpcm_oss_file = NULL; |
| |
| pcm_oss_file = kzalloc(sizeof(*pcm_oss_file), GFP_KERNEL); |
| if (pcm_oss_file == NULL) |
| return -ENOMEM; |
| |
| if ((f_mode & (FMODE_WRITE|FMODE_READ)) == (FMODE_WRITE|FMODE_READ) && |
| (pcm->info_flags & SNDRV_PCM_INFO_HALF_DUPLEX)) |
| f_mode = FMODE_WRITE; |
| |
| file->f_flags &= ~O_APPEND; |
| for (idx = 0; idx < 2; idx++) { |
| if (setup[idx].disable) |
| continue; |
| if (! pcm->streams[idx].substream_count) |
| continue; /* no matching substream */ |
| if (idx == SNDRV_PCM_STREAM_PLAYBACK) { |
| if (! (f_mode & FMODE_WRITE)) |
| continue; |
| } else { |
| if (! (f_mode & FMODE_READ)) |
| continue; |
| } |
| err = snd_pcm_open_substream(pcm, idx, file, &substream); |
| if (err < 0) { |
| snd_pcm_oss_release_file(pcm_oss_file); |
| return err; |
| } |
| |
| pcm_oss_file->streams[idx] = substream; |
| substream->file = pcm_oss_file; |
| snd_pcm_oss_init_substream(substream, &setup[idx], minor); |
| } |
| |
| if (!pcm_oss_file->streams[0] && !pcm_oss_file->streams[1]) { |
| snd_pcm_oss_release_file(pcm_oss_file); |
| return -EINVAL; |
| } |
| |
| file->private_data = pcm_oss_file; |
| if (rpcm_oss_file) |
| *rpcm_oss_file = pcm_oss_file; |
| return 0; |
| } |
| |
| |
| static int snd_task_name(struct task_struct *task, char *name, size_t size) |
| { |
| unsigned int idx; |
| |
| if (snd_BUG_ON(!task || !name || size < 2)) |
| return -EINVAL; |
| for (idx = 0; idx < sizeof(task->comm) && idx + 1 < size; idx++) |
| name[idx] = task->comm[idx]; |
| name[idx] = '\0'; |
| return 0; |
| } |
| |
| static int snd_pcm_oss_open(struct inode *inode, struct file *file) |
| { |
| int err; |
| char task_name[32]; |
| struct snd_pcm *pcm; |
| struct snd_pcm_oss_file *pcm_oss_file; |
| struct snd_pcm_oss_setup setup[2]; |
| int nonblock; |
| wait_queue_t wait; |
| |
| err = nonseekable_open(inode, file); |
| if (err < 0) |
| return err; |
| |
| pcm = snd_lookup_oss_minor_data(iminor(inode), |
| SNDRV_OSS_DEVICE_TYPE_PCM); |
| if (pcm == NULL) { |
| err = -ENODEV; |
| goto __error1; |
| } |
| err = snd_card_file_add(pcm->card, file); |
| if (err < 0) |
| goto __error1; |
| if (!try_module_get(pcm->card->module)) { |
| err = -EFAULT; |
| goto __error2; |
| } |
| if (snd_task_name(current, task_name, sizeof(task_name)) < 0) { |
| err = -EFAULT; |
| goto __error; |
| } |
| memset(setup, 0, sizeof(setup)); |
| if (file->f_mode & FMODE_WRITE) |
| snd_pcm_oss_look_for_setup(pcm, SNDRV_PCM_STREAM_PLAYBACK, |
| task_name, &setup[0]); |
| if (file->f_mode & FMODE_READ) |
| snd_pcm_oss_look_for_setup(pcm, SNDRV_PCM_STREAM_CAPTURE, |
| task_name, &setup[1]); |
| |
| nonblock = !!(file->f_flags & O_NONBLOCK); |
| if (!nonblock) |
| nonblock = nonblock_open; |
| |
| init_waitqueue_entry(&wait, current); |
| add_wait_queue(&pcm->open_wait, &wait); |
| mutex_lock(&pcm->open_mutex); |
| while (1) { |
| err = snd_pcm_oss_open_file(file, pcm, &pcm_oss_file, |
| iminor(inode), setup); |
| if (err >= 0) |
| break; |
| if (err == -EAGAIN) { |
| if (nonblock) { |
| err = -EBUSY; |
| break; |
| } |
| } else |
| break; |
| set_current_state(TASK_INTERRUPTIBLE); |
| mutex_unlock(&pcm->open_mutex); |
| schedule(); |
| mutex_lock(&pcm->open_mutex); |
| if (pcm->card->shutdown) { |
| err = -ENODEV; |
| break; |
| } |
| if (signal_pending(current)) { |
| err = -ERESTARTSYS; |
| break; |
| } |
| } |
| remove_wait_queue(&pcm->open_wait, &wait); |
| mutex_unlock(&pcm->open_mutex); |
| if (err < 0) |
| goto __error; |
| snd_card_unref(pcm->card); |
| return err; |
| |
| __error: |
| module_put(pcm->card->module); |
| __error2: |
| snd_card_file_remove(pcm->card, file); |
| __error1: |
| if (pcm) |
| snd_card_unref(pcm->card); |
| return err; |
| } |
| |
| static int snd_pcm_oss_release(struct inode *inode, struct file *file) |
| { |
| struct snd_pcm *pcm; |
| struct snd_pcm_substream *substream; |
| struct snd_pcm_oss_file *pcm_oss_file; |
| |
| pcm_oss_file = file->private_data; |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| if (substream == NULL) |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE]; |
| if (snd_BUG_ON(!substream)) |
| return -ENXIO; |
| pcm = substream->pcm; |
| if (!pcm->card->shutdown) |
| snd_pcm_oss_sync(pcm_oss_file); |
| mutex_lock(&pcm->open_mutex); |
| snd_pcm_oss_release_file(pcm_oss_file); |
| mutex_unlock(&pcm->open_mutex); |
| wake_up(&pcm->open_wait); |
| module_put(pcm->card->module); |
| snd_card_file_remove(pcm->card, file); |
| return 0; |
| } |
| |
| static long snd_pcm_oss_ioctl(struct file *file, unsigned int cmd, unsigned long arg) |
| { |
| struct snd_pcm_oss_file *pcm_oss_file; |
| int __user *p = (int __user *)arg; |
| int res; |
| |
| pcm_oss_file = file->private_data; |
| if (cmd == OSS_GETVERSION) |
| return put_user(SNDRV_OSS_VERSION, p); |
| if (cmd == OSS_ALSAEMULVER) |
| return put_user(1, p); |
| #if defined(CONFIG_SND_MIXER_OSS) || (defined(MODULE) && defined(CONFIG_SND_MIXER_OSS_MODULE)) |
| if (((cmd >> 8) & 0xff) == 'M') { /* mixer ioctl - for OSS compatibility */ |
| struct snd_pcm_substream *substream; |
| int idx; |
| for (idx = 0; idx < 2; ++idx) { |
| substream = pcm_oss_file->streams[idx]; |
| if (substream != NULL) |
| break; |
| } |
| if (snd_BUG_ON(idx >= 2)) |
| return -ENXIO; |
| return snd_mixer_oss_ioctl_card(substream->pcm->card, cmd, arg); |
| } |
| #endif |
| if (((cmd >> 8) & 0xff) != 'P') |
| return -EINVAL; |
| #ifdef OSS_DEBUG |
| pr_debug("pcm_oss: ioctl = 0x%x\n", cmd); |
| #endif |
| switch (cmd) { |
| case SNDCTL_DSP_RESET: |
| return snd_pcm_oss_reset(pcm_oss_file); |
| case SNDCTL_DSP_SYNC: |
| return snd_pcm_oss_sync(pcm_oss_file); |
| case SNDCTL_DSP_SPEED: |
| if (get_user(res, p)) |
| return -EFAULT; |
| if ((res = snd_pcm_oss_set_rate(pcm_oss_file, res))<0) |
| return res; |
| return put_user(res, p); |
| case SOUND_PCM_READ_RATE: |
| res = snd_pcm_oss_get_rate(pcm_oss_file); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SNDCTL_DSP_STEREO: |
| if (get_user(res, p)) |
| return -EFAULT; |
| res = res > 0 ? 2 : 1; |
| if ((res = snd_pcm_oss_set_channels(pcm_oss_file, res)) < 0) |
| return res; |
| return put_user(--res, p); |
| case SNDCTL_DSP_GETBLKSIZE: |
| res = snd_pcm_oss_get_block_size(pcm_oss_file); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SNDCTL_DSP_SETFMT: |
| if (get_user(res, p)) |
| return -EFAULT; |
| res = snd_pcm_oss_set_format(pcm_oss_file, res); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SOUND_PCM_READ_BITS: |
| res = snd_pcm_oss_get_format(pcm_oss_file); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SNDCTL_DSP_CHANNELS: |
| if (get_user(res, p)) |
| return -EFAULT; |
| res = snd_pcm_oss_set_channels(pcm_oss_file, res); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SOUND_PCM_READ_CHANNELS: |
| res = snd_pcm_oss_get_channels(pcm_oss_file); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SOUND_PCM_WRITE_FILTER: |
| case SOUND_PCM_READ_FILTER: |
| return -EIO; |
| case SNDCTL_DSP_POST: |
| return snd_pcm_oss_post(pcm_oss_file); |
| case SNDCTL_DSP_SUBDIVIDE: |
| if (get_user(res, p)) |
| return -EFAULT; |
| res = snd_pcm_oss_set_subdivide(pcm_oss_file, res); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SNDCTL_DSP_SETFRAGMENT: |
| if (get_user(res, p)) |
| return -EFAULT; |
| return snd_pcm_oss_set_fragment(pcm_oss_file, res); |
| case SNDCTL_DSP_GETFMTS: |
| res = snd_pcm_oss_get_formats(pcm_oss_file); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SNDCTL_DSP_GETOSPACE: |
| case SNDCTL_DSP_GETISPACE: |
| return snd_pcm_oss_get_space(pcm_oss_file, |
| cmd == SNDCTL_DSP_GETISPACE ? |
| SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK, |
| (struct audio_buf_info __user *) arg); |
| case SNDCTL_DSP_NONBLOCK: |
| return snd_pcm_oss_nonblock(file); |
| case SNDCTL_DSP_GETCAPS: |
| res = snd_pcm_oss_get_caps(pcm_oss_file); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SNDCTL_DSP_GETTRIGGER: |
| res = snd_pcm_oss_get_trigger(pcm_oss_file); |
| if (res < 0) |
| return res; |
| return put_user(res, p); |
| case SNDCTL_DSP_SETTRIGGER: |
| if (get_user(res, p)) |
| return -EFAULT; |
| return snd_pcm_oss_set_trigger(pcm_oss_file, res); |
| case SNDCTL_DSP_GETIPTR: |
| case SNDCTL_DSP_GETOPTR: |
| return snd_pcm_oss_get_ptr(pcm_oss_file, |
| cmd == SNDCTL_DSP_GETIPTR ? |
| SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK, |
| (struct count_info __user *) arg); |
| case SNDCTL_DSP_MAPINBUF: |
| case SNDCTL_DSP_MAPOUTBUF: |
| return snd_pcm_oss_get_mapbuf(pcm_oss_file, |
| cmd == SNDCTL_DSP_MAPINBUF ? |
| SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK, |
| (struct buffmem_desc __user *) arg); |
| case SNDCTL_DSP_SETSYNCRO: |
| /* stop DMA now.. */ |
| return 0; |
| case SNDCTL_DSP_SETDUPLEX: |
| if (snd_pcm_oss_get_caps(pcm_oss_file) & DSP_CAP_DUPLEX) |
| return 0; |
| return -EIO; |
| case SNDCTL_DSP_GETODELAY: |
| res = snd_pcm_oss_get_odelay(pcm_oss_file); |
| if (res < 0) { |
| /* it's for sure, some broken apps don't check for error codes */ |
| put_user(0, p); |
| return res; |
| } |
| return put_user(res, p); |
| case SNDCTL_DSP_PROFILE: |
| return 0; /* silently ignore */ |
| default: |
| pr_debug("pcm_oss: unknown command = 0x%x\n", cmd); |
| } |
| return -EINVAL; |
| } |
| |
| #ifdef CONFIG_COMPAT |
| /* all compatible */ |
| #define snd_pcm_oss_ioctl_compat snd_pcm_oss_ioctl |
| #else |
| #define snd_pcm_oss_ioctl_compat NULL |
| #endif |
| |
| static ssize_t snd_pcm_oss_read(struct file *file, char __user *buf, size_t count, loff_t *offset) |
| { |
| struct snd_pcm_oss_file *pcm_oss_file; |
| struct snd_pcm_substream *substream; |
| |
| pcm_oss_file = file->private_data; |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE]; |
| if (substream == NULL) |
| return -ENXIO; |
| substream->f_flags = file->f_flags & O_NONBLOCK; |
| #ifndef OSS_DEBUG |
| return snd_pcm_oss_read1(substream, buf, count); |
| #else |
| { |
| ssize_t res = snd_pcm_oss_read1(substream, buf, count); |
| pcm_dbg(substream->pcm, |
| "pcm_oss: read %li bytes (returned %li bytes)\n", |
| (long)count, (long)res); |
| return res; |
| } |
| #endif |
| } |
| |
| static ssize_t snd_pcm_oss_write(struct file *file, const char __user *buf, size_t count, loff_t *offset) |
| { |
| struct snd_pcm_oss_file *pcm_oss_file; |
| struct snd_pcm_substream *substream; |
| long result; |
| |
| pcm_oss_file = file->private_data; |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| if (substream == NULL) |
| return -ENXIO; |
| substream->f_flags = file->f_flags & O_NONBLOCK; |
| result = snd_pcm_oss_write1(substream, buf, count); |
| #ifdef OSS_DEBUG |
| pcm_dbg(substream->pcm, "pcm_oss: write %li bytes (wrote %li bytes)\n", |
| (long)count, (long)result); |
| #endif |
| return result; |
| } |
| |
| static int snd_pcm_oss_playback_ready(struct snd_pcm_substream *substream) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| if (atomic_read(&substream->mmap_count)) |
| return runtime->oss.prev_hw_ptr_period != |
| get_hw_ptr_period(runtime); |
| else |
| return snd_pcm_playback_avail(runtime) >= |
| runtime->oss.period_frames; |
| } |
| |
| static int snd_pcm_oss_capture_ready(struct snd_pcm_substream *substream) |
| { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| if (atomic_read(&substream->mmap_count)) |
| return runtime->oss.prev_hw_ptr_period != |
| get_hw_ptr_period(runtime); |
| else |
| return snd_pcm_capture_avail(runtime) >= |
| runtime->oss.period_frames; |
| } |
| |
| static unsigned int snd_pcm_oss_poll(struct file *file, poll_table * wait) |
| { |
| struct snd_pcm_oss_file *pcm_oss_file; |
| unsigned int mask; |
| struct snd_pcm_substream *psubstream = NULL, *csubstream = NULL; |
| |
| pcm_oss_file = file->private_data; |
| |
| psubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| csubstream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE]; |
| |
| mask = 0; |
| if (psubstream != NULL) { |
| struct snd_pcm_runtime *runtime = psubstream->runtime; |
| poll_wait(file, &runtime->sleep, wait); |
| snd_pcm_stream_lock_irq(psubstream); |
| if (runtime->status->state != SNDRV_PCM_STATE_DRAINING && |
| (runtime->status->state != SNDRV_PCM_STATE_RUNNING || |
| snd_pcm_oss_playback_ready(psubstream))) |
| mask |= POLLOUT | POLLWRNORM; |
| snd_pcm_stream_unlock_irq(psubstream); |
| } |
| if (csubstream != NULL) { |
| struct snd_pcm_runtime *runtime = csubstream->runtime; |
| snd_pcm_state_t ostate; |
| poll_wait(file, &runtime->sleep, wait); |
| snd_pcm_stream_lock_irq(csubstream); |
| if ((ostate = runtime->status->state) != SNDRV_PCM_STATE_RUNNING || |
| snd_pcm_oss_capture_ready(csubstream)) |
| mask |= POLLIN | POLLRDNORM; |
| snd_pcm_stream_unlock_irq(csubstream); |
| if (ostate != SNDRV_PCM_STATE_RUNNING && runtime->oss.trigger) { |
| struct snd_pcm_oss_file ofile; |
| memset(&ofile, 0, sizeof(ofile)); |
| ofile.streams[SNDRV_PCM_STREAM_CAPTURE] = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE]; |
| runtime->oss.trigger = 0; |
| snd_pcm_oss_set_trigger(&ofile, PCM_ENABLE_INPUT); |
| } |
| } |
| |
| return mask; |
| } |
| |
| static int snd_pcm_oss_mmap(struct file *file, struct vm_area_struct *area) |
| { |
| struct snd_pcm_oss_file *pcm_oss_file; |
| struct snd_pcm_substream *substream = NULL; |
| struct snd_pcm_runtime *runtime; |
| int err; |
| |
| #ifdef OSS_DEBUG |
| pr_debug("pcm_oss: mmap begin\n"); |
| #endif |
| pcm_oss_file = file->private_data; |
| switch ((area->vm_flags & (VM_READ | VM_WRITE))) { |
| case VM_READ | VM_WRITE: |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| if (substream) |
| break; |
| /* Fall through */ |
| case VM_READ: |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_CAPTURE]; |
| break; |
| case VM_WRITE: |
| substream = pcm_oss_file->streams[SNDRV_PCM_STREAM_PLAYBACK]; |
| break; |
| default: |
| return -EINVAL; |
| } |
| /* set VM_READ access as well to fix memset() routines that do |
| reads before writes (to improve performance) */ |
| area->vm_flags |= VM_READ; |
| if (substream == NULL) |
| return -ENXIO; |
| runtime = substream->runtime; |
| if (!(runtime->info & SNDRV_PCM_INFO_MMAP_VALID)) |
| return -EIO; |
| if (runtime->info & SNDRV_PCM_INFO_INTERLEAVED) |
| runtime->access = SNDRV_PCM_ACCESS_MMAP_INTERLEAVED; |
| else |
| return -EIO; |
| |
| if (runtime->oss.params) { |
| if ((err = snd_pcm_oss_change_params(substream)) < 0) |
| return err; |
| } |
| #ifdef CONFIG_SND_PCM_OSS_PLUGINS |
| if (runtime->oss.plugin_first != NULL) |
| return -EIO; |
| #endif |
| |
| if (area->vm_pgoff != 0) |
| return -EINVAL; |
| |
| err = snd_pcm_mmap_data(substream, file, area); |
| if (err < 0) |
| return err; |
| runtime->oss.mmap_bytes = area->vm_end - area->vm_start; |
| runtime->silence_threshold = 0; |
| runtime->silence_size = 0; |
| #ifdef OSS_DEBUG |
| pr_debug("pcm_oss: mmap ok, bytes = 0x%x\n", |
| runtime->oss.mmap_bytes); |
| #endif |
| /* In mmap mode we never stop */ |
| runtime->stop_threshold = runtime->boundary; |
| |
| return 0; |
| } |
| |
| #ifdef CONFIG_SND_VERBOSE_PROCFS |
| /* |
| * /proc interface |
| */ |
| |
| static void snd_pcm_oss_proc_read(struct snd_info_entry *entry, |
| struct snd_info_buffer *buffer) |
| { |
| struct snd_pcm_str *pstr = entry->private_data; |
| struct snd_pcm_oss_setup *setup = pstr->oss.setup_list; |
| mutex_lock(&pstr->oss.setup_mutex); |
| while (setup) { |
| snd_iprintf(buffer, "%s %u %u%s%s%s%s%s%s\n", |
| setup->task_name, |
| setup->periods, |
| setup->period_size, |
| setup->disable ? " disable" : "", |
| setup->direct ? " direct" : "", |
| setup->block ? " block" : "", |
| setup->nonblock ? " non-block" : "", |
| setup->partialfrag ? " partial-frag" : "", |
| setup->nosilence ? " no-silence" : ""); |
| setup = setup->next; |
| } |
| mutex_unlock(&pstr->oss.setup_mutex); |
| } |
| |
| static void snd_pcm_oss_proc_free_setup_list(struct snd_pcm_str * pstr) |
| { |
| struct snd_pcm_oss_setup *setup, *setupn; |
| |
| for (setup = pstr->oss.setup_list, pstr->oss.setup_list = NULL; |
| setup; setup = setupn) { |
| setupn = setup->next; |
| kfree(setup->task_name); |
| kfree(setup); |
| } |
| pstr->oss.setup_list = NULL; |
| } |
| |
| static void snd_pcm_oss_proc_write(struct snd_info_entry *entry, |
| struct snd_info_buffer *buffer) |
| { |
| struct snd_pcm_str *pstr = entry->private_data; |
| char line[128], str[32], task_name[32]; |
| const char *ptr; |
| int idx1; |
| struct snd_pcm_oss_setup *setup, *setup1, template; |
| |
| while (!snd_info_get_line(buffer, line, sizeof(line))) { |
| mutex_lock(&pstr->oss.setup_mutex); |
| memset(&template, 0, sizeof(template)); |
| ptr = snd_info_get_str(task_name, line, sizeof(task_name)); |
| if (!strcmp(task_name, "clear") || !strcmp(task_name, "erase")) { |
| snd_pcm_oss_proc_free_setup_list(pstr); |
| mutex_unlock(&pstr->oss.setup_mutex); |
| continue; |
| } |
| for (setup = pstr->oss.setup_list; setup; setup = setup->next) { |
| if (!strcmp(setup->task_name, task_name)) { |
| template = *setup; |
| break; |
| } |
| } |
| ptr = snd_info_get_str(str, ptr, sizeof(str)); |
| template.periods = simple_strtoul(str, NULL, 10); |
| ptr = snd_info_get_str(str, ptr, sizeof(str)); |
| template.period_size = simple_strtoul(str, NULL, 10); |
| for (idx1 = 31; idx1 >= 0; idx1--) |
| if (template.period_size & (1 << idx1)) |
| break; |
| for (idx1--; idx1 >= 0; idx1--) |
| template.period_size &= ~(1 << idx1); |
| do { |
| ptr = snd_info_get_str(str, ptr, sizeof(str)); |
| if (!strcmp(str, "disable")) { |
| template.disable = 1; |
| } else if (!strcmp(str, "direct")) { |
| template.direct = 1; |
| } else if (!strcmp(str, "block")) { |
| template.block = 1; |
| } else if (!strcmp(str, "non-block")) { |
| template.nonblock = 1; |
| } else if (!strcmp(str, "partial-frag")) { |
| template.partialfrag = 1; |
| } else if (!strcmp(str, "no-silence")) { |
| template.nosilence = 1; |
| } else if (!strcmp(str, "buggy-ptr")) { |
| template.buggyptr = 1; |
| } |
| } while (*str); |
| if (setup == NULL) { |
| setup = kmalloc(sizeof(*setup), GFP_KERNEL); |
| if (! setup) { |
| buffer->error = -ENOMEM; |
| mutex_unlock(&pstr->oss.setup_mutex); |
| return; |
| } |
| if (pstr->oss.setup_list == NULL) |
| pstr->oss.setup_list = setup; |
| else { |
| for (setup1 = pstr->oss.setup_list; |
| setup1->next; setup1 = setup1->next); |
| setup1->next = setup; |
| } |
| template.task_name = kstrdup(task_name, GFP_KERNEL); |
| if (! template.task_name) { |
| kfree(setup); |
| buffer->error = -ENOMEM; |
| mutex_unlock(&pstr->oss.setup_mutex); |
| return; |
| } |
| } |
| *setup = template; |
| mutex_unlock(&pstr->oss.setup_mutex); |
| } |
| } |
| |
| static void snd_pcm_oss_proc_init(struct snd_pcm *pcm) |
| { |
| int stream; |
| for (stream = 0; stream < 2; ++stream) { |
| struct snd_info_entry *entry; |
| struct snd_pcm_str *pstr = &pcm->streams[stream]; |
| if (pstr->substream_count == 0) |
| continue; |
| if ((entry = snd_info_create_card_entry(pcm->card, "oss", pstr->proc_root)) != NULL) { |
| entry->content = SNDRV_INFO_CONTENT_TEXT; |
| entry->mode = S_IFREG | S_IRUGO | S_IWUSR; |
| entry->c.text.read = snd_pcm_oss_proc_read; |
| entry->c.text.write = snd_pcm_oss_proc_write; |
| entry->private_data = pstr; |
| if (snd_info_register(entry) < 0) { |
| snd_info_free_entry(entry); |
| entry = NULL; |
| } |
| } |
| pstr->oss.proc_entry = entry; |
| } |
| } |
| |
| static void snd_pcm_oss_proc_done(struct snd_pcm *pcm) |
| { |
| int stream; |
| for (stream = 0; stream < 2; ++stream) { |
| struct snd_pcm_str *pstr = &pcm->streams[stream]; |
| snd_info_free_entry(pstr->oss.proc_entry); |
| pstr->oss.proc_entry = NULL; |
| snd_pcm_oss_proc_free_setup_list(pstr); |
| } |
| } |
| #else /* !CONFIG_SND_VERBOSE_PROCFS */ |
| #define snd_pcm_oss_proc_init(pcm) |
| #define snd_pcm_oss_proc_done(pcm) |
| #endif /* CONFIG_SND_VERBOSE_PROCFS */ |
| |
| /* |
| * ENTRY functions |
| */ |
| |
| static const struct file_operations snd_pcm_oss_f_reg = |
| { |
| .owner = THIS_MODULE, |
| .read = snd_pcm_oss_read, |
| .write = snd_pcm_oss_write, |
| .open = snd_pcm_oss_open, |
| .release = snd_pcm_oss_release, |
| .llseek = no_llseek, |
| .poll = snd_pcm_oss_poll, |
| .unlocked_ioctl = snd_pcm_oss_ioctl, |
| .compat_ioctl = snd_pcm_oss_ioctl_compat, |
| .mmap = snd_pcm_oss_mmap, |
| }; |
| |
| static void register_oss_dsp(struct snd_pcm *pcm, int index) |
| { |
| if (snd_register_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM, |
| pcm->card, index, &snd_pcm_oss_f_reg, |
| pcm) < 0) { |
| pcm_err(pcm, "unable to register OSS PCM device %i:%i\n", |
| pcm->card->number, pcm->device); |
| } |
| } |
| |
| static int snd_pcm_oss_register_minor(struct snd_pcm *pcm) |
| { |
| pcm->oss.reg = 0; |
| if (dsp_map[pcm->card->number] == (int)pcm->device) { |
| char name[128]; |
| int duplex; |
| register_oss_dsp(pcm, 0); |
| duplex = (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream_count > 0 && |
| pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream_count && |
| !(pcm->info_flags & SNDRV_PCM_INFO_HALF_DUPLEX)); |
| sprintf(name, "%s%s", pcm->name, duplex ? " (DUPLEX)" : ""); |
| #ifdef SNDRV_OSS_INFO_DEV_AUDIO |
| snd_oss_info_register(SNDRV_OSS_INFO_DEV_AUDIO, |
| pcm->card->number, |
| name); |
| #endif |
| pcm->oss.reg++; |
| pcm->oss.reg_mask |= 1; |
| } |
| if (adsp_map[pcm->card->number] == (int)pcm->device) { |
| register_oss_dsp(pcm, 1); |
| pcm->oss.reg++; |
| pcm->oss.reg_mask |= 2; |
| } |
| |
| if (pcm->oss.reg) |
| snd_pcm_oss_proc_init(pcm); |
| |
| return 0; |
| } |
| |
| static int snd_pcm_oss_disconnect_minor(struct snd_pcm *pcm) |
| { |
| if (pcm->oss.reg) { |
| if (pcm->oss.reg_mask & 1) { |
| pcm->oss.reg_mask &= ~1; |
| snd_unregister_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM, |
| pcm->card, 0); |
| } |
| if (pcm->oss.reg_mask & 2) { |
| pcm->oss.reg_mask &= ~2; |
| snd_unregister_oss_device(SNDRV_OSS_DEVICE_TYPE_PCM, |
| pcm->card, 1); |
| } |
| if (dsp_map[pcm->card->number] == (int)pcm->device) { |
| #ifdef SNDRV_OSS_INFO_DEV_AUDIO |
| snd_oss_info_unregister(SNDRV_OSS_INFO_DEV_AUDIO, pcm->card->number); |
| #endif |
| } |
| pcm->oss.reg = 0; |
| } |
| return 0; |
| } |
| |
| static int snd_pcm_oss_unregister_minor(struct snd_pcm *pcm) |
| { |
| snd_pcm_oss_disconnect_minor(pcm); |
| snd_pcm_oss_proc_done(pcm); |
| return 0; |
| } |
| |
| static struct snd_pcm_notify snd_pcm_oss_notify = |
| { |
| .n_register = snd_pcm_oss_register_minor, |
| .n_disconnect = snd_pcm_oss_disconnect_minor, |
| .n_unregister = snd_pcm_oss_unregister_minor, |
| }; |
| |
| static int __init alsa_pcm_oss_init(void) |
| { |
| int i; |
| int err; |
| |
| /* check device map table */ |
| for (i = 0; i < SNDRV_CARDS; i++) { |
| if (dsp_map[i] < 0 || dsp_map[i] >= SNDRV_PCM_DEVICES) { |
| pr_err("ALSA: pcm_oss: invalid dsp_map[%d] = %d\n", |
| i, dsp_map[i]); |
| dsp_map[i] = 0; |
| } |
| if (adsp_map[i] < 0 || adsp_map[i] >= SNDRV_PCM_DEVICES) { |
| pr_err("ALSA: pcm_oss: invalid adsp_map[%d] = %d\n", |
| i, adsp_map[i]); |
| adsp_map[i] = 1; |
| } |
| } |
| if ((err = snd_pcm_notify(&snd_pcm_oss_notify, 0)) < 0) |
| return err; |
| return 0; |
| } |
| |
| static void __exit alsa_pcm_oss_exit(void) |
| { |
| snd_pcm_notify(&snd_pcm_oss_notify, 1); |
| } |
| |
| module_init(alsa_pcm_oss_init) |
| module_exit(alsa_pcm_oss_exit) |