mirror of
https://github.com/adulau/aha.git
synced 2024-12-28 11:46:19 +00:00
4b3be6afa4
In pcm.c, if the NULL test on pcm is needed, then the dereference should be after the NULL test. In dummy.c and ali5451.c, the context of the calls to snd_card_dummy_new_mixer and snd_ali_free_voice show that dummy and pvoice, respectively cannot be NULL. A simplified version of the semantic match that detects this problem is as follows (http://coccinelle.lip6.fr/): // <smpl> @match exists@ expression x, E; identifier fld; @@ * x->fld ... when != \(x = E\|&x\) * x == NULL // </smpl> Signed-off-by: Julia Lawall <julia@diku.dk> Signed-off-by: Takashi Iwai <tiwai@suse.de>
1087 lines
28 KiB
C
1087 lines
28 KiB
C
/*
|
|
* Dummy soundcard
|
|
* 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
|
|
*
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/err.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/time.h>
|
|
#include <linux/wait.h>
|
|
#include <linux/hrtimer.h>
|
|
#include <linux/math64.h>
|
|
#include <linux/moduleparam.h>
|
|
#include <sound/core.h>
|
|
#include <sound/control.h>
|
|
#include <sound/tlv.h>
|
|
#include <sound/pcm.h>
|
|
#include <sound/rawmidi.h>
|
|
#include <sound/info.h>
|
|
#include <sound/initval.h>
|
|
|
|
MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
|
|
MODULE_DESCRIPTION("Dummy soundcard (/dev/null)");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_SUPPORTED_DEVICE("{{ALSA,Dummy soundcard}}");
|
|
|
|
#define MAX_PCM_DEVICES 4
|
|
#define MAX_PCM_SUBSTREAMS 128
|
|
#define MAX_MIDI_DEVICES 2
|
|
|
|
#if 0 /* emu10k1 emulation */
|
|
#define MAX_BUFFER_SIZE (128 * 1024)
|
|
static int emu10k1_playback_constraints(struct snd_pcm_runtime *runtime)
|
|
{
|
|
int err;
|
|
err = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
|
|
if (err < 0)
|
|
return err;
|
|
err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 256, UINT_MAX);
|
|
if (err < 0)
|
|
return err;
|
|
return 0;
|
|
}
|
|
#define add_playback_constraints emu10k1_playback_constraints
|
|
#endif
|
|
|
|
#if 0 /* RME9652 emulation */
|
|
#define MAX_BUFFER_SIZE (26 * 64 * 1024)
|
|
#define USE_FORMATS SNDRV_PCM_FMTBIT_S32_LE
|
|
#define USE_CHANNELS_MIN 26
|
|
#define USE_CHANNELS_MAX 26
|
|
#define USE_PERIODS_MIN 2
|
|
#define USE_PERIODS_MAX 2
|
|
#endif
|
|
|
|
#if 0 /* ICE1712 emulation */
|
|
#define MAX_BUFFER_SIZE (256 * 1024)
|
|
#define USE_FORMATS SNDRV_PCM_FMTBIT_S32_LE
|
|
#define USE_CHANNELS_MIN 10
|
|
#define USE_CHANNELS_MAX 10
|
|
#define USE_PERIODS_MIN 1
|
|
#define USE_PERIODS_MAX 1024
|
|
#endif
|
|
|
|
#if 0 /* UDA1341 emulation */
|
|
#define MAX_BUFFER_SIZE (16380)
|
|
#define USE_FORMATS SNDRV_PCM_FMTBIT_S16_LE
|
|
#define USE_CHANNELS_MIN 2
|
|
#define USE_CHANNELS_MAX 2
|
|
#define USE_PERIODS_MIN 2
|
|
#define USE_PERIODS_MAX 255
|
|
#endif
|
|
|
|
#if 0 /* simple AC97 bridge (intel8x0) with 48kHz AC97 only codec */
|
|
#define USE_FORMATS SNDRV_PCM_FMTBIT_S16_LE
|
|
#define USE_CHANNELS_MIN 2
|
|
#define USE_CHANNELS_MAX 2
|
|
#define USE_RATE SNDRV_PCM_RATE_48000
|
|
#define USE_RATE_MIN 48000
|
|
#define USE_RATE_MAX 48000
|
|
#endif
|
|
|
|
#if 0 /* CA0106 */
|
|
#define USE_FORMATS SNDRV_PCM_FMTBIT_S16_LE
|
|
#define USE_CHANNELS_MIN 2
|
|
#define USE_CHANNELS_MAX 2
|
|
#define USE_RATE (SNDRV_PCM_RATE_48000|SNDRV_PCM_RATE_96000|SNDRV_PCM_RATE_192000)
|
|
#define USE_RATE_MIN 48000
|
|
#define USE_RATE_MAX 192000
|
|
#define MAX_BUFFER_SIZE ((65536-64)*8)
|
|
#define MAX_PERIOD_SIZE (65536-64)
|
|
#define USE_PERIODS_MIN 2
|
|
#define USE_PERIODS_MAX 8
|
|
#endif
|
|
|
|
|
|
/* defaults */
|
|
#ifndef MAX_BUFFER_SIZE
|
|
#define MAX_BUFFER_SIZE (64*1024)
|
|
#endif
|
|
#ifndef MAX_PERIOD_SIZE
|
|
#define MAX_PERIOD_SIZE MAX_BUFFER_SIZE
|
|
#endif
|
|
#ifndef USE_FORMATS
|
|
#define USE_FORMATS (SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE)
|
|
#endif
|
|
#ifndef USE_RATE
|
|
#define USE_RATE SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000
|
|
#define USE_RATE_MIN 5500
|
|
#define USE_RATE_MAX 48000
|
|
#endif
|
|
#ifndef USE_CHANNELS_MIN
|
|
#define USE_CHANNELS_MIN 1
|
|
#endif
|
|
#ifndef USE_CHANNELS_MAX
|
|
#define USE_CHANNELS_MAX 2
|
|
#endif
|
|
#ifndef USE_PERIODS_MIN
|
|
#define USE_PERIODS_MIN 1
|
|
#endif
|
|
#ifndef USE_PERIODS_MAX
|
|
#define USE_PERIODS_MAX 1024
|
|
#endif
|
|
#ifndef add_playback_constraints
|
|
#define add_playback_constraints(x) 0
|
|
#endif
|
|
#ifndef add_capture_constraints
|
|
#define add_capture_constraints(x) 0
|
|
#endif
|
|
|
|
static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 0-MAX */
|
|
static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* ID for this card */
|
|
static int enable[SNDRV_CARDS] = {1, [1 ... (SNDRV_CARDS - 1)] = 0};
|
|
static int pcm_devs[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 1};
|
|
static int pcm_substreams[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 8};
|
|
//static int midi_devs[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 2};
|
|
#ifdef CONFIG_HIGH_RES_TIMERS
|
|
static int hrtimer = 1;
|
|
#endif
|
|
static int fake_buffer = 1;
|
|
|
|
module_param_array(index, int, NULL, 0444);
|
|
MODULE_PARM_DESC(index, "Index value for dummy soundcard.");
|
|
module_param_array(id, charp, NULL, 0444);
|
|
MODULE_PARM_DESC(id, "ID string for dummy soundcard.");
|
|
module_param_array(enable, bool, NULL, 0444);
|
|
MODULE_PARM_DESC(enable, "Enable this dummy soundcard.");
|
|
module_param_array(pcm_devs, int, NULL, 0444);
|
|
MODULE_PARM_DESC(pcm_devs, "PCM devices # (0-4) for dummy driver.");
|
|
module_param_array(pcm_substreams, int, NULL, 0444);
|
|
MODULE_PARM_DESC(pcm_substreams, "PCM substreams # (1-16) for dummy driver.");
|
|
//module_param_array(midi_devs, int, NULL, 0444);
|
|
//MODULE_PARM_DESC(midi_devs, "MIDI devices # (0-2) for dummy driver.");
|
|
module_param(fake_buffer, bool, 0444);
|
|
MODULE_PARM_DESC(fake_buffer, "Fake buffer allocations.");
|
|
#ifdef CONFIG_HIGH_RES_TIMERS
|
|
module_param(hrtimer, bool, 0644);
|
|
MODULE_PARM_DESC(hrtimer, "Use hrtimer as the timer source.");
|
|
#endif
|
|
|
|
static struct platform_device *devices[SNDRV_CARDS];
|
|
|
|
#define MIXER_ADDR_MASTER 0
|
|
#define MIXER_ADDR_LINE 1
|
|
#define MIXER_ADDR_MIC 2
|
|
#define MIXER_ADDR_SYNTH 3
|
|
#define MIXER_ADDR_CD 4
|
|
#define MIXER_ADDR_LAST 4
|
|
|
|
struct dummy_timer_ops {
|
|
int (*create)(struct snd_pcm_substream *);
|
|
void (*free)(struct snd_pcm_substream *);
|
|
int (*prepare)(struct snd_pcm_substream *);
|
|
int (*start)(struct snd_pcm_substream *);
|
|
int (*stop)(struct snd_pcm_substream *);
|
|
snd_pcm_uframes_t (*pointer)(struct snd_pcm_substream *);
|
|
};
|
|
|
|
struct snd_dummy {
|
|
struct snd_card *card;
|
|
struct snd_pcm *pcm;
|
|
spinlock_t mixer_lock;
|
|
int mixer_volume[MIXER_ADDR_LAST+1][2];
|
|
int capture_source[MIXER_ADDR_LAST+1][2];
|
|
const struct dummy_timer_ops *timer_ops;
|
|
};
|
|
|
|
/*
|
|
* system timer interface
|
|
*/
|
|
|
|
struct dummy_systimer_pcm {
|
|
spinlock_t lock;
|
|
struct timer_list timer;
|
|
unsigned long base_time;
|
|
unsigned int frac_pos; /* fractional sample position (based HZ) */
|
|
unsigned int frac_period_rest;
|
|
unsigned int frac_buffer_size; /* buffer_size * HZ */
|
|
unsigned int frac_period_size; /* period_size * HZ */
|
|
unsigned int rate;
|
|
int elapsed;
|
|
struct snd_pcm_substream *substream;
|
|
};
|
|
|
|
static void dummy_systimer_rearm(struct dummy_systimer_pcm *dpcm)
|
|
{
|
|
dpcm->timer.expires = jiffies +
|
|
(dpcm->frac_period_rest + dpcm->rate - 1) / dpcm->rate;
|
|
add_timer(&dpcm->timer);
|
|
}
|
|
|
|
static void dummy_systimer_update(struct dummy_systimer_pcm *dpcm)
|
|
{
|
|
unsigned long delta;
|
|
|
|
delta = jiffies - dpcm->base_time;
|
|
if (!delta)
|
|
return;
|
|
dpcm->base_time += delta;
|
|
delta *= dpcm->rate;
|
|
dpcm->frac_pos += delta;
|
|
while (dpcm->frac_pos >= dpcm->frac_buffer_size)
|
|
dpcm->frac_pos -= dpcm->frac_buffer_size;
|
|
while (dpcm->frac_period_rest <= delta) {
|
|
dpcm->elapsed++;
|
|
dpcm->frac_period_rest += dpcm->frac_period_size;
|
|
}
|
|
dpcm->frac_period_rest -= delta;
|
|
}
|
|
|
|
static int dummy_systimer_start(struct snd_pcm_substream *substream)
|
|
{
|
|
struct dummy_systimer_pcm *dpcm = substream->runtime->private_data;
|
|
spin_lock(&dpcm->lock);
|
|
dpcm->base_time = jiffies;
|
|
dummy_systimer_rearm(dpcm);
|
|
spin_unlock(&dpcm->lock);
|
|
return 0;
|
|
}
|
|
|
|
static int dummy_systimer_stop(struct snd_pcm_substream *substream)
|
|
{
|
|
struct dummy_systimer_pcm *dpcm = substream->runtime->private_data;
|
|
spin_lock(&dpcm->lock);
|
|
del_timer(&dpcm->timer);
|
|
spin_unlock(&dpcm->lock);
|
|
return 0;
|
|
}
|
|
|
|
static int dummy_systimer_prepare(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct dummy_systimer_pcm *dpcm = runtime->private_data;
|
|
|
|
dpcm->frac_pos = 0;
|
|
dpcm->rate = runtime->rate;
|
|
dpcm->frac_buffer_size = runtime->buffer_size * HZ;
|
|
dpcm->frac_period_size = runtime->period_size * HZ;
|
|
dpcm->frac_period_rest = dpcm->frac_period_size;
|
|
dpcm->elapsed = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void dummy_systimer_callback(unsigned long data)
|
|
{
|
|
struct dummy_systimer_pcm *dpcm = (struct dummy_systimer_pcm *)data;
|
|
unsigned long flags;
|
|
int elapsed = 0;
|
|
|
|
spin_lock_irqsave(&dpcm->lock, flags);
|
|
dummy_systimer_update(dpcm);
|
|
dummy_systimer_rearm(dpcm);
|
|
elapsed = dpcm->elapsed;
|
|
dpcm->elapsed = 0;
|
|
spin_unlock_irqrestore(&dpcm->lock, flags);
|
|
if (elapsed)
|
|
snd_pcm_period_elapsed(dpcm->substream);
|
|
}
|
|
|
|
static snd_pcm_uframes_t
|
|
dummy_systimer_pointer(struct snd_pcm_substream *substream)
|
|
{
|
|
struct dummy_systimer_pcm *dpcm = substream->runtime->private_data;
|
|
snd_pcm_uframes_t pos;
|
|
|
|
spin_lock(&dpcm->lock);
|
|
dummy_systimer_update(dpcm);
|
|
pos = dpcm->frac_pos / HZ;
|
|
spin_unlock(&dpcm->lock);
|
|
return pos;
|
|
}
|
|
|
|
static int dummy_systimer_create(struct snd_pcm_substream *substream)
|
|
{
|
|
struct dummy_systimer_pcm *dpcm;
|
|
|
|
dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL);
|
|
if (!dpcm)
|
|
return -ENOMEM;
|
|
substream->runtime->private_data = dpcm;
|
|
init_timer(&dpcm->timer);
|
|
dpcm->timer.data = (unsigned long) dpcm;
|
|
dpcm->timer.function = dummy_systimer_callback;
|
|
spin_lock_init(&dpcm->lock);
|
|
dpcm->substream = substream;
|
|
return 0;
|
|
}
|
|
|
|
static void dummy_systimer_free(struct snd_pcm_substream *substream)
|
|
{
|
|
kfree(substream->runtime->private_data);
|
|
}
|
|
|
|
static struct dummy_timer_ops dummy_systimer_ops = {
|
|
.create = dummy_systimer_create,
|
|
.free = dummy_systimer_free,
|
|
.prepare = dummy_systimer_prepare,
|
|
.start = dummy_systimer_start,
|
|
.stop = dummy_systimer_stop,
|
|
.pointer = dummy_systimer_pointer,
|
|
};
|
|
|
|
#ifdef CONFIG_HIGH_RES_TIMERS
|
|
/*
|
|
* hrtimer interface
|
|
*/
|
|
|
|
struct dummy_hrtimer_pcm {
|
|
ktime_t base_time;
|
|
ktime_t period_time;
|
|
atomic_t running;
|
|
struct hrtimer timer;
|
|
struct tasklet_struct tasklet;
|
|
struct snd_pcm_substream *substream;
|
|
};
|
|
|
|
static void dummy_hrtimer_pcm_elapsed(unsigned long priv)
|
|
{
|
|
struct dummy_hrtimer_pcm *dpcm = (struct dummy_hrtimer_pcm *)priv;
|
|
if (atomic_read(&dpcm->running))
|
|
snd_pcm_period_elapsed(dpcm->substream);
|
|
}
|
|
|
|
static enum hrtimer_restart dummy_hrtimer_callback(struct hrtimer *timer)
|
|
{
|
|
struct dummy_hrtimer_pcm *dpcm;
|
|
|
|
dpcm = container_of(timer, struct dummy_hrtimer_pcm, timer);
|
|
if (!atomic_read(&dpcm->running))
|
|
return HRTIMER_NORESTART;
|
|
tasklet_schedule(&dpcm->tasklet);
|
|
hrtimer_forward_now(timer, dpcm->period_time);
|
|
return HRTIMER_RESTART;
|
|
}
|
|
|
|
static int dummy_hrtimer_start(struct snd_pcm_substream *substream)
|
|
{
|
|
struct dummy_hrtimer_pcm *dpcm = substream->runtime->private_data;
|
|
|
|
dpcm->base_time = hrtimer_cb_get_time(&dpcm->timer);
|
|
hrtimer_start(&dpcm->timer, dpcm->period_time, HRTIMER_MODE_REL);
|
|
atomic_set(&dpcm->running, 1);
|
|
return 0;
|
|
}
|
|
|
|
static int dummy_hrtimer_stop(struct snd_pcm_substream *substream)
|
|
{
|
|
struct dummy_hrtimer_pcm *dpcm = substream->runtime->private_data;
|
|
|
|
atomic_set(&dpcm->running, 0);
|
|
hrtimer_cancel(&dpcm->timer);
|
|
return 0;
|
|
}
|
|
|
|
static inline void dummy_hrtimer_sync(struct dummy_hrtimer_pcm *dpcm)
|
|
{
|
|
tasklet_kill(&dpcm->tasklet);
|
|
}
|
|
|
|
static snd_pcm_uframes_t
|
|
dummy_hrtimer_pointer(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct dummy_hrtimer_pcm *dpcm = runtime->private_data;
|
|
u64 delta;
|
|
u32 pos;
|
|
|
|
delta = ktime_us_delta(hrtimer_cb_get_time(&dpcm->timer),
|
|
dpcm->base_time);
|
|
delta = div_u64(delta * runtime->rate + 999999, 1000000);
|
|
div_u64_rem(delta, runtime->buffer_size, &pos);
|
|
return pos;
|
|
}
|
|
|
|
static int dummy_hrtimer_prepare(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
struct dummy_hrtimer_pcm *dpcm = runtime->private_data;
|
|
unsigned int period, rate;
|
|
long sec;
|
|
unsigned long nsecs;
|
|
|
|
dummy_hrtimer_sync(dpcm);
|
|
period = runtime->period_size;
|
|
rate = runtime->rate;
|
|
sec = period / rate;
|
|
period %= rate;
|
|
nsecs = div_u64((u64)period * 1000000000UL + rate - 1, rate);
|
|
dpcm->period_time = ktime_set(sec, nsecs);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dummy_hrtimer_create(struct snd_pcm_substream *substream)
|
|
{
|
|
struct dummy_hrtimer_pcm *dpcm;
|
|
|
|
dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL);
|
|
if (!dpcm)
|
|
return -ENOMEM;
|
|
substream->runtime->private_data = dpcm;
|
|
hrtimer_init(&dpcm->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
|
|
dpcm->timer.function = dummy_hrtimer_callback;
|
|
dpcm->substream = substream;
|
|
atomic_set(&dpcm->running, 0);
|
|
tasklet_init(&dpcm->tasklet, dummy_hrtimer_pcm_elapsed,
|
|
(unsigned long)dpcm);
|
|
return 0;
|
|
}
|
|
|
|
static void dummy_hrtimer_free(struct snd_pcm_substream *substream)
|
|
{
|
|
struct dummy_hrtimer_pcm *dpcm = substream->runtime->private_data;
|
|
dummy_hrtimer_sync(dpcm);
|
|
kfree(dpcm);
|
|
}
|
|
|
|
static struct dummy_timer_ops dummy_hrtimer_ops = {
|
|
.create = dummy_hrtimer_create,
|
|
.free = dummy_hrtimer_free,
|
|
.prepare = dummy_hrtimer_prepare,
|
|
.start = dummy_hrtimer_start,
|
|
.stop = dummy_hrtimer_stop,
|
|
.pointer = dummy_hrtimer_pointer,
|
|
};
|
|
|
|
#endif /* CONFIG_HIGH_RES_TIMERS */
|
|
|
|
/*
|
|
* PCM interface
|
|
*/
|
|
|
|
static int dummy_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
|
|
{
|
|
struct snd_dummy *dummy = snd_pcm_substream_chip(substream);
|
|
|
|
switch (cmd) {
|
|
case SNDRV_PCM_TRIGGER_START:
|
|
case SNDRV_PCM_TRIGGER_RESUME:
|
|
return dummy->timer_ops->start(substream);
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
|
return dummy->timer_ops->stop(substream);
|
|
}
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int dummy_pcm_prepare(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_dummy *dummy = snd_pcm_substream_chip(substream);
|
|
|
|
return dummy->timer_ops->prepare(substream);
|
|
}
|
|
|
|
static snd_pcm_uframes_t dummy_pcm_pointer(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_dummy *dummy = snd_pcm_substream_chip(substream);
|
|
|
|
return dummy->timer_ops->pointer(substream);
|
|
}
|
|
|
|
static struct snd_pcm_hardware dummy_pcm_hardware = {
|
|
.info = (SNDRV_PCM_INFO_MMAP |
|
|
SNDRV_PCM_INFO_INTERLEAVED |
|
|
SNDRV_PCM_INFO_RESUME |
|
|
SNDRV_PCM_INFO_MMAP_VALID),
|
|
.formats = USE_FORMATS,
|
|
.rates = USE_RATE,
|
|
.rate_min = USE_RATE_MIN,
|
|
.rate_max = USE_RATE_MAX,
|
|
.channels_min = USE_CHANNELS_MIN,
|
|
.channels_max = USE_CHANNELS_MAX,
|
|
.buffer_bytes_max = MAX_BUFFER_SIZE,
|
|
.period_bytes_min = 64,
|
|
.period_bytes_max = MAX_PERIOD_SIZE,
|
|
.periods_min = USE_PERIODS_MIN,
|
|
.periods_max = USE_PERIODS_MAX,
|
|
.fifo_size = 0,
|
|
};
|
|
|
|
static int dummy_pcm_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *hw_params)
|
|
{
|
|
if (fake_buffer) {
|
|
/* runtime->dma_bytes has to be set manually to allow mmap */
|
|
substream->runtime->dma_bytes = params_buffer_bytes(hw_params);
|
|
return 0;
|
|
}
|
|
return snd_pcm_lib_malloc_pages(substream,
|
|
params_buffer_bytes(hw_params));
|
|
}
|
|
|
|
static int dummy_pcm_hw_free(struct snd_pcm_substream *substream)
|
|
{
|
|
if (fake_buffer)
|
|
return 0;
|
|
return snd_pcm_lib_free_pages(substream);
|
|
}
|
|
|
|
static int dummy_pcm_open(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_dummy *dummy = snd_pcm_substream_chip(substream);
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
|
int err;
|
|
|
|
dummy->timer_ops = &dummy_systimer_ops;
|
|
#ifdef CONFIG_HIGH_RES_TIMERS
|
|
if (hrtimer)
|
|
dummy->timer_ops = &dummy_hrtimer_ops;
|
|
#endif
|
|
|
|
err = dummy->timer_ops->create(substream);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
runtime->hw = dummy_pcm_hardware;
|
|
if (substream->pcm->device & 1) {
|
|
runtime->hw.info &= ~SNDRV_PCM_INFO_INTERLEAVED;
|
|
runtime->hw.info |= SNDRV_PCM_INFO_NONINTERLEAVED;
|
|
}
|
|
if (substream->pcm->device & 2)
|
|
runtime->hw.info &= ~(SNDRV_PCM_INFO_MMAP |
|
|
SNDRV_PCM_INFO_MMAP_VALID);
|
|
|
|
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
|
err = add_playback_constraints(substream->runtime);
|
|
else
|
|
err = add_capture_constraints(substream->runtime);
|
|
if (err < 0) {
|
|
dummy->timer_ops->free(substream);
|
|
return err;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int dummy_pcm_close(struct snd_pcm_substream *substream)
|
|
{
|
|
struct snd_dummy *dummy = snd_pcm_substream_chip(substream);
|
|
dummy->timer_ops->free(substream);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* dummy buffer handling
|
|
*/
|
|
|
|
static void *dummy_page[2];
|
|
|
|
static void free_fake_buffer(void)
|
|
{
|
|
if (fake_buffer) {
|
|
int i;
|
|
for (i = 0; i < 2; i++)
|
|
if (dummy_page[i]) {
|
|
free_page((unsigned long)dummy_page[i]);
|
|
dummy_page[i] = NULL;
|
|
}
|
|
}
|
|
}
|
|
|
|
static int alloc_fake_buffer(void)
|
|
{
|
|
int i;
|
|
|
|
if (!fake_buffer)
|
|
return 0;
|
|
for (i = 0; i < 2; i++) {
|
|
dummy_page[i] = (void *)get_zeroed_page(GFP_KERNEL);
|
|
if (!dummy_page[i]) {
|
|
free_fake_buffer();
|
|
return -ENOMEM;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int dummy_pcm_copy(struct snd_pcm_substream *substream,
|
|
int channel, snd_pcm_uframes_t pos,
|
|
void __user *dst, snd_pcm_uframes_t count)
|
|
{
|
|
return 0; /* do nothing */
|
|
}
|
|
|
|
static int dummy_pcm_silence(struct snd_pcm_substream *substream,
|
|
int channel, snd_pcm_uframes_t pos,
|
|
snd_pcm_uframes_t count)
|
|
{
|
|
return 0; /* do nothing */
|
|
}
|
|
|
|
static struct page *dummy_pcm_page(struct snd_pcm_substream *substream,
|
|
unsigned long offset)
|
|
{
|
|
return virt_to_page(dummy_page[substream->stream]); /* the same page */
|
|
}
|
|
|
|
static struct snd_pcm_ops dummy_pcm_ops = {
|
|
.open = dummy_pcm_open,
|
|
.close = dummy_pcm_close,
|
|
.ioctl = snd_pcm_lib_ioctl,
|
|
.hw_params = dummy_pcm_hw_params,
|
|
.hw_free = dummy_pcm_hw_free,
|
|
.prepare = dummy_pcm_prepare,
|
|
.trigger = dummy_pcm_trigger,
|
|
.pointer = dummy_pcm_pointer,
|
|
};
|
|
|
|
static struct snd_pcm_ops dummy_pcm_ops_no_buf = {
|
|
.open = dummy_pcm_open,
|
|
.close = dummy_pcm_close,
|
|
.ioctl = snd_pcm_lib_ioctl,
|
|
.hw_params = dummy_pcm_hw_params,
|
|
.hw_free = dummy_pcm_hw_free,
|
|
.prepare = dummy_pcm_prepare,
|
|
.trigger = dummy_pcm_trigger,
|
|
.pointer = dummy_pcm_pointer,
|
|
.copy = dummy_pcm_copy,
|
|
.silence = dummy_pcm_silence,
|
|
.page = dummy_pcm_page,
|
|
};
|
|
|
|
static int __devinit snd_card_dummy_pcm(struct snd_dummy *dummy, int device,
|
|
int substreams)
|
|
{
|
|
struct snd_pcm *pcm;
|
|
struct snd_pcm_ops *ops;
|
|
int err;
|
|
|
|
err = snd_pcm_new(dummy->card, "Dummy PCM", device,
|
|
substreams, substreams, &pcm);
|
|
if (err < 0)
|
|
return err;
|
|
dummy->pcm = pcm;
|
|
if (fake_buffer)
|
|
ops = &dummy_pcm_ops_no_buf;
|
|
else
|
|
ops = &dummy_pcm_ops;
|
|
snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, ops);
|
|
snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, ops);
|
|
pcm->private_data = dummy;
|
|
pcm->info_flags = 0;
|
|
strcpy(pcm->name, "Dummy PCM");
|
|
if (!fake_buffer) {
|
|
snd_pcm_lib_preallocate_pages_for_all(pcm,
|
|
SNDRV_DMA_TYPE_CONTINUOUS,
|
|
snd_dma_continuous_data(GFP_KERNEL),
|
|
0, 64*1024);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* mixer interface
|
|
*/
|
|
|
|
#define DUMMY_VOLUME(xname, xindex, addr) \
|
|
{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \
|
|
.access = SNDRV_CTL_ELEM_ACCESS_READWRITE | SNDRV_CTL_ELEM_ACCESS_TLV_READ, \
|
|
.name = xname, .index = xindex, \
|
|
.info = snd_dummy_volume_info, \
|
|
.get = snd_dummy_volume_get, .put = snd_dummy_volume_put, \
|
|
.private_value = addr, \
|
|
.tlv = { .p = db_scale_dummy } }
|
|
|
|
static int snd_dummy_volume_info(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_info *uinfo)
|
|
{
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
uinfo->count = 2;
|
|
uinfo->value.integer.min = -50;
|
|
uinfo->value.integer.max = 100;
|
|
return 0;
|
|
}
|
|
|
|
static int snd_dummy_volume_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_dummy *dummy = snd_kcontrol_chip(kcontrol);
|
|
int addr = kcontrol->private_value;
|
|
|
|
spin_lock_irq(&dummy->mixer_lock);
|
|
ucontrol->value.integer.value[0] = dummy->mixer_volume[addr][0];
|
|
ucontrol->value.integer.value[1] = dummy->mixer_volume[addr][1];
|
|
spin_unlock_irq(&dummy->mixer_lock);
|
|
return 0;
|
|
}
|
|
|
|
static int snd_dummy_volume_put(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_dummy *dummy = snd_kcontrol_chip(kcontrol);
|
|
int change, addr = kcontrol->private_value;
|
|
int left, right;
|
|
|
|
left = ucontrol->value.integer.value[0];
|
|
if (left < -50)
|
|
left = -50;
|
|
if (left > 100)
|
|
left = 100;
|
|
right = ucontrol->value.integer.value[1];
|
|
if (right < -50)
|
|
right = -50;
|
|
if (right > 100)
|
|
right = 100;
|
|
spin_lock_irq(&dummy->mixer_lock);
|
|
change = dummy->mixer_volume[addr][0] != left ||
|
|
dummy->mixer_volume[addr][1] != right;
|
|
dummy->mixer_volume[addr][0] = left;
|
|
dummy->mixer_volume[addr][1] = right;
|
|
spin_unlock_irq(&dummy->mixer_lock);
|
|
return change;
|
|
}
|
|
|
|
static const DECLARE_TLV_DB_SCALE(db_scale_dummy, -4500, 30, 0);
|
|
|
|
#define DUMMY_CAPSRC(xname, xindex, addr) \
|
|
{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
|
|
.info = snd_dummy_capsrc_info, \
|
|
.get = snd_dummy_capsrc_get, .put = snd_dummy_capsrc_put, \
|
|
.private_value = addr }
|
|
|
|
#define snd_dummy_capsrc_info snd_ctl_boolean_stereo_info
|
|
|
|
static int snd_dummy_capsrc_get(struct snd_kcontrol *kcontrol,
|
|
struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_dummy *dummy = snd_kcontrol_chip(kcontrol);
|
|
int addr = kcontrol->private_value;
|
|
|
|
spin_lock_irq(&dummy->mixer_lock);
|
|
ucontrol->value.integer.value[0] = dummy->capture_source[addr][0];
|
|
ucontrol->value.integer.value[1] = dummy->capture_source[addr][1];
|
|
spin_unlock_irq(&dummy->mixer_lock);
|
|
return 0;
|
|
}
|
|
|
|
static int snd_dummy_capsrc_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
|
|
{
|
|
struct snd_dummy *dummy = snd_kcontrol_chip(kcontrol);
|
|
int change, addr = kcontrol->private_value;
|
|
int left, right;
|
|
|
|
left = ucontrol->value.integer.value[0] & 1;
|
|
right = ucontrol->value.integer.value[1] & 1;
|
|
spin_lock_irq(&dummy->mixer_lock);
|
|
change = dummy->capture_source[addr][0] != left &&
|
|
dummy->capture_source[addr][1] != right;
|
|
dummy->capture_source[addr][0] = left;
|
|
dummy->capture_source[addr][1] = right;
|
|
spin_unlock_irq(&dummy->mixer_lock);
|
|
return change;
|
|
}
|
|
|
|
static struct snd_kcontrol_new snd_dummy_controls[] = {
|
|
DUMMY_VOLUME("Master Volume", 0, MIXER_ADDR_MASTER),
|
|
DUMMY_CAPSRC("Master Capture Switch", 0, MIXER_ADDR_MASTER),
|
|
DUMMY_VOLUME("Synth Volume", 0, MIXER_ADDR_SYNTH),
|
|
DUMMY_CAPSRC("Synth Capture Switch", 0, MIXER_ADDR_SYNTH),
|
|
DUMMY_VOLUME("Line Volume", 0, MIXER_ADDR_LINE),
|
|
DUMMY_CAPSRC("Line Capture Switch", 0, MIXER_ADDR_LINE),
|
|
DUMMY_VOLUME("Mic Volume", 0, MIXER_ADDR_MIC),
|
|
DUMMY_CAPSRC("Mic Capture Switch", 0, MIXER_ADDR_MIC),
|
|
DUMMY_VOLUME("CD Volume", 0, MIXER_ADDR_CD),
|
|
DUMMY_CAPSRC("CD Capture Switch", 0, MIXER_ADDR_CD)
|
|
};
|
|
|
|
static int __devinit snd_card_dummy_new_mixer(struct snd_dummy *dummy)
|
|
{
|
|
struct snd_card *card = dummy->card;
|
|
unsigned int idx;
|
|
int err;
|
|
|
|
spin_lock_init(&dummy->mixer_lock);
|
|
strcpy(card->mixername, "Dummy Mixer");
|
|
|
|
for (idx = 0; idx < ARRAY_SIZE(snd_dummy_controls); idx++) {
|
|
err = snd_ctl_add(card, snd_ctl_new1(&snd_dummy_controls[idx], dummy));
|
|
if (err < 0)
|
|
return err;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
#if defined(CONFIG_SND_DEBUG) && defined(CONFIG_PROC_FS)
|
|
/*
|
|
* proc interface
|
|
*/
|
|
static void print_formats(struct snd_info_buffer *buffer)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < SNDRV_PCM_FORMAT_LAST; i++) {
|
|
if (dummy_pcm_hardware.formats & (1ULL << i))
|
|
snd_iprintf(buffer, " %s", snd_pcm_format_name(i));
|
|
}
|
|
}
|
|
|
|
static void print_rates(struct snd_info_buffer *buffer)
|
|
{
|
|
static int rates[] = {
|
|
5512, 8000, 11025, 16000, 22050, 32000, 44100, 48000,
|
|
64000, 88200, 96000, 176400, 192000,
|
|
};
|
|
int i;
|
|
|
|
if (dummy_pcm_hardware.rates & SNDRV_PCM_RATE_CONTINUOUS)
|
|
snd_iprintf(buffer, " continuous");
|
|
if (dummy_pcm_hardware.rates & SNDRV_PCM_RATE_KNOT)
|
|
snd_iprintf(buffer, " knot");
|
|
for (i = 0; i < ARRAY_SIZE(rates); i++)
|
|
if (dummy_pcm_hardware.rates & (1 << i))
|
|
snd_iprintf(buffer, " %d", rates[i]);
|
|
}
|
|
|
|
#define get_dummy_int_ptr(ofs) \
|
|
(unsigned int *)((char *)&dummy_pcm_hardware + (ofs))
|
|
#define get_dummy_ll_ptr(ofs) \
|
|
(unsigned long long *)((char *)&dummy_pcm_hardware + (ofs))
|
|
|
|
struct dummy_hw_field {
|
|
const char *name;
|
|
const char *format;
|
|
unsigned int offset;
|
|
unsigned int size;
|
|
};
|
|
#define FIELD_ENTRY(item, fmt) { \
|
|
.name = #item, \
|
|
.format = fmt, \
|
|
.offset = offsetof(struct snd_pcm_hardware, item), \
|
|
.size = sizeof(dummy_pcm_hardware.item) }
|
|
|
|
static struct dummy_hw_field fields[] = {
|
|
FIELD_ENTRY(formats, "%#llx"),
|
|
FIELD_ENTRY(rates, "%#x"),
|
|
FIELD_ENTRY(rate_min, "%d"),
|
|
FIELD_ENTRY(rate_max, "%d"),
|
|
FIELD_ENTRY(channels_min, "%d"),
|
|
FIELD_ENTRY(channels_max, "%d"),
|
|
FIELD_ENTRY(buffer_bytes_max, "%ld"),
|
|
FIELD_ENTRY(period_bytes_min, "%ld"),
|
|
FIELD_ENTRY(period_bytes_max, "%ld"),
|
|
FIELD_ENTRY(periods_min, "%d"),
|
|
FIELD_ENTRY(periods_max, "%d"),
|
|
};
|
|
|
|
static void dummy_proc_read(struct snd_info_entry *entry,
|
|
struct snd_info_buffer *buffer)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(fields); i++) {
|
|
snd_iprintf(buffer, "%s ", fields[i].name);
|
|
if (fields[i].size == sizeof(int))
|
|
snd_iprintf(buffer, fields[i].format,
|
|
*get_dummy_int_ptr(fields[i].offset));
|
|
else
|
|
snd_iprintf(buffer, fields[i].format,
|
|
*get_dummy_ll_ptr(fields[i].offset));
|
|
if (!strcmp(fields[i].name, "formats"))
|
|
print_formats(buffer);
|
|
else if (!strcmp(fields[i].name, "rates"))
|
|
print_rates(buffer);
|
|
snd_iprintf(buffer, "\n");
|
|
}
|
|
}
|
|
|
|
static void dummy_proc_write(struct snd_info_entry *entry,
|
|
struct snd_info_buffer *buffer)
|
|
{
|
|
char line[64];
|
|
|
|
while (!snd_info_get_line(buffer, line, sizeof(line))) {
|
|
char item[20];
|
|
const char *ptr;
|
|
unsigned long long val;
|
|
int i;
|
|
|
|
ptr = snd_info_get_str(item, line, sizeof(item));
|
|
for (i = 0; i < ARRAY_SIZE(fields); i++) {
|
|
if (!strcmp(item, fields[i].name))
|
|
break;
|
|
}
|
|
if (i >= ARRAY_SIZE(fields))
|
|
continue;
|
|
snd_info_get_str(item, ptr, sizeof(item));
|
|
if (strict_strtoull(item, 0, &val))
|
|
continue;
|
|
if (fields[i].size == sizeof(int))
|
|
*get_dummy_int_ptr(fields[i].offset) = val;
|
|
else
|
|
*get_dummy_ll_ptr(fields[i].offset) = val;
|
|
}
|
|
}
|
|
|
|
static void __devinit dummy_proc_init(struct snd_dummy *chip)
|
|
{
|
|
struct snd_info_entry *entry;
|
|
|
|
if (!snd_card_proc_new(chip->card, "dummy_pcm", &entry)) {
|
|
snd_info_set_text_ops(entry, chip, dummy_proc_read);
|
|
entry->c.text.write = dummy_proc_write;
|
|
entry->mode |= S_IWUSR;
|
|
}
|
|
}
|
|
#else
|
|
#define dummy_proc_init(x)
|
|
#endif /* CONFIG_SND_DEBUG && CONFIG_PROC_FS */
|
|
|
|
static int __devinit snd_dummy_probe(struct platform_device *devptr)
|
|
{
|
|
struct snd_card *card;
|
|
struct snd_dummy *dummy;
|
|
int idx, err;
|
|
int dev = devptr->id;
|
|
|
|
err = snd_card_create(index[dev], id[dev], THIS_MODULE,
|
|
sizeof(struct snd_dummy), &card);
|
|
if (err < 0)
|
|
return err;
|
|
dummy = card->private_data;
|
|
dummy->card = card;
|
|
for (idx = 0; idx < MAX_PCM_DEVICES && idx < pcm_devs[dev]; idx++) {
|
|
if (pcm_substreams[dev] < 1)
|
|
pcm_substreams[dev] = 1;
|
|
if (pcm_substreams[dev] > MAX_PCM_SUBSTREAMS)
|
|
pcm_substreams[dev] = MAX_PCM_SUBSTREAMS;
|
|
err = snd_card_dummy_pcm(dummy, idx, pcm_substreams[dev]);
|
|
if (err < 0)
|
|
goto __nodev;
|
|
}
|
|
err = snd_card_dummy_new_mixer(dummy);
|
|
if (err < 0)
|
|
goto __nodev;
|
|
strcpy(card->driver, "Dummy");
|
|
strcpy(card->shortname, "Dummy");
|
|
sprintf(card->longname, "Dummy %i", dev + 1);
|
|
|
|
dummy_proc_init(dummy);
|
|
|
|
snd_card_set_dev(card, &devptr->dev);
|
|
|
|
err = snd_card_register(card);
|
|
if (err == 0) {
|
|
platform_set_drvdata(devptr, card);
|
|
return 0;
|
|
}
|
|
__nodev:
|
|
snd_card_free(card);
|
|
return err;
|
|
}
|
|
|
|
static int __devexit snd_dummy_remove(struct platform_device *devptr)
|
|
{
|
|
snd_card_free(platform_get_drvdata(devptr));
|
|
platform_set_drvdata(devptr, NULL);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int snd_dummy_suspend(struct platform_device *pdev, pm_message_t state)
|
|
{
|
|
struct snd_card *card = platform_get_drvdata(pdev);
|
|
struct snd_dummy *dummy = card->private_data;
|
|
|
|
snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
|
|
snd_pcm_suspend_all(dummy->pcm);
|
|
return 0;
|
|
}
|
|
|
|
static int snd_dummy_resume(struct platform_device *pdev)
|
|
{
|
|
struct snd_card *card = platform_get_drvdata(pdev);
|
|
|
|
snd_power_change_state(card, SNDRV_CTL_POWER_D0);
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
#define SND_DUMMY_DRIVER "snd_dummy"
|
|
|
|
static struct platform_driver snd_dummy_driver = {
|
|
.probe = snd_dummy_probe,
|
|
.remove = __devexit_p(snd_dummy_remove),
|
|
#ifdef CONFIG_PM
|
|
.suspend = snd_dummy_suspend,
|
|
.resume = snd_dummy_resume,
|
|
#endif
|
|
.driver = {
|
|
.name = SND_DUMMY_DRIVER
|
|
},
|
|
};
|
|
|
|
static void snd_dummy_unregister_all(void)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(devices); ++i)
|
|
platform_device_unregister(devices[i]);
|
|
platform_driver_unregister(&snd_dummy_driver);
|
|
free_fake_buffer();
|
|
}
|
|
|
|
static int __init alsa_card_dummy_init(void)
|
|
{
|
|
int i, cards, err;
|
|
|
|
err = platform_driver_register(&snd_dummy_driver);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = alloc_fake_buffer();
|
|
if (err < 0) {
|
|
platform_driver_unregister(&snd_dummy_driver);
|
|
return err;
|
|
}
|
|
|
|
cards = 0;
|
|
for (i = 0; i < SNDRV_CARDS; i++) {
|
|
struct platform_device *device;
|
|
if (! enable[i])
|
|
continue;
|
|
device = platform_device_register_simple(SND_DUMMY_DRIVER,
|
|
i, NULL, 0);
|
|
if (IS_ERR(device))
|
|
continue;
|
|
if (!platform_get_drvdata(device)) {
|
|
platform_device_unregister(device);
|
|
continue;
|
|
}
|
|
devices[i] = device;
|
|
cards++;
|
|
}
|
|
if (!cards) {
|
|
#ifdef MODULE
|
|
printk(KERN_ERR "Dummy soundcard not found or device busy\n");
|
|
#endif
|
|
snd_dummy_unregister_all();
|
|
return -ENODEV;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void __exit alsa_card_dummy_exit(void)
|
|
{
|
|
snd_dummy_unregister_all();
|
|
}
|
|
|
|
module_init(alsa_card_dummy_init)
|
|
module_exit(alsa_card_dummy_exit)
|