Merge tag 'pinctrl-v5.13-2' of git://git.kernel.org/pub/scm/linux/kernel/git/linusw...
[sfrench/cifs-2.6.git] / sound / isa / sb / sb16_main.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *  Copyright (c) by Jaroslav Kysela <perex@perex.cz>
4  *  Routines for control of 16-bit SoundBlaster cards and clones
5  *  Note: This is very ugly hardware which uses one 8-bit DMA channel and
6  *        second 16-bit DMA channel. Unfortunately 8-bit DMA channel can't
7  *        transfer 16-bit samples and 16-bit DMA channels can't transfer
8  *        8-bit samples. This make full duplex more complicated than
9  *        can be... People, don't buy these soundcards for full 16-bit
10  *        duplex!!!
11  *  Note: 16-bit wide is assigned to first direction which made request.
12  *        With full duplex - playback is preferred with abstract layer.
13  *
14  *  Note: Some chip revisions have hardware bug. Changing capture
15  *        channel from full-duplex 8bit DMA to 16bit DMA will block
16  *        16bit DMA transfers from DSP chip (capture) until 8bit transfer
17  *        to DSP chip (playback) starts. This bug can be avoided with
18  *        "16bit DMA Allocation" setting set to Playback or Capture.
19  */
20
21 #include <linux/io.h>
22 #include <asm/dma.h>
23 #include <linux/init.h>
24 #include <linux/time.h>
25 #include <linux/module.h>
26 #include <sound/core.h>
27 #include <sound/sb.h>
28 #include <sound/sb16_csp.h>
29 #include <sound/mpu401.h>
30 #include <sound/control.h>
31 #include <sound/info.h>
32
33 MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
34 MODULE_DESCRIPTION("Routines for control of 16-bit SoundBlaster cards and clones");
35 MODULE_LICENSE("GPL");
36
37 #define runtime_format_bits(runtime) \
38         ((unsigned int)pcm_format_to_bits((runtime)->format))
39
40 #ifdef CONFIG_SND_SB16_CSP
41 static void snd_sb16_csp_playback_prepare(struct snd_sb *chip, struct snd_pcm_runtime *runtime)
42 {
43         if (chip->hardware == SB_HW_16CSP) {
44                 struct snd_sb_csp *csp = chip->csp;
45
46                 if (csp->running & SNDRV_SB_CSP_ST_LOADED) {
47                         /* manually loaded codec */
48                         if ((csp->mode & SNDRV_SB_CSP_MODE_DSP_WRITE) &&
49                             (runtime_format_bits(runtime) == csp->acc_format)) {
50                                 /* Supported runtime PCM format for playback */
51                                 if (csp->ops.csp_use(csp) == 0) {
52                                         /* If CSP was successfully acquired */
53                                         goto __start_CSP;
54                                 }
55                         } else if ((csp->mode & SNDRV_SB_CSP_MODE_QSOUND) && (csp->q_enabled)) {
56                                 /* QSound decoder is loaded and enabled */
57                                 if (runtime_format_bits(runtime) & (SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_U8 |
58                                                               SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_U16_LE)) {
59                                         /* Only for simple PCM formats */
60                                         if (csp->ops.csp_use(csp) == 0) {
61                                                 /* If CSP was successfully acquired */
62                                                 goto __start_CSP;
63                                         }
64                                 }
65                         }
66                 } else if (csp->ops.csp_use(csp) == 0) {
67                         /* Acquire CSP and try to autoload hardware codec */
68                         if (csp->ops.csp_autoload(csp, runtime->format, SNDRV_SB_CSP_MODE_DSP_WRITE)) {
69                                 /* Unsupported format, release CSP */
70                                 csp->ops.csp_unuse(csp);
71                         } else {
72                       __start_CSP:
73                                 /* Try to start CSP */
74                                 if (csp->ops.csp_start(csp, (chip->mode & SB_MODE_PLAYBACK_16) ?
75                                                        SNDRV_SB_CSP_SAMPLE_16BIT : SNDRV_SB_CSP_SAMPLE_8BIT,
76                                                        (runtime->channels > 1) ?
77                                                        SNDRV_SB_CSP_STEREO : SNDRV_SB_CSP_MONO)) {
78                                         /* Failed, release CSP */
79                                         csp->ops.csp_unuse(csp);
80                                 } else {
81                                         /* Success, CSP acquired and running */
82                                         chip->open = SNDRV_SB_CSP_MODE_DSP_WRITE;
83                                 }
84                         }
85                 }
86         }
87 }
88
89 static void snd_sb16_csp_capture_prepare(struct snd_sb *chip, struct snd_pcm_runtime *runtime)
90 {
91         if (chip->hardware == SB_HW_16CSP) {
92                 struct snd_sb_csp *csp = chip->csp;
93
94                 if (csp->running & SNDRV_SB_CSP_ST_LOADED) {
95                         /* manually loaded codec */
96                         if ((csp->mode & SNDRV_SB_CSP_MODE_DSP_READ) &&
97                             (runtime_format_bits(runtime) == csp->acc_format)) {
98                                 /* Supported runtime PCM format for capture */
99                                 if (csp->ops.csp_use(csp) == 0) {
100                                         /* If CSP was successfully acquired */
101                                         goto __start_CSP;
102                                 }
103                         }
104                 } else if (csp->ops.csp_use(csp) == 0) {
105                         /* Acquire CSP and try to autoload hardware codec */
106                         if (csp->ops.csp_autoload(csp, runtime->format, SNDRV_SB_CSP_MODE_DSP_READ)) {
107                                 /* Unsupported format, release CSP */
108                                 csp->ops.csp_unuse(csp);
109                         } else {
110                       __start_CSP:
111                                 /* Try to start CSP */
112                                 if (csp->ops.csp_start(csp, (chip->mode & SB_MODE_CAPTURE_16) ?
113                                                        SNDRV_SB_CSP_SAMPLE_16BIT : SNDRV_SB_CSP_SAMPLE_8BIT,
114                                                        (runtime->channels > 1) ?
115                                                        SNDRV_SB_CSP_STEREO : SNDRV_SB_CSP_MONO)) {
116                                         /* Failed, release CSP */
117                                         csp->ops.csp_unuse(csp);
118                                 } else {
119                                         /* Success, CSP acquired and running */
120                                         chip->open = SNDRV_SB_CSP_MODE_DSP_READ;
121                                 }
122                         }
123                 }
124         }
125 }
126
127 static void snd_sb16_csp_update(struct snd_sb *chip)
128 {
129         if (chip->hardware == SB_HW_16CSP) {
130                 struct snd_sb_csp *csp = chip->csp;
131
132                 if (csp->qpos_changed) {
133                         spin_lock(&chip->reg_lock);
134                         csp->ops.csp_qsound_transfer (csp);
135                         spin_unlock(&chip->reg_lock);
136                 }
137         }
138 }
139
140 static void snd_sb16_csp_playback_open(struct snd_sb *chip, struct snd_pcm_runtime *runtime)
141 {
142         /* CSP decoders (QSound excluded) support only 16bit transfers */
143         if (chip->hardware == SB_HW_16CSP) {
144                 struct snd_sb_csp *csp = chip->csp;
145
146                 if (csp->running & SNDRV_SB_CSP_ST_LOADED) {
147                         /* manually loaded codec */
148                         if (csp->mode & SNDRV_SB_CSP_MODE_DSP_WRITE) {
149                                 runtime->hw.formats |= csp->acc_format;
150                         }
151                 } else {
152                         /* autoloaded codecs */
153                         runtime->hw.formats |= SNDRV_PCM_FMTBIT_MU_LAW | SNDRV_PCM_FMTBIT_A_LAW |
154                                                SNDRV_PCM_FMTBIT_IMA_ADPCM;
155                 }
156         }
157 }
158
159 static void snd_sb16_csp_playback_close(struct snd_sb *chip)
160 {
161         if ((chip->hardware == SB_HW_16CSP) && (chip->open == SNDRV_SB_CSP_MODE_DSP_WRITE)) {
162                 struct snd_sb_csp *csp = chip->csp;
163
164                 if (csp->ops.csp_stop(csp) == 0) {
165                         csp->ops.csp_unuse(csp);
166                         chip->open = 0;
167                 }
168         }
169 }
170
171 static void snd_sb16_csp_capture_open(struct snd_sb *chip, struct snd_pcm_runtime *runtime)
172 {
173         /* CSP coders support only 16bit transfers */
174         if (chip->hardware == SB_HW_16CSP) {
175                 struct snd_sb_csp *csp = chip->csp;
176
177                 if (csp->running & SNDRV_SB_CSP_ST_LOADED) {
178                         /* manually loaded codec */
179                         if (csp->mode & SNDRV_SB_CSP_MODE_DSP_READ) {
180                                 runtime->hw.formats |= csp->acc_format;
181                         }
182                 } else {
183                         /* autoloaded codecs */
184                         runtime->hw.formats |= SNDRV_PCM_FMTBIT_MU_LAW | SNDRV_PCM_FMTBIT_A_LAW |
185                                                SNDRV_PCM_FMTBIT_IMA_ADPCM;
186                 }
187         }
188 }
189
190 static void snd_sb16_csp_capture_close(struct snd_sb *chip)
191 {
192         if ((chip->hardware == SB_HW_16CSP) && (chip->open == SNDRV_SB_CSP_MODE_DSP_READ)) {
193                 struct snd_sb_csp *csp = chip->csp;
194
195                 if (csp->ops.csp_stop(csp) == 0) {
196                         csp->ops.csp_unuse(csp);
197                         chip->open = 0;
198                 }
199         }
200 }
201 #else
202 #define snd_sb16_csp_playback_prepare(chip, runtime)    /*nop*/
203 #define snd_sb16_csp_capture_prepare(chip, runtime)     /*nop*/
204 #define snd_sb16_csp_update(chip)                       /*nop*/
205 #define snd_sb16_csp_playback_open(chip, runtime)       /*nop*/
206 #define snd_sb16_csp_playback_close(chip)               /*nop*/
207 #define snd_sb16_csp_capture_open(chip, runtime)        /*nop*/
208 #define snd_sb16_csp_capture_close(chip)                /*nop*/
209 #endif
210
211
212 static void snd_sb16_setup_rate(struct snd_sb *chip,
213                                 unsigned short rate,
214                                 int channel)
215 {
216         unsigned long flags;
217
218         spin_lock_irqsave(&chip->reg_lock, flags);
219         if (chip->mode & (channel == SNDRV_PCM_STREAM_PLAYBACK ? SB_MODE_PLAYBACK_16 : SB_MODE_CAPTURE_16))
220                 snd_sb_ack_16bit(chip);
221         else
222                 snd_sb_ack_8bit(chip);
223         if (!(chip->mode & SB_RATE_LOCK)) {
224                 chip->locked_rate = rate;
225                 snd_sbdsp_command(chip, SB_DSP_SAMPLE_RATE_IN);
226                 snd_sbdsp_command(chip, rate >> 8);
227                 snd_sbdsp_command(chip, rate & 0xff);
228                 snd_sbdsp_command(chip, SB_DSP_SAMPLE_RATE_OUT);
229                 snd_sbdsp_command(chip, rate >> 8);
230                 snd_sbdsp_command(chip, rate & 0xff);
231         }
232         spin_unlock_irqrestore(&chip->reg_lock, flags);
233 }
234
235 static int snd_sb16_playback_prepare(struct snd_pcm_substream *substream)
236 {
237         unsigned long flags;
238         struct snd_sb *chip = snd_pcm_substream_chip(substream);
239         struct snd_pcm_runtime *runtime = substream->runtime;
240         unsigned char format;
241         unsigned int size, count, dma;
242
243         snd_sb16_csp_playback_prepare(chip, runtime);
244         if (snd_pcm_format_unsigned(runtime->format) > 0) {
245                 format = runtime->channels > 1 ? SB_DSP4_MODE_UNS_STEREO : SB_DSP4_MODE_UNS_MONO;
246         } else {
247                 format = runtime->channels > 1 ? SB_DSP4_MODE_SIGN_STEREO : SB_DSP4_MODE_SIGN_MONO;
248         }
249
250         snd_sb16_setup_rate(chip, runtime->rate, SNDRV_PCM_STREAM_PLAYBACK);
251         size = chip->p_dma_size = snd_pcm_lib_buffer_bytes(substream);
252         dma = (chip->mode & SB_MODE_PLAYBACK_8) ? chip->dma8 : chip->dma16;
253         snd_dma_program(dma, runtime->dma_addr, size, DMA_MODE_WRITE | DMA_AUTOINIT);
254
255         count = snd_pcm_lib_period_bytes(substream);
256         spin_lock_irqsave(&chip->reg_lock, flags);
257         if (chip->mode & SB_MODE_PLAYBACK_16) {
258                 count >>= 1;
259                 count--;
260                 snd_sbdsp_command(chip, SB_DSP4_OUT16_AI);
261                 snd_sbdsp_command(chip, format);
262                 snd_sbdsp_command(chip, count & 0xff);
263                 snd_sbdsp_command(chip, count >> 8);
264                 snd_sbdsp_command(chip, SB_DSP_DMA16_OFF);
265         } else {
266                 count--;
267                 snd_sbdsp_command(chip, SB_DSP4_OUT8_AI);
268                 snd_sbdsp_command(chip, format);
269                 snd_sbdsp_command(chip, count & 0xff);
270                 snd_sbdsp_command(chip, count >> 8);
271                 snd_sbdsp_command(chip, SB_DSP_DMA8_OFF);
272         }
273         spin_unlock_irqrestore(&chip->reg_lock, flags);
274         return 0;
275 }
276
277 static int snd_sb16_playback_trigger(struct snd_pcm_substream *substream,
278                                      int cmd)
279 {
280         struct snd_sb *chip = snd_pcm_substream_chip(substream);
281         int result = 0;
282
283         spin_lock(&chip->reg_lock);
284         switch (cmd) {
285         case SNDRV_PCM_TRIGGER_START:
286         case SNDRV_PCM_TRIGGER_RESUME:
287                 chip->mode |= SB_RATE_LOCK_PLAYBACK;
288                 snd_sbdsp_command(chip, chip->mode & SB_MODE_PLAYBACK_16 ? SB_DSP_DMA16_ON : SB_DSP_DMA8_ON);
289                 break;
290         case SNDRV_PCM_TRIGGER_STOP:
291         case SNDRV_PCM_TRIGGER_SUSPEND:
292                 snd_sbdsp_command(chip, chip->mode & SB_MODE_PLAYBACK_16 ? SB_DSP_DMA16_OFF : SB_DSP_DMA8_OFF);
293                 /* next two lines are needed for some types of DSP4 (SB AWE 32 - 4.13) */
294                 if (chip->mode & SB_RATE_LOCK_CAPTURE)
295                         snd_sbdsp_command(chip, chip->mode & SB_MODE_CAPTURE_16 ? SB_DSP_DMA16_ON : SB_DSP_DMA8_ON);
296                 chip->mode &= ~SB_RATE_LOCK_PLAYBACK;
297                 break;
298         default:
299                 result = -EINVAL;
300         }
301         spin_unlock(&chip->reg_lock);
302         return result;
303 }
304
305 static int snd_sb16_capture_prepare(struct snd_pcm_substream *substream)
306 {
307         unsigned long flags;
308         struct snd_sb *chip = snd_pcm_substream_chip(substream);
309         struct snd_pcm_runtime *runtime = substream->runtime;
310         unsigned char format;
311         unsigned int size, count, dma;
312
313         snd_sb16_csp_capture_prepare(chip, runtime);
314         if (snd_pcm_format_unsigned(runtime->format) > 0) {
315                 format = runtime->channels > 1 ? SB_DSP4_MODE_UNS_STEREO : SB_DSP4_MODE_UNS_MONO;
316         } else {
317                 format = runtime->channels > 1 ? SB_DSP4_MODE_SIGN_STEREO : SB_DSP4_MODE_SIGN_MONO;
318         }
319         snd_sb16_setup_rate(chip, runtime->rate, SNDRV_PCM_STREAM_CAPTURE);
320         size = chip->c_dma_size = snd_pcm_lib_buffer_bytes(substream);
321         dma = (chip->mode & SB_MODE_CAPTURE_8) ? chip->dma8 : chip->dma16;
322         snd_dma_program(dma, runtime->dma_addr, size, DMA_MODE_READ | DMA_AUTOINIT);
323
324         count = snd_pcm_lib_period_bytes(substream);
325         spin_lock_irqsave(&chip->reg_lock, flags);
326         if (chip->mode & SB_MODE_CAPTURE_16) {
327                 count >>= 1;
328                 count--;
329                 snd_sbdsp_command(chip, SB_DSP4_IN16_AI);
330                 snd_sbdsp_command(chip, format);
331                 snd_sbdsp_command(chip, count & 0xff);
332                 snd_sbdsp_command(chip, count >> 8);
333                 snd_sbdsp_command(chip, SB_DSP_DMA16_OFF);
334         } else {
335                 count--;
336                 snd_sbdsp_command(chip, SB_DSP4_IN8_AI);
337                 snd_sbdsp_command(chip, format);
338                 snd_sbdsp_command(chip, count & 0xff);
339                 snd_sbdsp_command(chip, count >> 8);
340                 snd_sbdsp_command(chip, SB_DSP_DMA8_OFF);
341         }
342         spin_unlock_irqrestore(&chip->reg_lock, flags);
343         return 0;
344 }
345
346 static int snd_sb16_capture_trigger(struct snd_pcm_substream *substream,
347                                     int cmd)
348 {
349         struct snd_sb *chip = snd_pcm_substream_chip(substream);
350         int result = 0;
351
352         spin_lock(&chip->reg_lock);
353         switch (cmd) {
354         case SNDRV_PCM_TRIGGER_START:
355         case SNDRV_PCM_TRIGGER_RESUME:
356                 chip->mode |= SB_RATE_LOCK_CAPTURE;
357                 snd_sbdsp_command(chip, chip->mode & SB_MODE_CAPTURE_16 ? SB_DSP_DMA16_ON : SB_DSP_DMA8_ON);
358                 break;
359         case SNDRV_PCM_TRIGGER_STOP:
360         case SNDRV_PCM_TRIGGER_SUSPEND:
361                 snd_sbdsp_command(chip, chip->mode & SB_MODE_CAPTURE_16 ? SB_DSP_DMA16_OFF : SB_DSP_DMA8_OFF);
362                 /* next two lines are needed for some types of DSP4 (SB AWE 32 - 4.13) */
363                 if (chip->mode & SB_RATE_LOCK_PLAYBACK)
364                         snd_sbdsp_command(chip, chip->mode & SB_MODE_PLAYBACK_16 ? SB_DSP_DMA16_ON : SB_DSP_DMA8_ON);
365                 chip->mode &= ~SB_RATE_LOCK_CAPTURE;
366                 break;
367         default:
368                 result = -EINVAL;
369         }
370         spin_unlock(&chip->reg_lock);
371         return result;
372 }
373
374 irqreturn_t snd_sb16dsp_interrupt(int irq, void *dev_id)
375 {
376         struct snd_sb *chip = dev_id;
377         unsigned char status;
378         int ok;
379
380         spin_lock(&chip->mixer_lock);
381         status = snd_sbmixer_read(chip, SB_DSP4_IRQSTATUS);
382         spin_unlock(&chip->mixer_lock);
383         if ((status & SB_IRQTYPE_MPUIN) && chip->rmidi_callback)
384                 chip->rmidi_callback(irq, chip->rmidi->private_data);
385         if (status & SB_IRQTYPE_8BIT) {
386                 ok = 0;
387                 if (chip->mode & SB_MODE_PLAYBACK_8) {
388                         snd_pcm_period_elapsed(chip->playback_substream);
389                         snd_sb16_csp_update(chip);
390                         ok++;
391                 }
392                 if (chip->mode & SB_MODE_CAPTURE_8) {
393                         snd_pcm_period_elapsed(chip->capture_substream);
394                         ok++;
395                 }
396                 spin_lock(&chip->reg_lock);
397                 if (!ok)
398                         snd_sbdsp_command(chip, SB_DSP_DMA8_OFF);
399                 snd_sb_ack_8bit(chip);
400                 spin_unlock(&chip->reg_lock);
401         }
402         if (status & SB_IRQTYPE_16BIT) {
403                 ok = 0;
404                 if (chip->mode & SB_MODE_PLAYBACK_16) {
405                         snd_pcm_period_elapsed(chip->playback_substream);
406                         snd_sb16_csp_update(chip);
407                         ok++;
408                 }
409                 if (chip->mode & SB_MODE_CAPTURE_16) {
410                         snd_pcm_period_elapsed(chip->capture_substream);
411                         ok++;
412                 }
413                 spin_lock(&chip->reg_lock);
414                 if (!ok)
415                         snd_sbdsp_command(chip, SB_DSP_DMA16_OFF);
416                 snd_sb_ack_16bit(chip);
417                 spin_unlock(&chip->reg_lock);
418         }
419         return IRQ_HANDLED;
420 }
421
422 /*
423
424  */
425
426 static snd_pcm_uframes_t snd_sb16_playback_pointer(struct snd_pcm_substream *substream)
427 {
428         struct snd_sb *chip = snd_pcm_substream_chip(substream);
429         unsigned int dma;
430         size_t ptr;
431
432         dma = (chip->mode & SB_MODE_PLAYBACK_8) ? chip->dma8 : chip->dma16;
433         ptr = snd_dma_pointer(dma, chip->p_dma_size);
434         return bytes_to_frames(substream->runtime, ptr);
435 }
436
437 static snd_pcm_uframes_t snd_sb16_capture_pointer(struct snd_pcm_substream *substream)
438 {
439         struct snd_sb *chip = snd_pcm_substream_chip(substream);
440         unsigned int dma;
441         size_t ptr;
442
443         dma = (chip->mode & SB_MODE_CAPTURE_8) ? chip->dma8 : chip->dma16;
444         ptr = snd_dma_pointer(dma, chip->c_dma_size);
445         return bytes_to_frames(substream->runtime, ptr);
446 }
447
448 /*
449
450  */
451
452 static const struct snd_pcm_hardware snd_sb16_playback =
453 {
454         .info =                 (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
455                                  SNDRV_PCM_INFO_MMAP_VALID),
456         .formats =              0,
457         .rates =                SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_44100,
458         .rate_min =             4000,
459         .rate_max =             44100,
460         .channels_min =         1,
461         .channels_max =         2,
462         .buffer_bytes_max =     (128*1024),
463         .period_bytes_min =     64,
464         .period_bytes_max =     (128*1024),
465         .periods_min =          1,
466         .periods_max =          1024,
467         .fifo_size =            0,
468 };
469
470 static const struct snd_pcm_hardware snd_sb16_capture =
471 {
472         .info =                 (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
473                                  SNDRV_PCM_INFO_MMAP_VALID),
474         .formats =              0,
475         .rates =                SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_44100,
476         .rate_min =             4000,
477         .rate_max =             44100,
478         .channels_min =         1,
479         .channels_max =         2,
480         .buffer_bytes_max =     (128*1024),
481         .period_bytes_min =     64,
482         .period_bytes_max =     (128*1024),
483         .periods_min =          1,
484         .periods_max =          1024,
485         .fifo_size =            0,
486 };
487
488 /*
489  *  open/close
490  */
491
492 static int snd_sb16_playback_open(struct snd_pcm_substream *substream)
493 {
494         unsigned long flags;
495         struct snd_sb *chip = snd_pcm_substream_chip(substream);
496         struct snd_pcm_runtime *runtime = substream->runtime;
497
498         spin_lock_irqsave(&chip->open_lock, flags);
499         if (chip->mode & SB_MODE_PLAYBACK) {
500                 spin_unlock_irqrestore(&chip->open_lock, flags);
501                 return -EAGAIN;
502         }
503         runtime->hw = snd_sb16_playback;
504
505         /* skip if 16 bit DMA was reserved for capture */
506         if (chip->force_mode16 & SB_MODE_CAPTURE_16)
507                 goto __skip_16bit;
508
509         if (chip->dma16 >= 0 && !(chip->mode & SB_MODE_CAPTURE_16)) {
510                 chip->mode |= SB_MODE_PLAYBACK_16;
511                 runtime->hw.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_U16_LE;
512                 /* Vibra16X hack */
513                 if (chip->dma16 <= 3) {
514                         runtime->hw.buffer_bytes_max =
515                         runtime->hw.period_bytes_max = 64 * 1024;
516                 } else {
517                         snd_sb16_csp_playback_open(chip, runtime);
518                 }
519                 goto __open_ok;
520         }
521
522       __skip_16bit:
523         if (chip->dma8 >= 0 && !(chip->mode & SB_MODE_CAPTURE_8)) {
524                 chip->mode |= SB_MODE_PLAYBACK_8;
525                 /* DSP v 4.xx can transfer 16bit data through 8bit DMA channel, SBHWPG 2-7 */
526                 if (chip->dma16 < 0) {
527                         runtime->hw.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_U16_LE;
528                         chip->mode |= SB_MODE_PLAYBACK_16;
529                 } else {
530                         runtime->hw.formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S8;
531                 }
532                 runtime->hw.buffer_bytes_max =
533                 runtime->hw.period_bytes_max = 64 * 1024;
534                 goto __open_ok;
535         }
536         spin_unlock_irqrestore(&chip->open_lock, flags);
537         return -EAGAIN;
538
539       __open_ok:
540         if (chip->hardware == SB_HW_ALS100)
541                 runtime->hw.rate_max = 48000;
542         if (chip->hardware == SB_HW_CS5530) {
543                 runtime->hw.buffer_bytes_max = 32 * 1024;
544                 runtime->hw.periods_min = 2;
545                 runtime->hw.rate_min = 44100;
546         }
547         if (chip->mode & SB_RATE_LOCK)
548                 runtime->hw.rate_min = runtime->hw.rate_max = chip->locked_rate;
549         chip->playback_substream = substream;
550         spin_unlock_irqrestore(&chip->open_lock, flags);
551         return 0;
552 }
553
554 static int snd_sb16_playback_close(struct snd_pcm_substream *substream)
555 {
556         unsigned long flags;
557         struct snd_sb *chip = snd_pcm_substream_chip(substream);
558
559         snd_sb16_csp_playback_close(chip);
560         spin_lock_irqsave(&chip->open_lock, flags);
561         chip->playback_substream = NULL;
562         chip->mode &= ~SB_MODE_PLAYBACK;
563         spin_unlock_irqrestore(&chip->open_lock, flags);
564         return 0;
565 }
566
567 static int snd_sb16_capture_open(struct snd_pcm_substream *substream)
568 {
569         unsigned long flags;
570         struct snd_sb *chip = snd_pcm_substream_chip(substream);
571         struct snd_pcm_runtime *runtime = substream->runtime;
572
573         spin_lock_irqsave(&chip->open_lock, flags);
574         if (chip->mode & SB_MODE_CAPTURE) {
575                 spin_unlock_irqrestore(&chip->open_lock, flags);
576                 return -EAGAIN;
577         }
578         runtime->hw = snd_sb16_capture;
579
580         /* skip if 16 bit DMA was reserved for playback */
581         if (chip->force_mode16 & SB_MODE_PLAYBACK_16)
582                 goto __skip_16bit;
583
584         if (chip->dma16 >= 0 && !(chip->mode & SB_MODE_PLAYBACK_16)) {
585                 chip->mode |= SB_MODE_CAPTURE_16;
586                 runtime->hw.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_U16_LE;
587                 /* Vibra16X hack */
588                 if (chip->dma16 <= 3) {
589                         runtime->hw.buffer_bytes_max =
590                         runtime->hw.period_bytes_max = 64 * 1024;
591                 } else {
592                         snd_sb16_csp_capture_open(chip, runtime);
593                 }
594                 goto __open_ok;
595         }
596
597       __skip_16bit:
598         if (chip->dma8 >= 0 && !(chip->mode & SB_MODE_PLAYBACK_8)) {
599                 chip->mode |= SB_MODE_CAPTURE_8;
600                 /* DSP v 4.xx can transfer 16bit data through 8bit DMA channel, SBHWPG 2-7 */
601                 if (chip->dma16 < 0) {
602                         runtime->hw.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_U16_LE;
603                         chip->mode |= SB_MODE_CAPTURE_16;
604                 } else {
605                         runtime->hw.formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S8;
606                 }
607                 runtime->hw.buffer_bytes_max =
608                 runtime->hw.period_bytes_max = 64 * 1024;
609                 goto __open_ok;
610         }
611         spin_unlock_irqrestore(&chip->open_lock, flags);
612         return -EAGAIN;
613
614       __open_ok:
615         if (chip->hardware == SB_HW_ALS100)
616                 runtime->hw.rate_max = 48000;
617         if (chip->hardware == SB_HW_CS5530) {
618                 runtime->hw.buffer_bytes_max = 32 * 1024;
619                 runtime->hw.periods_min = 2;
620                 runtime->hw.rate_min = 44100;
621         }
622         if (chip->mode & SB_RATE_LOCK)
623                 runtime->hw.rate_min = runtime->hw.rate_max = chip->locked_rate;
624         chip->capture_substream = substream;
625         spin_unlock_irqrestore(&chip->open_lock, flags);
626         return 0;
627 }
628
629 static int snd_sb16_capture_close(struct snd_pcm_substream *substream)
630 {
631         unsigned long flags;
632         struct snd_sb *chip = snd_pcm_substream_chip(substream);
633
634         snd_sb16_csp_capture_close(chip);
635         spin_lock_irqsave(&chip->open_lock, flags);
636         chip->capture_substream = NULL;
637         chip->mode &= ~SB_MODE_CAPTURE;
638         spin_unlock_irqrestore(&chip->open_lock, flags);
639         return 0;
640 }
641
642 /*
643  *  DMA control interface
644  */
645
646 static int snd_sb16_set_dma_mode(struct snd_sb *chip, int what)
647 {
648         if (chip->dma8 < 0 || chip->dma16 < 0) {
649                 if (snd_BUG_ON(what))
650                         return -EINVAL;
651                 return 0;
652         }
653         if (what == 0) {
654                 chip->force_mode16 = 0;
655         } else if (what == 1) {
656                 chip->force_mode16 = SB_MODE_PLAYBACK_16;
657         } else if (what == 2) {
658                 chip->force_mode16 = SB_MODE_CAPTURE_16;
659         } else {
660                 return -EINVAL;
661         }
662         return 0;
663 }
664
665 static int snd_sb16_get_dma_mode(struct snd_sb *chip)
666 {
667         if (chip->dma8 < 0 || chip->dma16 < 0)
668                 return 0;
669         switch (chip->force_mode16) {
670         case SB_MODE_PLAYBACK_16:
671                 return 1;
672         case SB_MODE_CAPTURE_16:
673                 return 2;
674         default:
675                 return 0;
676         }
677 }
678
679 static int snd_sb16_dma_control_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
680 {
681         static const char * const texts[3] = {
682                 "Auto", "Playback", "Capture"
683         };
684
685         return snd_ctl_enum_info(uinfo, 1, 3, texts);
686 }
687
688 static int snd_sb16_dma_control_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
689 {
690         struct snd_sb *chip = snd_kcontrol_chip(kcontrol);
691         unsigned long flags;
692         
693         spin_lock_irqsave(&chip->reg_lock, flags);
694         ucontrol->value.enumerated.item[0] = snd_sb16_get_dma_mode(chip);
695         spin_unlock_irqrestore(&chip->reg_lock, flags);
696         return 0;
697 }
698
699 static int snd_sb16_dma_control_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
700 {
701         struct snd_sb *chip = snd_kcontrol_chip(kcontrol);
702         unsigned long flags;
703         unsigned char nval, oval;
704         int change;
705         
706         if ((nval = ucontrol->value.enumerated.item[0]) > 2)
707                 return -EINVAL;
708         spin_lock_irqsave(&chip->reg_lock, flags);
709         oval = snd_sb16_get_dma_mode(chip);
710         change = nval != oval;
711         snd_sb16_set_dma_mode(chip, nval);
712         spin_unlock_irqrestore(&chip->reg_lock, flags);
713         return change;
714 }
715
716 static const struct snd_kcontrol_new snd_sb16_dma_control = {
717         .iface = SNDRV_CTL_ELEM_IFACE_CARD,
718         .name = "16-bit DMA Allocation",
719         .info = snd_sb16_dma_control_info,
720         .get = snd_sb16_dma_control_get,
721         .put = snd_sb16_dma_control_put
722 };
723
724 /*
725  *  Initialization part
726  */
727  
728 int snd_sb16dsp_configure(struct snd_sb * chip)
729 {
730         unsigned long flags;
731         unsigned char irqreg = 0, dmareg = 0, mpureg;
732         unsigned char realirq, realdma, realmpureg;
733         /* note: mpu register should be present only on SB16 Vibra soundcards */
734
735         // printk(KERN_DEBUG "codec->irq=%i, codec->dma8=%i, codec->dma16=%i\n", chip->irq, chip->dma8, chip->dma16);
736         spin_lock_irqsave(&chip->mixer_lock, flags);
737         mpureg = snd_sbmixer_read(chip, SB_DSP4_MPUSETUP) & ~0x06;
738         spin_unlock_irqrestore(&chip->mixer_lock, flags);
739         switch (chip->irq) {
740         case 2:
741         case 9:
742                 irqreg |= SB_IRQSETUP_IRQ9;
743                 break;
744         case 5:
745                 irqreg |= SB_IRQSETUP_IRQ5;
746                 break;
747         case 7:
748                 irqreg |= SB_IRQSETUP_IRQ7;
749                 break;
750         case 10:
751                 irqreg |= SB_IRQSETUP_IRQ10;
752                 break;
753         default:
754                 return -EINVAL;
755         }
756         if (chip->dma8 >= 0) {
757                 switch (chip->dma8) {
758                 case 0:
759                         dmareg |= SB_DMASETUP_DMA0;
760                         break;
761                 case 1:
762                         dmareg |= SB_DMASETUP_DMA1;
763                         break;
764                 case 3:
765                         dmareg |= SB_DMASETUP_DMA3;
766                         break;
767                 default:
768                         return -EINVAL;
769                 }
770         }
771         if (chip->dma16 >= 0 && chip->dma16 != chip->dma8) {
772                 switch (chip->dma16) {
773                 case 5:
774                         dmareg |= SB_DMASETUP_DMA5;
775                         break;
776                 case 6:
777                         dmareg |= SB_DMASETUP_DMA6;
778                         break;
779                 case 7:
780                         dmareg |= SB_DMASETUP_DMA7;
781                         break;
782                 default:
783                         return -EINVAL;
784                 }
785         }
786         switch (chip->mpu_port) {
787         case 0x300:
788                 mpureg |= 0x04;
789                 break;
790         case 0x330:
791                 mpureg |= 0x00;
792                 break;
793         default:
794                 mpureg |= 0x02; /* disable MPU */
795         }
796         spin_lock_irqsave(&chip->mixer_lock, flags);
797
798         snd_sbmixer_write(chip, SB_DSP4_IRQSETUP, irqreg);
799         realirq = snd_sbmixer_read(chip, SB_DSP4_IRQSETUP);
800
801         snd_sbmixer_write(chip, SB_DSP4_DMASETUP, dmareg);
802         realdma = snd_sbmixer_read(chip, SB_DSP4_DMASETUP);
803
804         snd_sbmixer_write(chip, SB_DSP4_MPUSETUP, mpureg);
805         realmpureg = snd_sbmixer_read(chip, SB_DSP4_MPUSETUP);
806
807         spin_unlock_irqrestore(&chip->mixer_lock, flags);
808         if ((~realirq) & irqreg || (~realdma) & dmareg) {
809                 snd_printk(KERN_ERR "SB16 [0x%lx]: unable to set DMA & IRQ (PnP device?)\n", chip->port);
810                 snd_printk(KERN_ERR "SB16 [0x%lx]: wanted: irqreg=0x%x, dmareg=0x%x, mpureg = 0x%x\n", chip->port, realirq, realdma, realmpureg);
811                 snd_printk(KERN_ERR "SB16 [0x%lx]:    got: irqreg=0x%x, dmareg=0x%x, mpureg = 0x%x\n", chip->port, irqreg, dmareg, mpureg);
812                 return -ENODEV;
813         }
814         return 0;
815 }
816
817 static const struct snd_pcm_ops snd_sb16_playback_ops = {
818         .open =         snd_sb16_playback_open,
819         .close =        snd_sb16_playback_close,
820         .prepare =      snd_sb16_playback_prepare,
821         .trigger =      snd_sb16_playback_trigger,
822         .pointer =      snd_sb16_playback_pointer,
823 };
824
825 static const struct snd_pcm_ops snd_sb16_capture_ops = {
826         .open =         snd_sb16_capture_open,
827         .close =        snd_sb16_capture_close,
828         .prepare =      snd_sb16_capture_prepare,
829         .trigger =      snd_sb16_capture_trigger,
830         .pointer =      snd_sb16_capture_pointer,
831 };
832
833 int snd_sb16dsp_pcm(struct snd_sb *chip, int device)
834 {
835         struct snd_card *card = chip->card;
836         struct snd_pcm *pcm;
837         int err;
838
839         if ((err = snd_pcm_new(card, "SB16 DSP", device, 1, 1, &pcm)) < 0)
840                 return err;
841         sprintf(pcm->name, "DSP v%i.%i", chip->version >> 8, chip->version & 0xff);
842         pcm->info_flags = SNDRV_PCM_INFO_JOINT_DUPLEX;
843         pcm->private_data = chip;
844         chip->pcm = pcm;
845
846         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_sb16_playback_ops);
847         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_sb16_capture_ops);
848
849         if (chip->dma16 >= 0 && chip->dma8 != chip->dma16)
850                 snd_ctl_add(card, snd_ctl_new1(&snd_sb16_dma_control, chip));
851         else
852                 pcm->info_flags = SNDRV_PCM_INFO_HALF_DUPLEX;
853
854         snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_DEV,
855                                        card->dev, 64*1024, 128*1024);
856         return 0;
857 }
858
859 const struct snd_pcm_ops *snd_sb16dsp_get_pcm_ops(int direction)
860 {
861         return direction == SNDRV_PCM_STREAM_PLAYBACK ?
862                 &snd_sb16_playback_ops : &snd_sb16_capture_ops;
863 }
864
865 EXPORT_SYMBOL(snd_sb16dsp_pcm);
866 EXPORT_SYMBOL(snd_sb16dsp_get_pcm_ops);
867 EXPORT_SYMBOL(snd_sb16dsp_configure);
868 EXPORT_SYMBOL(snd_sb16dsp_interrupt);