| 1 | /* | 
|---|
| 2 | *  Dummy soundcard | 
|---|
| 3 | *  Copyright (c) by Jaroslav Kysela <perex@perex.cz> | 
|---|
| 4 | * | 
|---|
| 5 | *   This program is free software; you can redistribute it and/or modify | 
|---|
| 6 | *   it under the terms of the GNU General Public License as published by | 
|---|
| 7 | *   the Free Software Foundation; either version 2 of the License, or | 
|---|
| 8 | *   (at your option) any later version. | 
|---|
| 9 | * | 
|---|
| 10 | *   This program is distributed in the hope that it will be useful, | 
|---|
| 11 | *   but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|---|
| 12 | *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|---|
| 13 | *   GNU General Public License for more details. | 
|---|
| 14 | * | 
|---|
| 15 | *   You should have received a copy of the GNU General Public License | 
|---|
| 16 | *   along with this program; if not, write to the Free Software | 
|---|
| 17 | *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA | 
|---|
| 18 | * | 
|---|
| 19 | */ | 
|---|
| 20 |  | 
|---|
| 21 | #include <linux/init.h> | 
|---|
| 22 | #include <linux/err.h> | 
|---|
| 23 | #include <linux/platform_device.h> | 
|---|
| 24 | #include <linux/jiffies.h> | 
|---|
| 25 | #include <linux/slab.h> | 
|---|
| 26 | #include <linux/time.h> | 
|---|
| 27 | #include <linux/wait.h> | 
|---|
| 28 | #include <linux/hrtimer.h> | 
|---|
| 29 | #include <linux/math64.h> | 
|---|
| 30 | #include <linux/moduleparam.h> | 
|---|
| 31 | #include <sound/core.h> | 
|---|
| 32 | #include <sound/control.h> | 
|---|
| 33 | #include <sound/tlv.h> | 
|---|
| 34 | #include <sound/pcm.h> | 
|---|
| 35 | #include <sound/rawmidi.h> | 
|---|
| 36 | #include <sound/info.h> | 
|---|
| 37 | #include <sound/initval.h> | 
|---|
| 38 |  | 
|---|
| 39 | MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>"); | 
|---|
| 40 | MODULE_DESCRIPTION("Dummy soundcard (/dev/null)"); | 
|---|
| 41 | MODULE_LICENSE("GPL"); | 
|---|
| 42 | MODULE_SUPPORTED_DEVICE("{{ALSA,Dummy soundcard}}"); | 
|---|
| 43 |  | 
|---|
| 44 | #define MAX_PCM_DEVICES         4 | 
|---|
| 45 | #define MAX_PCM_SUBSTREAMS      128 | 
|---|
| 46 | #define MAX_MIDI_DEVICES        2 | 
|---|
| 47 |  | 
|---|
| 48 | /* defaults */ | 
|---|
| 49 | #define MAX_BUFFER_SIZE         (64*1024) | 
|---|
| 50 | #define MIN_PERIOD_SIZE         64 | 
|---|
| 51 | #define MAX_PERIOD_SIZE         MAX_BUFFER_SIZE | 
|---|
| 52 | #define USE_FORMATS             (SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE) | 
|---|
| 53 | #define USE_RATE                SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000 | 
|---|
| 54 | #define USE_RATE_MIN            5500 | 
|---|
| 55 | #define USE_RATE_MAX            48000 | 
|---|
| 56 | #define USE_CHANNELS_MIN        1 | 
|---|
| 57 | #define USE_CHANNELS_MAX        2 | 
|---|
| 58 | #define USE_PERIODS_MIN         1 | 
|---|
| 59 | #define USE_PERIODS_MAX         1024 | 
|---|
| 60 |  | 
|---|
| 61 | static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;      /* Index 0-MAX */ | 
|---|
| 62 | static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;       /* ID for this card */ | 
|---|
| 63 | static int enable[SNDRV_CARDS] = {1, [1 ... (SNDRV_CARDS - 1)] = 0}; | 
|---|
| 64 | static char *model[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = NULL}; | 
|---|
| 65 | static int pcm_devs[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 1}; | 
|---|
| 66 | static int pcm_substreams[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 8}; | 
|---|
| 67 | //static int midi_devs[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 2}; | 
|---|
| 68 | #ifdef CONFIG_HIGH_RES_TIMERS | 
|---|
| 69 | static int hrtimer = 1; | 
|---|
| 70 | #endif | 
|---|
| 71 | static int fake_buffer = 1; | 
|---|
| 72 |  | 
|---|
| 73 | module_param_array(index, int, NULL, 0444); | 
|---|
| 74 | MODULE_PARM_DESC(index, "Index value for dummy soundcard."); | 
|---|
| 75 | module_param_array(id, charp, NULL, 0444); | 
|---|
| 76 | MODULE_PARM_DESC(id, "ID string for dummy soundcard."); | 
|---|
| 77 | module_param_array(enable, bool, NULL, 0444); | 
|---|
| 78 | MODULE_PARM_DESC(enable, "Enable this dummy soundcard."); | 
|---|
| 79 | module_param_array(model, charp, NULL, 0444); | 
|---|
| 80 | MODULE_PARM_DESC(model, "Soundcard model."); | 
|---|
| 81 | module_param_array(pcm_devs, int, NULL, 0444); | 
|---|
| 82 | MODULE_PARM_DESC(pcm_devs, "PCM devices # (0-4) for dummy driver."); | 
|---|
| 83 | module_param_array(pcm_substreams, int, NULL, 0444); | 
|---|
| 84 | MODULE_PARM_DESC(pcm_substreams, "PCM substreams # (1-128) for dummy driver."); | 
|---|
| 85 | //module_param_array(midi_devs, int, NULL, 0444); | 
|---|
| 86 | //MODULE_PARM_DESC(midi_devs, "MIDI devices # (0-2) for dummy driver."); | 
|---|
| 87 | module_param(fake_buffer, bool, 0444); | 
|---|
| 88 | MODULE_PARM_DESC(fake_buffer, "Fake buffer allocations."); | 
|---|
| 89 | #ifdef CONFIG_HIGH_RES_TIMERS | 
|---|
| 90 | module_param(hrtimer, bool, 0644); | 
|---|
| 91 | MODULE_PARM_DESC(hrtimer, "Use hrtimer as the timer source."); | 
|---|
| 92 | #endif | 
|---|
| 93 |  | 
|---|
| 94 | static struct platform_device *devices[SNDRV_CARDS]; | 
|---|
| 95 |  | 
|---|
| 96 | #define MIXER_ADDR_MASTER       0 | 
|---|
| 97 | #define MIXER_ADDR_LINE         1 | 
|---|
| 98 | #define MIXER_ADDR_MIC          2 | 
|---|
| 99 | #define MIXER_ADDR_SYNTH        3 | 
|---|
| 100 | #define MIXER_ADDR_CD           4 | 
|---|
| 101 | #define MIXER_ADDR_LAST         4 | 
|---|
| 102 |  | 
|---|
| 103 | struct dummy_timer_ops { | 
|---|
| 104 | int (*create)(struct snd_pcm_substream *); | 
|---|
| 105 | void (*free)(struct snd_pcm_substream *); | 
|---|
| 106 | int (*prepare)(struct snd_pcm_substream *); | 
|---|
| 107 | int (*start)(struct snd_pcm_substream *); | 
|---|
| 108 | int (*stop)(struct snd_pcm_substream *); | 
|---|
| 109 | snd_pcm_uframes_t (*pointer)(struct snd_pcm_substream *); | 
|---|
| 110 | }; | 
|---|
| 111 |  | 
|---|
| 112 | struct dummy_model { | 
|---|
| 113 | const char *name; | 
|---|
| 114 | int (*playback_constraints)(struct snd_pcm_runtime *runtime); | 
|---|
| 115 | int (*capture_constraints)(struct snd_pcm_runtime *runtime); | 
|---|
| 116 | u64 formats; | 
|---|
| 117 | size_t buffer_bytes_max; | 
|---|
| 118 | size_t period_bytes_min; | 
|---|
| 119 | size_t period_bytes_max; | 
|---|
| 120 | unsigned int periods_min; | 
|---|
| 121 | unsigned int periods_max; | 
|---|
| 122 | unsigned int rates; | 
|---|
| 123 | unsigned int rate_min; | 
|---|
| 124 | unsigned int rate_max; | 
|---|
| 125 | unsigned int channels_min; | 
|---|
| 126 | unsigned int channels_max; | 
|---|
| 127 | }; | 
|---|
| 128 |  | 
|---|
| 129 | struct snd_dummy { | 
|---|
| 130 | struct snd_card *card; | 
|---|
| 131 | struct dummy_model *model; | 
|---|
| 132 | struct snd_pcm *pcm; | 
|---|
| 133 | struct snd_pcm_hardware pcm_hw; | 
|---|
| 134 | spinlock_t mixer_lock; | 
|---|
| 135 | int mixer_volume[MIXER_ADDR_LAST+1][2]; | 
|---|
| 136 | int capture_source[MIXER_ADDR_LAST+1][2]; | 
|---|
| 137 | const struct dummy_timer_ops *timer_ops; | 
|---|
| 138 | }; | 
|---|
| 139 |  | 
|---|
| 140 | /* | 
|---|
| 141 | * card models | 
|---|
| 142 | */ | 
|---|
| 143 |  | 
|---|
| 144 | static int emu10k1_playback_constraints(struct snd_pcm_runtime *runtime) | 
|---|
| 145 | { | 
|---|
| 146 | int err; | 
|---|
| 147 | err = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); | 
|---|
| 148 | if (err < 0) | 
|---|
| 149 | return err; | 
|---|
| 150 | err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 256, UINT_MAX); | 
|---|
| 151 | if (err < 0) | 
|---|
| 152 | return err; | 
|---|
| 153 | return 0; | 
|---|
| 154 | } | 
|---|
| 155 |  | 
|---|
| 156 | struct dummy_model model_emu10k1 = { | 
|---|
| 157 | .name = "emu10k1", | 
|---|
| 158 | .playback_constraints = emu10k1_playback_constraints, | 
|---|
| 159 | .buffer_bytes_max = 128 * 1024, | 
|---|
| 160 | }; | 
|---|
| 161 |  | 
|---|
| 162 | struct dummy_model model_rme9652 = { | 
|---|
| 163 | .name = "rme9652", | 
|---|
| 164 | .buffer_bytes_max = 26 * 64 * 1024, | 
|---|
| 165 | .formats = SNDRV_PCM_FMTBIT_S32_LE, | 
|---|
| 166 | .channels_min = 26, | 
|---|
| 167 | .channels_max = 26, | 
|---|
| 168 | .periods_min = 2, | 
|---|
| 169 | .periods_max = 2, | 
|---|
| 170 | }; | 
|---|
| 171 |  | 
|---|
| 172 | struct dummy_model model_ice1712 = { | 
|---|
| 173 | .name = "ice1712", | 
|---|
| 174 | .buffer_bytes_max = 256 * 1024, | 
|---|
| 175 | .formats = SNDRV_PCM_FMTBIT_S32_LE, | 
|---|
| 176 | .channels_min = 10, | 
|---|
| 177 | .channels_max = 10, | 
|---|
| 178 | .periods_min = 1, | 
|---|
| 179 | .periods_max = 1024, | 
|---|
| 180 | }; | 
|---|
| 181 |  | 
|---|
| 182 | struct dummy_model model_uda1341 = { | 
|---|
| 183 | .name = "uda1341", | 
|---|
| 184 | .buffer_bytes_max = 16380, | 
|---|
| 185 | .formats = SNDRV_PCM_FMTBIT_S16_LE, | 
|---|
| 186 | .channels_min = 2, | 
|---|
| 187 | .channels_max = 2, | 
|---|
| 188 | .periods_min = 2, | 
|---|
| 189 | .periods_max = 255, | 
|---|
| 190 | }; | 
|---|
| 191 |  | 
|---|
| 192 | struct dummy_model model_ac97 = { | 
|---|
| 193 | .name = "ac97", | 
|---|
| 194 | .formats = SNDRV_PCM_FMTBIT_S16_LE, | 
|---|
| 195 | .channels_min = 2, | 
|---|
| 196 | .channels_max = 2, | 
|---|
| 197 | .rates = SNDRV_PCM_RATE_48000, | 
|---|
| 198 | .rate_min = 48000, | 
|---|
| 199 | .rate_max = 48000, | 
|---|
| 200 | }; | 
|---|
| 201 |  | 
|---|
| 202 | struct dummy_model model_ca0106 = { | 
|---|
| 203 | .name = "ca0106", | 
|---|
| 204 | .formats = SNDRV_PCM_FMTBIT_S16_LE, | 
|---|
| 205 | .buffer_bytes_max = ((65536-64)*8), | 
|---|
| 206 | .period_bytes_max = (65536-64), | 
|---|
| 207 | .periods_min = 2, | 
|---|
| 208 | .periods_max = 8, | 
|---|
| 209 | .channels_min = 2, | 
|---|
| 210 | .channels_max = 2, | 
|---|
| 211 | .rates = SNDRV_PCM_RATE_48000|SNDRV_PCM_RATE_96000|SNDRV_PCM_RATE_192000, | 
|---|
| 212 | .rate_min = 48000, | 
|---|
| 213 | .rate_max = 192000, | 
|---|
| 214 | }; | 
|---|
| 215 |  | 
|---|
| 216 | struct dummy_model *dummy_models[] = { | 
|---|
| 217 | &model_emu10k1, | 
|---|
| 218 | &model_rme9652, | 
|---|
| 219 | &model_ice1712, | 
|---|
| 220 | &model_uda1341, | 
|---|
| 221 | &model_ac97, | 
|---|
| 222 | &model_ca0106, | 
|---|
| 223 | NULL | 
|---|
| 224 | }; | 
|---|
| 225 |  | 
|---|
| 226 | /* | 
|---|
| 227 | * system timer interface | 
|---|
| 228 | */ | 
|---|
| 229 |  | 
|---|
| 230 | struct dummy_systimer_pcm { | 
|---|
| 231 | spinlock_t lock; | 
|---|
| 232 | struct timer_list timer; | 
|---|
| 233 | unsigned long base_time; | 
|---|
| 234 | unsigned int frac_pos;  /* fractional sample position (based HZ) */ | 
|---|
| 235 | unsigned int frac_period_rest; | 
|---|
| 236 | unsigned int frac_buffer_size;  /* buffer_size * HZ */ | 
|---|
| 237 | unsigned int frac_period_size;  /* period_size * HZ */ | 
|---|
| 238 | unsigned int rate; | 
|---|
| 239 | int elapsed; | 
|---|
| 240 | struct snd_pcm_substream *substream; | 
|---|
| 241 | }; | 
|---|
| 242 |  | 
|---|
| 243 | static void dummy_systimer_rearm(struct dummy_systimer_pcm *dpcm) | 
|---|
| 244 | { | 
|---|
| 245 | dpcm->timer.expires = jiffies + | 
|---|
| 246 | (dpcm->frac_period_rest + dpcm->rate - 1) / dpcm->rate; | 
|---|
| 247 | add_timer(&dpcm->timer); | 
|---|
| 248 | } | 
|---|
| 249 |  | 
|---|
| 250 | static void dummy_systimer_update(struct dummy_systimer_pcm *dpcm) | 
|---|
| 251 | { | 
|---|
| 252 | unsigned long delta; | 
|---|
| 253 |  | 
|---|
| 254 | delta = jiffies - dpcm->base_time; | 
|---|
| 255 | if (!delta) | 
|---|
| 256 | return; | 
|---|
| 257 | dpcm->base_time += delta; | 
|---|
| 258 | delta *= dpcm->rate; | 
|---|
| 259 | dpcm->frac_pos += delta; | 
|---|
| 260 | while (dpcm->frac_pos >= dpcm->frac_buffer_size) | 
|---|
| 261 | dpcm->frac_pos -= dpcm->frac_buffer_size; | 
|---|
| 262 | while (dpcm->frac_period_rest <= delta) { | 
|---|
| 263 | dpcm->elapsed++; | 
|---|
| 264 | dpcm->frac_period_rest += dpcm->frac_period_size; | 
|---|
| 265 | } | 
|---|
| 266 | dpcm->frac_period_rest -= delta; | 
|---|
| 267 | } | 
|---|
| 268 |  | 
|---|
| 269 | static int dummy_systimer_start(struct snd_pcm_substream *substream) | 
|---|
| 270 | { | 
|---|
| 271 | struct dummy_systimer_pcm *dpcm = substream->runtime->private_data; | 
|---|
| 272 | spin_lock(&dpcm->lock); | 
|---|
| 273 | dpcm->base_time = jiffies; | 
|---|
| 274 | dummy_systimer_rearm(dpcm); | 
|---|
| 275 | spin_unlock(&dpcm->lock); | 
|---|
| 276 | return 0; | 
|---|
| 277 | } | 
|---|
| 278 |  | 
|---|
| 279 | static int dummy_systimer_stop(struct snd_pcm_substream *substream) | 
|---|
| 280 | { | 
|---|
| 281 | struct dummy_systimer_pcm *dpcm = substream->runtime->private_data; | 
|---|
| 282 | spin_lock(&dpcm->lock); | 
|---|
| 283 | del_timer(&dpcm->timer); | 
|---|
| 284 | spin_unlock(&dpcm->lock); | 
|---|
| 285 | return 0; | 
|---|
| 286 | } | 
|---|
| 287 |  | 
|---|
| 288 | static int dummy_systimer_prepare(struct snd_pcm_substream *substream) | 
|---|
| 289 | { | 
|---|
| 290 | struct snd_pcm_runtime *runtime = substream->runtime; | 
|---|
| 291 | struct dummy_systimer_pcm *dpcm = runtime->private_data; | 
|---|
| 292 |  | 
|---|
| 293 | dpcm->frac_pos = 0; | 
|---|
| 294 | dpcm->rate = runtime->rate; | 
|---|
| 295 | dpcm->frac_buffer_size = runtime->buffer_size * HZ; | 
|---|
| 296 | dpcm->frac_period_size = runtime->period_size * HZ; | 
|---|
| 297 | dpcm->frac_period_rest = dpcm->frac_period_size; | 
|---|
| 298 | dpcm->elapsed = 0; | 
|---|
| 299 |  | 
|---|
| 300 | return 0; | 
|---|
| 301 | } | 
|---|
| 302 |  | 
|---|
| 303 | static void dummy_systimer_callback(unsigned long data) | 
|---|
| 304 | { | 
|---|
| 305 | struct dummy_systimer_pcm *dpcm = (struct dummy_systimer_pcm *)data; | 
|---|
| 306 | unsigned long flags; | 
|---|
| 307 | int elapsed = 0; | 
|---|
| 308 |  | 
|---|
| 309 | spin_lock_irqsave(&dpcm->lock, flags); | 
|---|
| 310 | dummy_systimer_update(dpcm); | 
|---|
| 311 | dummy_systimer_rearm(dpcm); | 
|---|
| 312 | elapsed = dpcm->elapsed; | 
|---|
| 313 | dpcm->elapsed = 0; | 
|---|
| 314 | spin_unlock_irqrestore(&dpcm->lock, flags); | 
|---|
| 315 | if (elapsed) | 
|---|
| 316 | snd_pcm_period_elapsed(dpcm->substream); | 
|---|
| 317 | } | 
|---|
| 318 |  | 
|---|
| 319 | static snd_pcm_uframes_t | 
|---|
| 320 | dummy_systimer_pointer(struct snd_pcm_substream *substream) | 
|---|
| 321 | { | 
|---|
| 322 | struct dummy_systimer_pcm *dpcm = substream->runtime->private_data; | 
|---|
| 323 | snd_pcm_uframes_t pos; | 
|---|
| 324 |  | 
|---|
| 325 | spin_lock(&dpcm->lock); | 
|---|
| 326 | dummy_systimer_update(dpcm); | 
|---|
| 327 | pos = dpcm->frac_pos / HZ; | 
|---|
| 328 | spin_unlock(&dpcm->lock); | 
|---|
| 329 | return pos; | 
|---|
| 330 | } | 
|---|
| 331 |  | 
|---|
| 332 | static int dummy_systimer_create(struct snd_pcm_substream *substream) | 
|---|
| 333 | { | 
|---|
| 334 | struct dummy_systimer_pcm *dpcm; | 
|---|
| 335 |  | 
|---|
| 336 | dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL); | 
|---|
| 337 | if (!dpcm) | 
|---|
| 338 | return -ENOMEM; | 
|---|
| 339 | substream->runtime->private_data = dpcm; | 
|---|
| 340 | init_timer(&dpcm->timer); | 
|---|
| 341 | dpcm->timer.data = (unsigned long) dpcm; | 
|---|
| 342 | dpcm->timer.function = dummy_systimer_callback; | 
|---|
| 343 | spin_lock_init(&dpcm->lock); | 
|---|
| 344 | dpcm->substream = substream; | 
|---|
| 345 | return 0; | 
|---|
| 346 | } | 
|---|
| 347 |  | 
|---|
| 348 | static void dummy_systimer_free(struct snd_pcm_substream *substream) | 
|---|
| 349 | { | 
|---|
| 350 | kfree(substream->runtime->private_data); | 
|---|
| 351 | } | 
|---|
| 352 |  | 
|---|
| 353 | static struct dummy_timer_ops dummy_systimer_ops = { | 
|---|
| 354 | .create =       dummy_systimer_create, | 
|---|
| 355 | .free =         dummy_systimer_free, | 
|---|
| 356 | .prepare =      dummy_systimer_prepare, | 
|---|
| 357 | .start =        dummy_systimer_start, | 
|---|
| 358 | .stop =         dummy_systimer_stop, | 
|---|
| 359 | .pointer =      dummy_systimer_pointer, | 
|---|
| 360 | }; | 
|---|
| 361 |  | 
|---|
| 362 | #ifdef CONFIG_HIGH_RES_TIMERS | 
|---|
| 363 | /* | 
|---|
| 364 | * hrtimer interface | 
|---|
| 365 | */ | 
|---|
| 366 |  | 
|---|
| 367 | struct dummy_hrtimer_pcm { | 
|---|
| 368 | ktime_t base_time; | 
|---|
| 369 | ktime_t period_time; | 
|---|
| 370 | atomic_t running; | 
|---|
| 371 | struct hrtimer timer; | 
|---|
| 372 | struct tasklet_struct tasklet; | 
|---|
| 373 | struct snd_pcm_substream *substream; | 
|---|
| 374 | }; | 
|---|
| 375 |  | 
|---|
| 376 | static void dummy_hrtimer_pcm_elapsed(unsigned long priv) | 
|---|
| 377 | { | 
|---|
| 378 | struct dummy_hrtimer_pcm *dpcm = (struct dummy_hrtimer_pcm *)priv; | 
|---|
| 379 | if (atomic_read(&dpcm->running)) | 
|---|
| 380 | snd_pcm_period_elapsed(dpcm->substream); | 
|---|
| 381 | } | 
|---|
| 382 |  | 
|---|
| 383 | static enum hrtimer_restart dummy_hrtimer_callback(struct hrtimer *timer) | 
|---|
| 384 | { | 
|---|
| 385 | struct dummy_hrtimer_pcm *dpcm; | 
|---|
| 386 |  | 
|---|
| 387 | dpcm = container_of(timer, struct dummy_hrtimer_pcm, timer); | 
|---|
| 388 | if (!atomic_read(&dpcm->running)) | 
|---|
| 389 | return HRTIMER_NORESTART; | 
|---|
| 390 | tasklet_schedule(&dpcm->tasklet); | 
|---|
| 391 | hrtimer_forward_now(timer, dpcm->period_time); | 
|---|
| 392 | return HRTIMER_RESTART; | 
|---|
| 393 | } | 
|---|
| 394 |  | 
|---|
| 395 | static int dummy_hrtimer_start(struct snd_pcm_substream *substream) | 
|---|
| 396 | { | 
|---|
| 397 | struct dummy_hrtimer_pcm *dpcm = substream->runtime->private_data; | 
|---|
| 398 |  | 
|---|
| 399 | dpcm->base_time = hrtimer_cb_get_time(&dpcm->timer); | 
|---|
| 400 | hrtimer_start(&dpcm->timer, dpcm->period_time, HRTIMER_MODE_REL); | 
|---|
| 401 | atomic_set(&dpcm->running, 1); | 
|---|
| 402 | return 0; | 
|---|
| 403 | } | 
|---|
| 404 |  | 
|---|
| 405 | static int dummy_hrtimer_stop(struct snd_pcm_substream *substream) | 
|---|
| 406 | { | 
|---|
| 407 | struct dummy_hrtimer_pcm *dpcm = substream->runtime->private_data; | 
|---|
| 408 |  | 
|---|
| 409 | atomic_set(&dpcm->running, 0); | 
|---|
| 410 | hrtimer_cancel(&dpcm->timer); | 
|---|
| 411 | return 0; | 
|---|
| 412 | } | 
|---|
| 413 |  | 
|---|
| 414 | static inline void dummy_hrtimer_sync(struct dummy_hrtimer_pcm *dpcm) | 
|---|
| 415 | { | 
|---|
| 416 | tasklet_kill(&dpcm->tasklet); | 
|---|
| 417 | } | 
|---|
| 418 |  | 
|---|
| 419 | static snd_pcm_uframes_t | 
|---|
| 420 | dummy_hrtimer_pointer(struct snd_pcm_substream *substream) | 
|---|
| 421 | { | 
|---|
| 422 | struct snd_pcm_runtime *runtime = substream->runtime; | 
|---|
| 423 | struct dummy_hrtimer_pcm *dpcm = runtime->private_data; | 
|---|
| 424 | u64 delta; | 
|---|
| 425 | u32 pos; | 
|---|
| 426 |  | 
|---|
| 427 | delta = ktime_us_delta(hrtimer_cb_get_time(&dpcm->timer), | 
|---|
| 428 | dpcm->base_time); | 
|---|
| 429 | delta = div_u64(delta * runtime->rate + 999999, 1000000); | 
|---|
| 430 | div_u64_rem(delta, runtime->buffer_size, &pos); | 
|---|
| 431 | return pos; | 
|---|
| 432 | } | 
|---|
| 433 |  | 
|---|
| 434 | static int dummy_hrtimer_prepare(struct snd_pcm_substream *substream) | 
|---|
| 435 | { | 
|---|
| 436 | struct snd_pcm_runtime *runtime = substream->runtime; | 
|---|
| 437 | struct dummy_hrtimer_pcm *dpcm = runtime->private_data; | 
|---|
| 438 | unsigned int period, rate; | 
|---|
| 439 | long sec; | 
|---|
| 440 | unsigned long nsecs; | 
|---|
| 441 |  | 
|---|
| 442 | dummy_hrtimer_sync(dpcm); | 
|---|
| 443 | period = runtime->period_size; | 
|---|
| 444 | rate = runtime->rate; | 
|---|
| 445 | sec = period / rate; | 
|---|
| 446 | period %= rate; | 
|---|
| 447 | nsecs = div_u64((u64)period * 1000000000UL + rate - 1, rate); | 
|---|
| 448 | dpcm->period_time = ktime_set(sec, nsecs); | 
|---|
| 449 |  | 
|---|
| 450 | return 0; | 
|---|
| 451 | } | 
|---|
| 452 |  | 
|---|
| 453 | static int dummy_hrtimer_create(struct snd_pcm_substream *substream) | 
|---|
| 454 | { | 
|---|
| 455 | struct dummy_hrtimer_pcm *dpcm; | 
|---|
| 456 |  | 
|---|
| 457 | dpcm = kzalloc(sizeof(*dpcm), GFP_KERNEL); | 
|---|
| 458 | if (!dpcm) | 
|---|
| 459 | return -ENOMEM; | 
|---|
| 460 | substream->runtime->private_data = dpcm; | 
|---|
| 461 | hrtimer_init(&dpcm->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); | 
|---|
| 462 | dpcm->timer.function = dummy_hrtimer_callback; | 
|---|
| 463 | dpcm->substream = substream; | 
|---|
| 464 | atomic_set(&dpcm->running, 0); | 
|---|
| 465 | tasklet_init(&dpcm->tasklet, dummy_hrtimer_pcm_elapsed, | 
|---|
| 466 | (unsigned long)dpcm); | 
|---|
| 467 | return 0; | 
|---|
| 468 | } | 
|---|
| 469 |  | 
|---|
| 470 | static void dummy_hrtimer_free(struct snd_pcm_substream *substream) | 
|---|
| 471 | { | 
|---|
| 472 | struct dummy_hrtimer_pcm *dpcm = substream->runtime->private_data; | 
|---|
| 473 | dummy_hrtimer_sync(dpcm); | 
|---|
| 474 | kfree(dpcm); | 
|---|
| 475 | } | 
|---|
| 476 |  | 
|---|
| 477 | static struct dummy_timer_ops dummy_hrtimer_ops = { | 
|---|
| 478 | .create =       dummy_hrtimer_create, | 
|---|
| 479 | .free =         dummy_hrtimer_free, | 
|---|
| 480 | .prepare =      dummy_hrtimer_prepare, | 
|---|
| 481 | .start =        dummy_hrtimer_start, | 
|---|
| 482 | .stop =         dummy_hrtimer_stop, | 
|---|
| 483 | .pointer =      dummy_hrtimer_pointer, | 
|---|
| 484 | }; | 
|---|
| 485 |  | 
|---|
| 486 | #endif /* CONFIG_HIGH_RES_TIMERS */ | 
|---|
| 487 |  | 
|---|
| 488 | /* | 
|---|
| 489 | * PCM interface | 
|---|
| 490 | */ | 
|---|
| 491 |  | 
|---|
| 492 | static int dummy_pcm_trigger(struct snd_pcm_substream *substream, int cmd) | 
|---|
| 493 | { | 
|---|
| 494 | struct snd_dummy *dummy = snd_pcm_substream_chip(substream); | 
|---|
| 495 |  | 
|---|
| 496 | switch (cmd) { | 
|---|
| 497 | case SNDRV_PCM_TRIGGER_START: | 
|---|
| 498 | case SNDRV_PCM_TRIGGER_RESUME: | 
|---|
| 499 | return dummy->timer_ops->start(substream); | 
|---|
| 500 | case SNDRV_PCM_TRIGGER_STOP: | 
|---|
| 501 | case SNDRV_PCM_TRIGGER_SUSPEND: | 
|---|
| 502 | return dummy->timer_ops->stop(substream); | 
|---|
| 503 | } | 
|---|
| 504 | return -EINVAL; | 
|---|
| 505 | } | 
|---|
| 506 |  | 
|---|
| 507 | static int dummy_pcm_prepare(struct snd_pcm_substream *substream) | 
|---|
| 508 | { | 
|---|
| 509 | struct snd_dummy *dummy = snd_pcm_substream_chip(substream); | 
|---|
| 510 |  | 
|---|
| 511 | return dummy->timer_ops->prepare(substream); | 
|---|
| 512 | } | 
|---|
| 513 |  | 
|---|
| 514 | static snd_pcm_uframes_t dummy_pcm_pointer(struct snd_pcm_substream *substream) | 
|---|
| 515 | { | 
|---|
| 516 | struct snd_dummy *dummy = snd_pcm_substream_chip(substream); | 
|---|
| 517 |  | 
|---|
| 518 | return dummy->timer_ops->pointer(substream); | 
|---|
| 519 | } | 
|---|
| 520 |  | 
|---|
| 521 | static struct snd_pcm_hardware dummy_pcm_hardware = { | 
|---|
| 522 | .info =                 (SNDRV_PCM_INFO_MMAP | | 
|---|
| 523 | SNDRV_PCM_INFO_INTERLEAVED | | 
|---|
| 524 | SNDRV_PCM_INFO_RESUME | | 
|---|
| 525 | SNDRV_PCM_INFO_MMAP_VALID), | 
|---|
| 526 | .formats =              USE_FORMATS, | 
|---|
| 527 | .rates =                USE_RATE, | 
|---|
| 528 | .rate_min =             USE_RATE_MIN, | 
|---|
| 529 | .rate_max =             USE_RATE_MAX, | 
|---|
| 530 | .channels_min =         USE_CHANNELS_MIN, | 
|---|
| 531 | .channels_max =         USE_CHANNELS_MAX, | 
|---|
| 532 | .buffer_bytes_max =     MAX_BUFFER_SIZE, | 
|---|
| 533 | .period_bytes_min =     MIN_PERIOD_SIZE, | 
|---|
| 534 | .period_bytes_max =     MAX_PERIOD_SIZE, | 
|---|
| 535 | .periods_min =          USE_PERIODS_MIN, | 
|---|
| 536 | .periods_max =          USE_PERIODS_MAX, | 
|---|
| 537 | .fifo_size =            0, | 
|---|
| 538 | }; | 
|---|
| 539 |  | 
|---|
| 540 | static int dummy_pcm_hw_params(struct snd_pcm_substream *substream, | 
|---|
| 541 | struct snd_pcm_hw_params *hw_params) | 
|---|
| 542 | { | 
|---|
| 543 | if (fake_buffer) { | 
|---|
| 544 | /* runtime->dma_bytes has to be set manually to allow mmap */ | 
|---|
| 545 | substream->runtime->dma_bytes = params_buffer_bytes(hw_params); | 
|---|
| 546 | return 0; | 
|---|
| 547 | } | 
|---|
| 548 | return snd_pcm_lib_malloc_pages(substream, | 
|---|
| 549 | params_buffer_bytes(hw_params)); | 
|---|
| 550 | } | 
|---|
| 551 |  | 
|---|
| 552 | static int dummy_pcm_hw_free(struct snd_pcm_substream *substream) | 
|---|
| 553 | { | 
|---|
| 554 | if (fake_buffer) | 
|---|
| 555 | return 0; | 
|---|
| 556 | return snd_pcm_lib_free_pages(substream); | 
|---|
| 557 | } | 
|---|
| 558 |  | 
|---|
| 559 | static int dummy_pcm_open(struct snd_pcm_substream *substream) | 
|---|
| 560 | { | 
|---|
| 561 | struct snd_dummy *dummy = snd_pcm_substream_chip(substream); | 
|---|
| 562 | struct dummy_model *model = dummy->model; | 
|---|
| 563 | struct snd_pcm_runtime *runtime = substream->runtime; | 
|---|
| 564 | int err; | 
|---|
| 565 |  | 
|---|
| 566 | dummy->timer_ops = &dummy_systimer_ops; | 
|---|
| 567 | #ifdef CONFIG_HIGH_RES_TIMERS | 
|---|
| 568 | if (hrtimer) | 
|---|
| 569 | dummy->timer_ops = &dummy_hrtimer_ops; | 
|---|
| 570 | #endif | 
|---|
| 571 |  | 
|---|
| 572 | err = dummy->timer_ops->create(substream); | 
|---|
| 573 | if (err < 0) | 
|---|
| 574 | return err; | 
|---|
| 575 |  | 
|---|
| 576 | runtime->hw = dummy->pcm_hw; | 
|---|
| 577 | if (substream->pcm->device & 1) { | 
|---|
| 578 | runtime->hw.info &= ~SNDRV_PCM_INFO_INTERLEAVED; | 
|---|
| 579 | runtime->hw.info |= SNDRV_PCM_INFO_NONINTERLEAVED; | 
|---|
| 580 | } | 
|---|
| 581 | if (substream->pcm->device & 2) | 
|---|
| 582 | runtime->hw.info &= ~(SNDRV_PCM_INFO_MMAP | | 
|---|
| 583 | SNDRV_PCM_INFO_MMAP_VALID); | 
|---|
| 584 |  | 
|---|
| 585 | if (model == NULL) | 
|---|
| 586 | return 0; | 
|---|
| 587 |  | 
|---|
| 588 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { | 
|---|
| 589 | if (model->playback_constraints) | 
|---|
| 590 | err = model->playback_constraints(substream->runtime); | 
|---|
| 591 | } else { | 
|---|
| 592 | if (model->capture_constraints) | 
|---|
| 593 | err = model->capture_constraints(substream->runtime); | 
|---|
| 594 | } | 
|---|
| 595 | if (err < 0) { | 
|---|
| 596 | dummy->timer_ops->free(substream); | 
|---|
| 597 | return err; | 
|---|
| 598 | } | 
|---|
| 599 | return 0; | 
|---|
| 600 | } | 
|---|
| 601 |  | 
|---|
| 602 | static int dummy_pcm_close(struct snd_pcm_substream *substream) | 
|---|
| 603 | { | 
|---|
| 604 | struct snd_dummy *dummy = snd_pcm_substream_chip(substream); | 
|---|
| 605 | dummy->timer_ops->free(substream); | 
|---|
| 606 | return 0; | 
|---|
| 607 | } | 
|---|
| 608 |  | 
|---|
| 609 | /* | 
|---|
| 610 | * dummy buffer handling | 
|---|
| 611 | */ | 
|---|
| 612 |  | 
|---|
| 613 | static void *dummy_page[2]; | 
|---|
| 614 |  | 
|---|
| 615 | static void free_fake_buffer(void) | 
|---|
| 616 | { | 
|---|
| 617 | if (fake_buffer) { | 
|---|
| 618 | int i; | 
|---|
| 619 | for (i = 0; i < 2; i++) | 
|---|
| 620 | if (dummy_page[i]) { | 
|---|
| 621 | free_page((unsigned long)dummy_page[i]); | 
|---|
| 622 | dummy_page[i] = NULL; | 
|---|
| 623 | } | 
|---|
| 624 | } | 
|---|
| 625 | } | 
|---|
| 626 |  | 
|---|
| 627 | static int alloc_fake_buffer(void) | 
|---|
| 628 | { | 
|---|
| 629 | int i; | 
|---|
| 630 |  | 
|---|
| 631 | if (!fake_buffer) | 
|---|
| 632 | return 0; | 
|---|
| 633 | for (i = 0; i < 2; i++) { | 
|---|
| 634 | dummy_page[i] = (void *)get_zeroed_page(GFP_KERNEL); | 
|---|
| 635 | if (!dummy_page[i]) { | 
|---|
| 636 | free_fake_buffer(); | 
|---|
| 637 | return -ENOMEM; | 
|---|
| 638 | } | 
|---|
| 639 | } | 
|---|
| 640 | return 0; | 
|---|
| 641 | } | 
|---|
| 642 |  | 
|---|
| 643 | static int dummy_pcm_copy(struct snd_pcm_substream *substream, | 
|---|
| 644 | int channel, snd_pcm_uframes_t pos, | 
|---|
| 645 | void __user *dst, snd_pcm_uframes_t count) | 
|---|
| 646 | { | 
|---|
| 647 | return 0; /* do nothing */ | 
|---|
| 648 | } | 
|---|
| 649 |  | 
|---|
| 650 | static int dummy_pcm_silence(struct snd_pcm_substream *substream, | 
|---|
| 651 | int channel, snd_pcm_uframes_t pos, | 
|---|
| 652 | snd_pcm_uframes_t count) | 
|---|
| 653 | { | 
|---|
| 654 | return 0; /* do nothing */ | 
|---|
| 655 | } | 
|---|
| 656 |  | 
|---|
| 657 | static struct page *dummy_pcm_page(struct snd_pcm_substream *substream, | 
|---|
| 658 | unsigned long offset) | 
|---|
| 659 | { | 
|---|
| 660 | return virt_to_page(dummy_page[substream->stream]); /* the same page */ | 
|---|
| 661 | } | 
|---|
| 662 |  | 
|---|
| 663 | static struct snd_pcm_ops dummy_pcm_ops = { | 
|---|
| 664 | .open =         dummy_pcm_open, | 
|---|
| 665 | .close =        dummy_pcm_close, | 
|---|
| 666 | .ioctl =        snd_pcm_lib_ioctl, | 
|---|
| 667 | .hw_params =    dummy_pcm_hw_params, | 
|---|
| 668 | .hw_free =      dummy_pcm_hw_free, | 
|---|
| 669 | .prepare =      dummy_pcm_prepare, | 
|---|
| 670 | .trigger =      dummy_pcm_trigger, | 
|---|
| 671 | .pointer =      dummy_pcm_pointer, | 
|---|
| 672 | }; | 
|---|
| 673 |  | 
|---|
| 674 | static struct snd_pcm_ops dummy_pcm_ops_no_buf = { | 
|---|
| 675 | .open =         dummy_pcm_open, | 
|---|
| 676 | .close =        dummy_pcm_close, | 
|---|
| 677 | .ioctl =        snd_pcm_lib_ioctl, | 
|---|
| 678 | .hw_params =    dummy_pcm_hw_params, | 
|---|
| 679 | .hw_free =      dummy_pcm_hw_free, | 
|---|
| 680 | .prepare =      dummy_pcm_prepare, | 
|---|
| 681 | .trigger =      dummy_pcm_trigger, | 
|---|
| 682 | .pointer =      dummy_pcm_pointer, | 
|---|
| 683 | .copy =         dummy_pcm_copy, | 
|---|
| 684 | .silence =      dummy_pcm_silence, | 
|---|
| 685 | .page =         dummy_pcm_page, | 
|---|
| 686 | }; | 
|---|
| 687 |  | 
|---|
| 688 | static int __devinit snd_card_dummy_pcm(struct snd_dummy *dummy, int device, | 
|---|
| 689 | int substreams) | 
|---|
| 690 | { | 
|---|
| 691 | struct snd_pcm *pcm; | 
|---|
| 692 | struct snd_pcm_ops *ops; | 
|---|
| 693 | int err; | 
|---|
| 694 |  | 
|---|
| 695 | err = snd_pcm_new(dummy->card, "Dummy PCM", device, | 
|---|
| 696 | substreams, substreams, &pcm); | 
|---|
| 697 | if (err < 0) | 
|---|
| 698 | return err; | 
|---|
| 699 | dummy->pcm = pcm; | 
|---|
| 700 | if (fake_buffer) | 
|---|
| 701 | ops = &dummy_pcm_ops_no_buf; | 
|---|
| 702 | else | 
|---|
| 703 | ops = &dummy_pcm_ops; | 
|---|
| 704 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, ops); | 
|---|
| 705 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, ops); | 
|---|
| 706 | pcm->private_data = dummy; | 
|---|
| 707 | pcm->info_flags = 0; | 
|---|
| 708 | strcpy(pcm->name, "Dummy PCM"); | 
|---|
| 709 | if (!fake_buffer) { | 
|---|
| 710 | snd_pcm_lib_preallocate_pages_for_all(pcm, | 
|---|
| 711 | SNDRV_DMA_TYPE_CONTINUOUS, | 
|---|
| 712 | snd_dma_continuous_data(GFP_KERNEL), | 
|---|
| 713 | 0, 64*1024); | 
|---|
| 714 | } | 
|---|
| 715 | return 0; | 
|---|
| 716 | } | 
|---|
| 717 |  | 
|---|
| 718 | /* | 
|---|
| 719 | * mixer interface | 
|---|
| 720 | */ | 
|---|
| 721 |  | 
|---|
| 722 | #define DUMMY_VOLUME(xname, xindex, addr) \ | 
|---|
| 723 | { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \ | 
|---|
| 724 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE | SNDRV_CTL_ELEM_ACCESS_TLV_READ, \ | 
|---|
| 725 | .name = xname, .index = xindex, \ | 
|---|
| 726 | .info = snd_dummy_volume_info, \ | 
|---|
| 727 | .get = snd_dummy_volume_get, .put = snd_dummy_volume_put, \ | 
|---|
| 728 | .private_value = addr, \ | 
|---|
| 729 | .tlv = { .p = db_scale_dummy } } | 
|---|
| 730 |  | 
|---|
| 731 | static int snd_dummy_volume_info(struct snd_kcontrol *kcontrol, | 
|---|
| 732 | struct snd_ctl_elem_info *uinfo) | 
|---|
| 733 | { | 
|---|
| 734 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | 
|---|
| 735 | uinfo->count = 2; | 
|---|
| 736 | uinfo->value.integer.min = -50; | 
|---|
| 737 | uinfo->value.integer.max = 100; | 
|---|
| 738 | return 0; | 
|---|
| 739 | } | 
|---|
| 740 |  | 
|---|
| 741 | static int snd_dummy_volume_get(struct snd_kcontrol *kcontrol, | 
|---|
| 742 | struct snd_ctl_elem_value *ucontrol) | 
|---|
| 743 | { | 
|---|
| 744 | struct snd_dummy *dummy = snd_kcontrol_chip(kcontrol); | 
|---|
| 745 | int addr = kcontrol->private_value; | 
|---|
| 746 |  | 
|---|
| 747 | spin_lock_irq(&dummy->mixer_lock); | 
|---|
| 748 | ucontrol->value.integer.value[0] = dummy->mixer_volume[addr][0]; | 
|---|
| 749 | ucontrol->value.integer.value[1] = dummy->mixer_volume[addr][1]; | 
|---|
| 750 | spin_unlock_irq(&dummy->mixer_lock); | 
|---|
| 751 | return 0; | 
|---|
| 752 | } | 
|---|
| 753 |  | 
|---|
| 754 | static int snd_dummy_volume_put(struct snd_kcontrol *kcontrol, | 
|---|
| 755 | struct snd_ctl_elem_value *ucontrol) | 
|---|
| 756 | { | 
|---|
| 757 | struct snd_dummy *dummy = snd_kcontrol_chip(kcontrol); | 
|---|
| 758 | int change, addr = kcontrol->private_value; | 
|---|
| 759 | int left, right; | 
|---|
| 760 |  | 
|---|
| 761 | left = ucontrol->value.integer.value[0]; | 
|---|
| 762 | if (left < -50) | 
|---|
| 763 | left = -50; | 
|---|
| 764 | if (left > 100) | 
|---|
| 765 | left = 100; | 
|---|
| 766 | right = ucontrol->value.integer.value[1]; | 
|---|
| 767 | if (right < -50) | 
|---|
| 768 | right = -50; | 
|---|
| 769 | if (right > 100) | 
|---|
| 770 | right = 100; | 
|---|
| 771 | spin_lock_irq(&dummy->mixer_lock); | 
|---|
| 772 | change = dummy->mixer_volume[addr][0] != left || | 
|---|
| 773 | dummy->mixer_volume[addr][1] != right; | 
|---|
| 774 | dummy->mixer_volume[addr][0] = left; | 
|---|
| 775 | dummy->mixer_volume[addr][1] = right; | 
|---|
| 776 | spin_unlock_irq(&dummy->mixer_lock); | 
|---|
| 777 | return change; | 
|---|
| 778 | } | 
|---|
| 779 |  | 
|---|
| 780 | static const DECLARE_TLV_DB_SCALE(db_scale_dummy, -4500, 30, 0); | 
|---|
| 781 |  | 
|---|
| 782 | #define DUMMY_CAPSRC(xname, xindex, addr) \ | 
|---|
| 783 | { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \ | 
|---|
| 784 | .info = snd_dummy_capsrc_info, \ | 
|---|
| 785 | .get = snd_dummy_capsrc_get, .put = snd_dummy_capsrc_put, \ | 
|---|
| 786 | .private_value = addr } | 
|---|
| 787 |  | 
|---|
| 788 | #define snd_dummy_capsrc_info   snd_ctl_boolean_stereo_info | 
|---|
| 789 |  | 
|---|
| 790 | static int snd_dummy_capsrc_get(struct snd_kcontrol *kcontrol, | 
|---|
| 791 | struct snd_ctl_elem_value *ucontrol) | 
|---|
| 792 | { | 
|---|
| 793 | struct snd_dummy *dummy = snd_kcontrol_chip(kcontrol); | 
|---|
| 794 | int addr = kcontrol->private_value; | 
|---|
| 795 |  | 
|---|
| 796 | spin_lock_irq(&dummy->mixer_lock); | 
|---|
| 797 | ucontrol->value.integer.value[0] = dummy->capture_source[addr][0]; | 
|---|
| 798 | ucontrol->value.integer.value[1] = dummy->capture_source[addr][1]; | 
|---|
| 799 | spin_unlock_irq(&dummy->mixer_lock); | 
|---|
| 800 | return 0; | 
|---|
| 801 | } | 
|---|
| 802 |  | 
|---|
| 803 | static int snd_dummy_capsrc_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) | 
|---|
| 804 | { | 
|---|
| 805 | struct snd_dummy *dummy = snd_kcontrol_chip(kcontrol); | 
|---|
| 806 | int change, addr = kcontrol->private_value; | 
|---|
| 807 | int left, right; | 
|---|
| 808 |  | 
|---|
| 809 | left = ucontrol->value.integer.value[0] & 1; | 
|---|
| 810 | right = ucontrol->value.integer.value[1] & 1; | 
|---|
| 811 | spin_lock_irq(&dummy->mixer_lock); | 
|---|
| 812 | change = dummy->capture_source[addr][0] != left && | 
|---|
| 813 | dummy->capture_source[addr][1] != right; | 
|---|
| 814 | dummy->capture_source[addr][0] = left; | 
|---|
| 815 | dummy->capture_source[addr][1] = right; | 
|---|
| 816 | spin_unlock_irq(&dummy->mixer_lock); | 
|---|
| 817 | return change; | 
|---|
| 818 | } | 
|---|
| 819 |  | 
|---|
| 820 | static struct snd_kcontrol_new snd_dummy_controls[] = { | 
|---|
| 821 | DUMMY_VOLUME("Master Volume", 0, MIXER_ADDR_MASTER), | 
|---|
| 822 | DUMMY_CAPSRC("Master Capture Switch", 0, MIXER_ADDR_MASTER), | 
|---|
| 823 | DUMMY_VOLUME("Synth Volume", 0, MIXER_ADDR_SYNTH), | 
|---|
| 824 | DUMMY_CAPSRC("Synth Capture Switch", 0, MIXER_ADDR_SYNTH), | 
|---|
| 825 | DUMMY_VOLUME("Line Volume", 0, MIXER_ADDR_LINE), | 
|---|
| 826 | DUMMY_CAPSRC("Line Capture Switch", 0, MIXER_ADDR_LINE), | 
|---|
| 827 | DUMMY_VOLUME("Mic Volume", 0, MIXER_ADDR_MIC), | 
|---|
| 828 | DUMMY_CAPSRC("Mic Capture Switch", 0, MIXER_ADDR_MIC), | 
|---|
| 829 | DUMMY_VOLUME("CD Volume", 0, MIXER_ADDR_CD), | 
|---|
| 830 | DUMMY_CAPSRC("CD Capture Switch", 0, MIXER_ADDR_CD) | 
|---|
| 831 | }; | 
|---|
| 832 |  | 
|---|
| 833 | static int __devinit snd_card_dummy_new_mixer(struct snd_dummy *dummy) | 
|---|
| 834 | { | 
|---|
| 835 | struct snd_card *card = dummy->card; | 
|---|
| 836 | unsigned int idx; | 
|---|
| 837 | int err; | 
|---|
| 838 |  | 
|---|
| 839 | spin_lock_init(&dummy->mixer_lock); | 
|---|
| 840 | strcpy(card->mixername, "Dummy Mixer"); | 
|---|
| 841 |  | 
|---|
| 842 | for (idx = 0; idx < ARRAY_SIZE(snd_dummy_controls); idx++) { | 
|---|
| 843 | err = snd_ctl_add(card, snd_ctl_new1(&snd_dummy_controls[idx], dummy)); | 
|---|
| 844 | if (err < 0) | 
|---|
| 845 | return err; | 
|---|
| 846 | } | 
|---|
| 847 | return 0; | 
|---|
| 848 | } | 
|---|
| 849 |  | 
|---|
| 850 | #if defined(CONFIG_SND_DEBUG) && defined(CONFIG_PROC_FS) | 
|---|
| 851 | /* | 
|---|
| 852 | * proc interface | 
|---|
| 853 | */ | 
|---|
| 854 | static void print_formats(struct snd_dummy *dummy, | 
|---|
| 855 | struct snd_info_buffer *buffer) | 
|---|
| 856 | { | 
|---|
| 857 | int i; | 
|---|
| 858 |  | 
|---|
| 859 | for (i = 0; i < SNDRV_PCM_FORMAT_LAST; i++) { | 
|---|
| 860 | if (dummy->pcm_hw.formats & (1ULL << i)) | 
|---|
| 861 | snd_iprintf(buffer, " %s", snd_pcm_format_name(i)); | 
|---|
| 862 | } | 
|---|
| 863 | } | 
|---|
| 864 |  | 
|---|
| 865 | static void print_rates(struct snd_dummy *dummy, | 
|---|
| 866 | struct snd_info_buffer *buffer) | 
|---|
| 867 | { | 
|---|
| 868 | static int rates[] = { | 
|---|
| 869 | 5512, 8000, 11025, 16000, 22050, 32000, 44100, 48000, | 
|---|
| 870 | 64000, 88200, 96000, 176400, 192000, | 
|---|
| 871 | }; | 
|---|
| 872 | int i; | 
|---|
| 873 |  | 
|---|
| 874 | if (dummy->pcm_hw.rates & SNDRV_PCM_RATE_CONTINUOUS) | 
|---|
| 875 | snd_iprintf(buffer, " continuous"); | 
|---|
| 876 | if (dummy->pcm_hw.rates & SNDRV_PCM_RATE_KNOT) | 
|---|
| 877 | snd_iprintf(buffer, " knot"); | 
|---|
| 878 | for (i = 0; i < ARRAY_SIZE(rates); i++) | 
|---|
| 879 | if (dummy->pcm_hw.rates & (1 << i)) | 
|---|
| 880 | snd_iprintf(buffer, " %d", rates[i]); | 
|---|
| 881 | } | 
|---|
| 882 |  | 
|---|
| 883 | #define get_dummy_int_ptr(dummy, ofs) \ | 
|---|
| 884 | (unsigned int *)((char *)&((dummy)->pcm_hw) + (ofs)) | 
|---|
| 885 | #define get_dummy_ll_ptr(dummy, ofs) \ | 
|---|
| 886 | (unsigned long long *)((char *)&((dummy)->pcm_hw) + (ofs)) | 
|---|
| 887 |  | 
|---|
| 888 | struct dummy_hw_field { | 
|---|
| 889 | const char *name; | 
|---|
| 890 | const char *format; | 
|---|
| 891 | unsigned int offset; | 
|---|
| 892 | unsigned int size; | 
|---|
| 893 | }; | 
|---|
| 894 | #define FIELD_ENTRY(item, fmt) {                   \ | 
|---|
| 895 | .name = #item,                             \ | 
|---|
| 896 | .format = fmt,                             \ | 
|---|
| 897 | .offset = offsetof(struct snd_pcm_hardware, item), \ | 
|---|
| 898 | .size = sizeof(dummy_pcm_hardware.item) } | 
|---|
| 899 |  | 
|---|
| 900 | static struct dummy_hw_field fields[] = { | 
|---|
| 901 | FIELD_ENTRY(formats, "%#llx"), | 
|---|
| 902 | FIELD_ENTRY(rates, "%#x"), | 
|---|
| 903 | FIELD_ENTRY(rate_min, "%d"), | 
|---|
| 904 | FIELD_ENTRY(rate_max, "%d"), | 
|---|
| 905 | FIELD_ENTRY(channels_min, "%d"), | 
|---|
| 906 | FIELD_ENTRY(channels_max, "%d"), | 
|---|
| 907 | FIELD_ENTRY(buffer_bytes_max, "%ld"), | 
|---|
| 908 | FIELD_ENTRY(period_bytes_min, "%ld"), | 
|---|
| 909 | FIELD_ENTRY(period_bytes_max, "%ld"), | 
|---|
| 910 | FIELD_ENTRY(periods_min, "%d"), | 
|---|
| 911 | FIELD_ENTRY(periods_max, "%d"), | 
|---|
| 912 | }; | 
|---|
| 913 |  | 
|---|
| 914 | static void dummy_proc_read(struct snd_info_entry *entry, | 
|---|
| 915 | struct snd_info_buffer *buffer) | 
|---|
| 916 | { | 
|---|
| 917 | struct snd_dummy *dummy = entry->private_data; | 
|---|
| 918 | int i; | 
|---|
| 919 |  | 
|---|
| 920 | for (i = 0; i < ARRAY_SIZE(fields); i++) { | 
|---|
| 921 | snd_iprintf(buffer, "%s ", fields[i].name); | 
|---|
| 922 | if (fields[i].size == sizeof(int)) | 
|---|
| 923 | snd_iprintf(buffer, fields[i].format, | 
|---|
| 924 | *get_dummy_int_ptr(dummy, fields[i].offset)); | 
|---|
| 925 | else | 
|---|
| 926 | snd_iprintf(buffer, fields[i].format, | 
|---|
| 927 | *get_dummy_ll_ptr(dummy, fields[i].offset)); | 
|---|
| 928 | if (!strcmp(fields[i].name, "formats")) | 
|---|
| 929 | print_formats(dummy, buffer); | 
|---|
| 930 | else if (!strcmp(fields[i].name, "rates")) | 
|---|
| 931 | print_rates(dummy, buffer); | 
|---|
| 932 | snd_iprintf(buffer, "\n"); | 
|---|
| 933 | } | 
|---|
| 934 | } | 
|---|
| 935 |  | 
|---|
| 936 | static void dummy_proc_write(struct snd_info_entry *entry, | 
|---|
| 937 | struct snd_info_buffer *buffer) | 
|---|
| 938 | { | 
|---|
| 939 | struct snd_dummy *dummy = entry->private_data; | 
|---|
| 940 | char line[64]; | 
|---|
| 941 |  | 
|---|
| 942 | while (!snd_info_get_line(buffer, line, sizeof(line))) { | 
|---|
| 943 | char item[20]; | 
|---|
| 944 | const char *ptr; | 
|---|
| 945 | unsigned long long val; | 
|---|
| 946 | int i; | 
|---|
| 947 |  | 
|---|
| 948 | ptr = snd_info_get_str(item, line, sizeof(item)); | 
|---|
| 949 | for (i = 0; i < ARRAY_SIZE(fields); i++) { | 
|---|
| 950 | if (!strcmp(item, fields[i].name)) | 
|---|
| 951 | break; | 
|---|
| 952 | } | 
|---|
| 953 | if (i >= ARRAY_SIZE(fields)) | 
|---|
| 954 | continue; | 
|---|
| 955 | snd_info_get_str(item, ptr, sizeof(item)); | 
|---|
| 956 | if (strict_strtoull(item, 0, &val)) | 
|---|
| 957 | continue; | 
|---|
| 958 | if (fields[i].size == sizeof(int)) | 
|---|
| 959 | *get_dummy_int_ptr(dummy, fields[i].offset) = val; | 
|---|
| 960 | else | 
|---|
| 961 | *get_dummy_ll_ptr(dummy, fields[i].offset) = val; | 
|---|
| 962 | } | 
|---|
| 963 | } | 
|---|
| 964 |  | 
|---|
| 965 | static void __devinit dummy_proc_init(struct snd_dummy *chip) | 
|---|
| 966 | { | 
|---|
| 967 | struct snd_info_entry *entry; | 
|---|
| 968 |  | 
|---|
| 969 | if (!snd_card_proc_new(chip->card, "dummy_pcm", &entry)) { | 
|---|
| 970 | snd_info_set_text_ops(entry, chip, dummy_proc_read); | 
|---|
| 971 | entry->c.text.write = dummy_proc_write; | 
|---|
| 972 | entry->mode |= S_IWUSR; | 
|---|
| 973 | entry->private_data = chip; | 
|---|
| 974 | } | 
|---|
| 975 | } | 
|---|
| 976 | #else | 
|---|
| 977 | #define dummy_proc_init(x) | 
|---|
| 978 | #endif /* CONFIG_SND_DEBUG && CONFIG_PROC_FS */ | 
|---|
| 979 |  | 
|---|
| 980 | static int __devinit snd_dummy_probe(struct platform_device *devptr) | 
|---|
| 981 | { | 
|---|
| 982 | struct snd_card *card; | 
|---|
| 983 | struct snd_dummy *dummy; | 
|---|
| 984 | struct dummy_model *m = NULL, **mdl; | 
|---|
| 985 | int idx, err; | 
|---|
| 986 | int dev = devptr->id; | 
|---|
| 987 |  | 
|---|
| 988 | err = snd_card_create(index[dev], id[dev], THIS_MODULE, | 
|---|
| 989 | sizeof(struct snd_dummy), &card); | 
|---|
| 990 | if (err < 0) | 
|---|
| 991 | return err; | 
|---|
| 992 | dummy = card->private_data; | 
|---|
| 993 | dummy->card = card; | 
|---|
| 994 | for (mdl = dummy_models; *mdl && model[dev]; mdl++) { | 
|---|
| 995 | if (strcmp(model[dev], (*mdl)->name) == 0) { | 
|---|
| 996 | printk(KERN_INFO | 
|---|
| 997 | "snd-dummy: Using model '%s' for card %i\n", | 
|---|
| 998 | (*mdl)->name, card->number); | 
|---|
| 999 | m = dummy->model = *mdl; | 
|---|
| 1000 | break; | 
|---|
| 1001 | } | 
|---|
| 1002 | } | 
|---|
| 1003 | for (idx = 0; idx < MAX_PCM_DEVICES && idx < pcm_devs[dev]; idx++) { | 
|---|
| 1004 | if (pcm_substreams[dev] < 1) | 
|---|
| 1005 | pcm_substreams[dev] = 1; | 
|---|
| 1006 | if (pcm_substreams[dev] > MAX_PCM_SUBSTREAMS) | 
|---|
| 1007 | pcm_substreams[dev] = MAX_PCM_SUBSTREAMS; | 
|---|
| 1008 | err = snd_card_dummy_pcm(dummy, idx, pcm_substreams[dev]); | 
|---|
| 1009 | if (err < 0) | 
|---|
| 1010 | goto __nodev; | 
|---|
| 1011 | } | 
|---|
| 1012 |  | 
|---|
| 1013 | dummy->pcm_hw = dummy_pcm_hardware; | 
|---|
| 1014 | if (m) { | 
|---|
| 1015 | if (m->formats) | 
|---|
| 1016 | dummy->pcm_hw.formats = m->formats; | 
|---|
| 1017 | if (m->buffer_bytes_max) | 
|---|
| 1018 | dummy->pcm_hw.buffer_bytes_max = m->buffer_bytes_max; | 
|---|
| 1019 | if (m->period_bytes_min) | 
|---|
| 1020 | dummy->pcm_hw.period_bytes_min = m->period_bytes_min; | 
|---|
| 1021 | if (m->period_bytes_max) | 
|---|
| 1022 | dummy->pcm_hw.period_bytes_max = m->period_bytes_max; | 
|---|
| 1023 | if (m->periods_min) | 
|---|
| 1024 | dummy->pcm_hw.periods_min = m->periods_min; | 
|---|
| 1025 | if (m->periods_max) | 
|---|
| 1026 | dummy->pcm_hw.periods_max = m->periods_max; | 
|---|
| 1027 | if (m->rates) | 
|---|
| 1028 | dummy->pcm_hw.rates = m->rates; | 
|---|
| 1029 | if (m->rate_min) | 
|---|
| 1030 | dummy->pcm_hw.rate_min = m->rate_min; | 
|---|
| 1031 | if (m->rate_max) | 
|---|
| 1032 | dummy->pcm_hw.rate_max = m->rate_max; | 
|---|
| 1033 | if (m->channels_min) | 
|---|
| 1034 | dummy->pcm_hw.channels_min = m->channels_min; | 
|---|
| 1035 | if (m->channels_max) | 
|---|
| 1036 | dummy->pcm_hw.channels_max = m->channels_max; | 
|---|
| 1037 | } | 
|---|
| 1038 |  | 
|---|
| 1039 | err = snd_card_dummy_new_mixer(dummy); | 
|---|
| 1040 | if (err < 0) | 
|---|
| 1041 | goto __nodev; | 
|---|
| 1042 | strcpy(card->driver, "Dummy"); | 
|---|
| 1043 | strcpy(card->shortname, "Dummy"); | 
|---|
| 1044 | sprintf(card->longname, "Dummy %i", dev + 1); | 
|---|
| 1045 |  | 
|---|
| 1046 | dummy_proc_init(dummy); | 
|---|
| 1047 |  | 
|---|
| 1048 | snd_card_set_dev(card, &devptr->dev); | 
|---|
| 1049 |  | 
|---|
| 1050 | err = snd_card_register(card); | 
|---|
| 1051 | if (err == 0) { | 
|---|
| 1052 | platform_set_drvdata(devptr, card); | 
|---|
| 1053 | return 0; | 
|---|
| 1054 | } | 
|---|
| 1055 | __nodev: | 
|---|
| 1056 | snd_card_free(card); | 
|---|
| 1057 | return err; | 
|---|
| 1058 | } | 
|---|
| 1059 |  | 
|---|
| 1060 | static int __devexit snd_dummy_remove(struct platform_device *devptr) | 
|---|
| 1061 | { | 
|---|
| 1062 | snd_card_free(platform_get_drvdata(devptr)); | 
|---|
| 1063 | platform_set_drvdata(devptr, NULL); | 
|---|
| 1064 | return 0; | 
|---|
| 1065 | } | 
|---|
| 1066 |  | 
|---|
| 1067 | #ifdef CONFIG_PM | 
|---|
| 1068 | static int snd_dummy_suspend(struct platform_device *pdev, pm_message_t state) | 
|---|
| 1069 | { | 
|---|
| 1070 | struct snd_card *card = platform_get_drvdata(pdev); | 
|---|
| 1071 | struct snd_dummy *dummy = card->private_data; | 
|---|
| 1072 |  | 
|---|
| 1073 | snd_power_change_state(card, SNDRV_CTL_POWER_D3hot); | 
|---|
| 1074 | snd_pcm_suspend_all(dummy->pcm); | 
|---|
| 1075 | return 0; | 
|---|
| 1076 | } | 
|---|
| 1077 |  | 
|---|
| 1078 | static int snd_dummy_resume(struct platform_device *pdev) | 
|---|
| 1079 | { | 
|---|
| 1080 | struct snd_card *card = platform_get_drvdata(pdev); | 
|---|
| 1081 |  | 
|---|
| 1082 | snd_power_change_state(card, SNDRV_CTL_POWER_D0); | 
|---|
| 1083 | return 0; | 
|---|
| 1084 | } | 
|---|
| 1085 | #endif | 
|---|
| 1086 |  | 
|---|
| 1087 | #define SND_DUMMY_DRIVER        "snd_dummy" | 
|---|
| 1088 |  | 
|---|
| 1089 | static struct platform_driver snd_dummy_driver = { | 
|---|
| 1090 | .probe          = snd_dummy_probe, | 
|---|
| 1091 | .remove         = __devexit_p(snd_dummy_remove), | 
|---|
| 1092 | #ifdef CONFIG_PM | 
|---|
| 1093 | .suspend        = snd_dummy_suspend, | 
|---|
| 1094 | .resume         = snd_dummy_resume, | 
|---|
| 1095 | #endif | 
|---|
| 1096 | .driver         = { | 
|---|
| 1097 | .name   = SND_DUMMY_DRIVER | 
|---|
| 1098 | }, | 
|---|
| 1099 | }; | 
|---|
| 1100 |  | 
|---|
| 1101 | static void snd_dummy_unregister_all(void) | 
|---|
| 1102 | { | 
|---|
| 1103 | int i; | 
|---|
| 1104 |  | 
|---|
| 1105 | for (i = 0; i < ARRAY_SIZE(devices); ++i) | 
|---|
| 1106 | platform_device_unregister(devices[i]); | 
|---|
| 1107 | platform_driver_unregister(&snd_dummy_driver); | 
|---|
| 1108 | free_fake_buffer(); | 
|---|
| 1109 | } | 
|---|
| 1110 |  | 
|---|
| 1111 | static int __init alsa_card_dummy_init(void) | 
|---|
| 1112 | { | 
|---|
| 1113 | int i, cards, err; | 
|---|
| 1114 |  | 
|---|
| 1115 | err = platform_driver_register(&snd_dummy_driver); | 
|---|
| 1116 | if (err < 0) | 
|---|
| 1117 | return err; | 
|---|
| 1118 |  | 
|---|
| 1119 | err = alloc_fake_buffer(); | 
|---|
| 1120 | if (err < 0) { | 
|---|
| 1121 | platform_driver_unregister(&snd_dummy_driver); | 
|---|
| 1122 | return err; | 
|---|
| 1123 | } | 
|---|
| 1124 |  | 
|---|
| 1125 | cards = 0; | 
|---|
| 1126 | for (i = 0; i < SNDRV_CARDS; i++) { | 
|---|
| 1127 | struct platform_device *device; | 
|---|
| 1128 | if (! enable[i]) | 
|---|
| 1129 | continue; | 
|---|
| 1130 | device = platform_device_register_simple(SND_DUMMY_DRIVER, | 
|---|
| 1131 | i, NULL, 0); | 
|---|
| 1132 | if (IS_ERR(device)) | 
|---|
| 1133 | continue; | 
|---|
| 1134 | if (!platform_get_drvdata(device)) { | 
|---|
| 1135 | platform_device_unregister(device); | 
|---|
| 1136 | continue; | 
|---|
| 1137 | } | 
|---|
| 1138 | devices[i] = device; | 
|---|
| 1139 | cards++; | 
|---|
| 1140 | } | 
|---|
| 1141 | if (!cards) { | 
|---|
| 1142 | #ifdef MODULE | 
|---|
| 1143 | printk(KERN_ERR "Dummy soundcard not found or device busy\n"); | 
|---|
| 1144 | #endif | 
|---|
| 1145 | snd_dummy_unregister_all(); | 
|---|
| 1146 | return -ENODEV; | 
|---|
| 1147 | } | 
|---|
| 1148 | return 0; | 
|---|
| 1149 | } | 
|---|
| 1150 |  | 
|---|
| 1151 | static void __exit alsa_card_dummy_exit(void) | 
|---|
| 1152 | { | 
|---|
| 1153 | snd_dummy_unregister_all(); | 
|---|
| 1154 | } | 
|---|
| 1155 |  | 
|---|
| 1156 | module_init(alsa_card_dummy_init) | 
|---|
| 1157 | module_exit(alsa_card_dummy_exit) | 
|---|