12 #define BUFSIZE 16384
\r
14 #define REG_MIXPORT (base_port + 0x4)
\r
15 #define REG_MIXDATA (base_port + 0x5)
\r
16 #define REG_RESET (base_port + 0x6)
\r
17 #define REG_RDATA (base_port + 0xa)
\r
18 #define REG_WDATA (base_port + 0xc)
\r
19 #define REG_WSTAT (base_port + 0xc)
\r
20 #define REG_RSTAT (base_port + 0xe)
\r
21 #define REG_INTACK (base_port + 0xe)
\r
22 #define REG_INT16ACK (base_port + 0xf)
\r
24 #define WSTAT_BUSY 0x80
\r
25 #define RSTAT_RDY 0x80
\r
27 #define DSP_RATE 0x40
\r
28 #define DSP4_OUT_RATE 0x41
\r
29 #define DSP4_IN_RATE 0x42
\r
30 #define DSP_GET_VER 0xe1
\r
32 /* start DMA playback/recording. combine with fifo/auto/input flags */
\r
33 #define DSP4_START_DMA8 0xc0
\r
34 #define DSP4_START_DMA16 0xb0
\r
35 #define DSP4_FIFO 0x02
\r
36 #define DSP4_AUTO 0x04
\r
37 #define DSP4_INPUT 0x08
\r
39 /* transfer mode commands */
\r
40 #define DSP4_MODE_SIGNED 0x10
\r
41 #define DSP4_MODE_STEREO 0x20
\r
43 /* immediately pause/continue */
\r
44 #define DSP_PAUSE_DMA8 0xd0
\r
45 #define DSP_ENABLE_OUTPUT 0xd1
\r
46 #define DSP_DISABLE_OUTPUT 0xd3
\r
47 #define DSP_CONT_DMA8 0xd4
\r
48 #define DSP_PAUSE_DMA16 0xd5
\r
49 #define DSP_CONT_DMA16 0xd6
\r
51 /* end the playback at the end of the current buffer */
\r
52 #define DSP_END_DMA16 0xd9
\r
53 #define DSP_END_DMA8 0xda
\r
55 /* mixer registers */
\r
56 #define MIX_MASTER 0x02
\r
57 #define MIX_VOICE 0x0a
\r
58 #define MIX_SBPRO_VOICE 0x04
\r
59 #define MIX_SBPRO_MASTER 0x22
\r
60 #define MIX_SB16_MASTER_L 0x30
\r
61 #define MIX_SB16_MASTER_R 0x31
\r
62 #define MIX_SB16_VOICE_L 0x32
\r
63 #define MIX_SB16_VOICE_R 0x33
\r
64 #define MIX_SB16_IRQ_SEL 0x80
\r
65 #define MIX_SB16_DMA_SEL 0x81
\r
66 #define MIX_SB16_INTSTAT 0x82
\r
68 #define INTSTAT_DMA8 0x01
\r
69 #define INTSTAT_DMA16 0x02
\r
70 #define INTSTAT_MPU401 0x04
\r
72 #define VER_MAJOR(x) ((x) >> 8)
\r
73 #define VER_MINOR(x) ((x) & 0xff)
\r
75 /* delay for about 1us */
\r
76 #define iodelay() outp(0x80, 0)
\r
79 static int reset_dsp(void);
\r
80 static void *sb_buffer(int *size);
\r
81 static void set_output_rate(int rate);
\r
82 static void start(int rate, int bits, int nchan);
\r
83 static void pause(void);
\r
84 static void cont(void);
\r
85 static void stop(void);
\r
86 static int isplaying(void);
\r
87 static void setvolume(int ctl, int vol);
\r
88 static int getvolume(int ctl);
\r
90 static void INTERRUPT intr_handler();
\r
91 static void start_dsp4(int bits, unsigned int mode, int num_samples);
\r
92 static void start_dsp(int nchan, int num_samples);
\r
93 static void write_dsp(unsigned char val);
\r
94 static unsigned char read_dsp(void);
\r
95 static void write_mix(int reg, unsigned char val);
\r
96 static unsigned char read_mix(int reg);
\r
97 static int get_dsp_version(void);
\r
98 static int dsp4_detect_irq(void);
\r
99 static int dsp4_detect_dma(void);
\r
100 static void print_dsp_info(void);
\r
101 static const char *sbname(int ver);
\r
104 static const struct audrv sbdrv = {
\r
115 static int base_port;
\r
116 static int irq, dma_chan, dma16_chan, dsp_ver;
\r
119 static void *buffer[2];
\r
120 static volatile int wrbuf;
\r
122 static volatile int playing;
\r
123 static int cur_bits, cur_mode, auto_init;
\r
125 static void (INTERRUPT *prev_intr_handler)();
\r
128 int sb_detect(struct audrv *drv)
\r
133 if((env = getenv("BLASTER"))) {
\r
135 if(sscanf(env, "A%x I%d D%d H%d", &base_port, &irq, &dma_chan, &dma16_chan) >= 3) {
\r
136 if(reset_dsp() == 0) {
\r
137 dsp_ver = get_dsp_version();
\r
138 dsp4 = VER_MAJOR(dsp_ver) >= 4 ? 1 : 0;
\r
144 printf("sb_detect: malformed BLASTER environment variable. Fallback to probing.\n");
\r
148 for(i=0; i<6; i++) {
\r
149 base_port = 0x200 + ((i + 1) << 4);
\r
150 if(reset_dsp() == 0) {
\r
151 dsp_ver = get_dsp_version();
\r
152 dsp4 = VER_MAJOR(dsp_ver) >= 4 ? 1 : 0;
\r
155 if(dsp4_detect_irq() == -1) {
\r
156 printf("sb_detect: failed to configure IRQ\n");
\r
159 if(dsp4_detect_dma() == -1) {
\r
160 printf("sb_detect: failed to configure DMA\n");
\r
165 /* XXX for old sound blasters, hard-code to IRQ 5 DMA 1 for now */
\r
170 printf("sb_detect: old sound blaster dsp. assuming: irq 5, dma 1\n");
\r
182 static int reset_dsp(void)
\r
186 outp(REG_RESET, 1);
\r
187 for(i=0; i<3; i++) iodelay();
\r
188 outp(REG_RESET, 0);
\r
190 for(i=0; i<128; i++) {
\r
191 if(inp(REG_RSTAT) & RSTAT_RDY) {
\r
192 if(inp(REG_RDATA) == 0xaa) {
\r
201 static void set_output_rate(int rate)
\r
204 write_dsp(DSP4_OUT_RATE);
\r
205 write_dsp(rate >> 8);
\r
206 write_dsp(rate & 0xff);
\r
208 int tcon = 256 - 1000000 / rate;
\r
209 write_dsp(DSP_RATE);
\r
214 static void start(int rate, int bits, int nchan)
\r
216 uint16_t seg, pmsel;
\r
217 uint32_t addr, next64k;
\r
218 int size, num_samples;
\r
221 /* allocate a buffer in low memory that doesn't cross 64k boundaries */
\r
222 if(!(seg = dpmi_alloc(BUFSIZE * 2 / 16, &pmsel))) {
\r
223 fprintf(stderr, "SB start: failed to allocate DMA buffer\n");
\r
227 addr = (uint32_t)seg << 4;
\r
228 next64k = (addr + 0x10000) & 0xffff0000;
\r
229 if(next64k - addr < BUFSIZE) {
\r
233 buffer[0] = (void*)addr;
\r
234 buffer[1] = (void*)(addr + BUFSIZE / 2);
\r
238 /* Auto-init playback mode:
\r
239 * fill the whole buffer with data, program the DMA for BUFSIZE transfer,
\r
240 * and program the DSP for BUFSIZE/2 transfer. We'll get an interrupt in the
\r
241 * middle, while the DSP uses the upper half, and we'll refill the bottom half.
\r
242 * Then continue ping-ponging the two halves of the buffer until we run out of
\r
247 /* TODO: if size <= BUFSIZE, do a single transfer instead */
\r
249 if(!(size = audio_callback(buffer[wrbuf], BUFSIZE))) {
\r
252 addr = (uint32_t)buffer[wrbuf];
\r
253 num_samples = bits == 8 ? size : size / 2;
\r
256 if(!prev_intr_handler) {
\r
257 prev_intr_handler = _dos_getvect(IRQ_TO_INTR(irq));
\r
259 _dos_setvect(IRQ_TO_INTR(irq), intr_handler);
\r
265 cur_mode = bits == 8 ? 0 : DSP4_MODE_SIGNED;
\r
267 cur_mode |= DSP4_MODE_STEREO;
\r
270 write_dsp(DSP_ENABLE_OUTPUT);
\r
271 dma_out(cur_bits == 8 ? dma_chan : dma16_chan, addr, BUFSIZE, DMA_SINGLE | DMA_AUTO);
\r
272 set_output_rate(rate);
\r
273 start_dsp4(cur_bits, cur_mode, num_samples / 2);
\r
277 static void start_dsp4(int bits, unsigned int mode, int num_samples)
\r
279 unsigned char cmd = bits == 8 ? DSP4_START_DMA8 : DSP4_START_DMA16;
\r
280 cmd |= DSP4_AUTO | DSP4_FIFO;
\r
282 /* program the DSP to start the DMA transfer */
\r
286 write_dsp(num_samples & 0xff);
\r
287 write_dsp((num_samples >> 8) & 0xff);
\r
290 static void start_dsp(int nchan, int num_samples)
\r
292 /* program the DSP to start the DMA transfer */
\r
296 static void pause(void)
\r
298 write_dsp(cur_bits == 8 ? DSP_PAUSE_DMA8 : DSP_PAUSE_DMA16);
\r
301 static void cont(void)
\r
303 write_dsp(cur_bits == 8 ? DSP_CONT_DMA8 : DSP_CONT_DMA16);
\r
306 static void stop(void)
\r
308 write_dsp(DSP_DISABLE_OUTPUT);
\r
311 /* TODO: don't _enable, restore state */
\r
313 _dos_setvect(IRQ_TO_INTR(irq), prev_intr_handler);
\r
316 write_dsp(cur_bits == 8 ? DSP_END_DMA8 : DSP_END_DMA16);
\r
320 static int isplaying(void)
\r
325 static void setvolume(int ctl, int vol)
\r
329 if(VER_MAJOR(dsp_ver) >= 4) {
\r
330 /* DSP 4.x - SB16 */
\r
332 if(ctl == AUDIO_PCM) {
\r
333 write_mix(MIX_SB16_VOICE_L, val);
\r
334 write_mix(MIX_SB16_VOICE_R, val);
\r
336 write_mix(MIX_SB16_MASTER_L, val);
\r
337 write_mix(MIX_SB16_MASTER_R, val);
\r
340 } else if(VER_MAJOR(dsp_ver) >= 3) {
\r
341 /* DSP 3.x - SBPro */
\r
345 if(ctl == AUDIO_PCM) {
\r
346 write_mix(MIX_SBPRO_VOICE, val);
\r
348 write_mix(MIX_SBPRO_MASTER, val);
\r
352 /* DSP 2.x - SB 2.0 */
\r
353 if(ctl == AUDIO_PCM) {
\r
354 val = (vol >> 5) & 6;
\r
355 write_mix(MIX_VOICE, val);
\r
357 val = (vol >> 4) & 0xe;
\r
358 write_mix(MIX_MASTER, val);
\r
363 static int getvolume(int ctl)
\r
368 if(VER_MAJOR(dsp_ver) >= 4) {
\r
369 /* DSP 4.x - SB16 */
\r
371 if(ctl == AUDIO_PCM) {
\r
372 lreg = MIX_SB16_VOICE_L;
\r
373 rreg = MIX_SB16_VOICE_R;
\r
374 } else { /* MASTER or DEFAULT */
\r
375 lreg = MIX_SB16_MASTER_L;
\r
376 rreg = MIX_SB16_MASTER_R;
\r
379 val = read_mix(lreg);
\r
380 left = (val & 0xf8) | (val >> 5);
\r
381 val = read_mix(rreg);
\r
382 right = (val & 0xf8) | (val >> 5);
\r
384 } else if(VER_MAJOR(dsp_ver) >= 3) {
\r
385 /* DSP 3.x - SBPro */
\r
386 val = read_mix(ctl == AUDIO_PCM ? MIX_SBPRO_VOICE : MIX_SBPRO_MASTER);
\r
388 /* left is top 3 bits, duplicate twice(-ish) */
\r
389 left = (val & 0xe0) | ((val >> 3) & 0x1c) | (val >> 6);
\r
390 /* right is top 3 bits of the lower nibble */
\r
391 right = (val << 4) | ((val << 1) & 0x1c) | ((val >> 2) & 3);
\r
396 /* DSP 2.x - SB 2.0 */
\r
397 if(ctl == AUDIO_PCM) {
\r
398 /* voice is in bits 1 and 2 */
\r
399 val = read_mix(MIX_VOICE);
\r
400 volume = (val << 5) | ((val << 3) & 0x30) | ((val << 1) & 0xc) | ((val >> 1) & 3);
\r
402 /* master is in the 3 top bits of the lower nibble */
\r
403 val = read_mix(MIX_MASTER);
\r
404 volume = (val << 4) | ((val << 1) & 0x1c) | ((val >> 2) & 3);
\r
409 return (left + right) >> 1;
\r
412 static void INTERRUPT intr_handler()
\r
415 void *bptr = buffer[wrbuf];
\r
416 uint32_t addr = (uint32_t)bptr;
\r
420 /* ask for more data */
\r
421 if(!(size = audio_callback(bptr, BUFSIZE / 2))) {
\r
425 /* acknowledge the interrupt */
\r
426 if(cur_bits == 8) {
\r
429 unsigned char istat = read_mix(MIX_SB16_INTSTAT);
\r
430 if(istat & INTSTAT_DMA16) {
\r
436 outp(PIC2_CMD, OCW2_EOI);
\r
438 outp(PIC1_CMD, OCW2_EOI);
\r
441 static void write_dsp(unsigned char val)
\r
443 while(inp(REG_WSTAT) & WSTAT_BUSY);
\r
444 outp(REG_WDATA, val);
\r
447 static unsigned char read_dsp(void)
\r
449 while((inp(REG_RSTAT) & RSTAT_RDY) == 0);
\r
450 return inp(REG_RDATA);
\r
453 static void write_mix(int reg, unsigned char val)
\r
455 outp(REG_MIXPORT, reg);
\r
456 outp(REG_MIXDATA, val);
\r
459 static unsigned char read_mix(int reg)
\r
461 outp(REG_MIXPORT, reg);
\r
462 return inp(REG_MIXDATA);
\r
465 static int get_dsp_version(void)
\r
469 write_dsp(DSP_GET_VER);
\r
470 major = read_dsp();
\r
471 minor = read_dsp();
\r
473 return (major << 8) | minor;
\r
476 static int dsp4_detect_irq(void)
\r
479 static int irqtab[] = {2, 5, 7, 10};
\r
482 irqsel = read_mix(MIX_SB16_IRQ_SEL);
\r
483 for(i=0; i<4; i++) {
\r
484 if(irqsel & (1 << i)) {
\r
490 /* try to force IRQ 5 */
\r
491 write_mix(MIX_SB16_IRQ_SEL, 2); /* bit1 selects irq 5 */
\r
493 /* re-read to verify */
\r
494 irqsel = read_mix(MIX_SB16_IRQ_SEL);
\r
504 static int dsp4_detect_dma(void)
\r
506 int i, dmasel, tmp;
\r
507 static int dmatab[] = {0, 1, -1, 3, -1, 5, 6, 7};
\r
511 dmasel = read_mix(MIX_SB16_DMA_SEL);
\r
512 for(i=0; i<4; i++) {
\r
513 if(dmasel & (1 << i)) {
\r
514 dma_chan = dmatab[i];
\r
518 for(i=5; i<8; i++) {
\r
519 if(dmasel & (1 << i)) {
\r
520 dma16_chan = dmatab[i];
\r
524 if(dma_chan == -1) {
\r
525 /* try to force DMA 1 */
\r
528 if(dma16_chan == -1) {
\r
529 /* try to force 16bit DMA 5 */
\r
533 if(dma_chan == -1 || dma16_chan == -1) {
\r
534 write_mix(MIX_SB16_DMA_SEL, dmasel);
\r
536 /* re-read to verify */
\r
537 tmp = read_mix(MIX_SB16_DMA_SEL);
\r
538 if(tmp != dmasel) {
\r
548 static void print_dsp_info(void)
\r
550 printf("sb_detect: %s (DSP v%d.%02d) port %xh, irq %d", sbname(dsp_ver),
\r
551 VER_MAJOR(dsp_ver), VER_MINOR(dsp_ver), base_port, irq);
\r
552 if(VER_MAJOR(dsp_ver) >= 4) {
\r
553 printf(" dma %d/%d\n", dma_chan, dma16_chan);
\r
555 printf(" dma %d\n", dma_chan);
\r
559 #define V(maj, min) (((maj) << 8) | (min))
\r
561 static const char *sbname(int ver)
\r
563 int major = VER_MAJOR(ver);
\r
564 int minor = VER_MINOR(ver);
\r
569 return "Sound Blaster 1.5";
\r
571 return "Sound Blaster 1.0";
\r
574 if(minor == 1 || minor == 2) {
\r
575 return "Sound Blaster 2.0";
\r
582 return "Sound Blaster Pro";
\r
585 return "Sound Blaster Pro 2";
\r
587 return "Gallant SC-6000";
\r
597 return "Sound Blaster 16";
\r
599 return "Sound Blaster 16 SCSI-2";
\r
601 return "Sound Blaster AWE 32";
\r
603 return "Sound Blaster ViBRA16C";
\r
605 return "Sound Blaster AWE 64";
\r
612 return "Unknown Sound Blaster";
\r