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
67 #define VER_MAJOR(x) ((x) >> 8)
\r
68 #define VER_MINOR(x) ((x) & 0xff)
\r
70 /* delay for about 1us */
\r
71 #define iodelay() outp(0x80, 0)
\r
74 static int reset_dsp(void);
\r
75 static void *sb_buffer(int *size);
\r
76 static void set_output_rate(int rate);
\r
77 static void start(int rate, int bits, int nchan);
\r
78 static void pause(void);
\r
79 static void cont(void);
\r
80 static void stop(void);
\r
81 static int isplaying(void);
\r
82 static void setvolume(int ctl, int vol);
\r
83 static int getvolume(int ctl);
\r
85 static void INTERRUPT intr_handler();
\r
86 static void start_dsp4(int bits, unsigned int mode, int num_samples);
\r
87 static void start_dsp(int nchan, int num_samples);
\r
88 static void write_dsp(unsigned char val);
\r
89 static unsigned char read_dsp(void);
\r
90 static void write_mix(unsigned char val, int reg);
\r
91 static unsigned char read_mix(int reg);
\r
92 static int get_dsp_version(void);
\r
93 static int dsp4_detect_irq(void);
\r
94 static int dsp4_detect_dma(void);
\r
95 static void print_dsp_info(void);
\r
96 static const char *sbname(int ver);
\r
99 static const struct audrv sbdrv = {
\r
110 static int base_port;
\r
111 static int irq, dma_chan, dma16_chan, dsp_ver;
\r
114 static void *buffer[2];
\r
115 static volatile int wrbuf;
\r
117 static volatile int playing;
\r
118 static int cur_bits, cur_mode, auto_init;
\r
120 static void (INTERRUPT *prev_intr_handler)();
\r
123 int sb_detect(struct audrv *drv)
\r
128 if((env = getenv("BLASTER"))) {
\r
130 if(sscanf(env, "A%x I%d D%d H%d", &base_port, &irq, &dma_chan, &dma16_chan) >= 3) {
\r
131 if(reset_dsp() == 0) {
\r
132 dsp_ver = get_dsp_version();
\r
133 dsp4 = VER_MAJOR(dsp_ver) >= 4 ? 1 : 0;
\r
139 printf("sb_detect: malformed BLASTER environment variable. Fallback to probing.\n");
\r
143 for(i=0; i<6; i++) {
\r
144 base_port = 0x200 + ((i + 1) << 4);
\r
145 if(reset_dsp() == 0) {
\r
146 dsp_ver = get_dsp_version();
\r
147 dsp4 = VER_MAJOR(dsp_ver) >= 4 ? 1 : 0;
\r
150 if(dsp4_detect_irq() == -1) {
\r
151 printf("sb_detect: failed to configure IRQ\n");
\r
154 if(dsp4_detect_dma() == -1) {
\r
155 printf("sb_detect: failed to configure DMA\n");
\r
160 /* XXX for old sound blasters, hard-code to IRQ 5 DMA 1 for now */
\r
165 printf("sb_detect: old sound blaster dsp. assuming: irq 5, dma 1\n");
\r
177 static int reset_dsp(void)
\r
181 outp(REG_RESET, 1);
\r
182 for(i=0; i<3; i++) iodelay();
\r
183 outp(REG_RESET, 0);
\r
185 for(i=0; i<128; i++) {
\r
186 if(inp(REG_RSTAT) & RSTAT_RDY) {
\r
187 if(inp(REG_RDATA) == 0xaa) {
\r
196 static void set_output_rate(int rate)
\r
199 write_dsp(DSP4_OUT_RATE);
\r
200 write_dsp(rate >> 8);
\r
201 write_dsp(rate & 0xff);
\r
203 int tcon = 256 - 1000000 / rate;
\r
204 write_dsp(DSP_RATE);
\r
209 static void start(int rate, int bits, int nchan)
\r
211 uint16_t seg, pmsel;
\r
212 uint32_t addr, next64k;
\r
213 int size, num_samples;
\r
216 /* allocate a buffer in low memory that doesn't cross 64k boundaries */
\r
217 if(!(seg = dpmi_alloc(BUFSIZE * 2 / 16, &pmsel))) {
\r
218 fprintf(stderr, "SB start: failed to allocate DMA buffer\n");
\r
222 printf("DBG allocated seg: %x, addr: %lx\n", (unsigned int)seg,
\r
223 (unsigned long)seg << 4);
\r
225 addr = (uint32_t)seg << 4;
\r
226 next64k = (addr + 0x10000) & 0xffff0000;
\r
227 if(next64k - addr < BUFSIZE) {
\r
231 printf("DBG aligned: %lx (mid: %lx)\n", (unsigned long)addr, (unsigned long)(addr + BUFSIZE / 2));
\r
232 buffer[0] = (void*)addr;
\r
233 buffer[1] = (void*)(addr + BUFSIZE / 2);
\r
237 /* Auto-init playback mode:
\r
238 * fill the whole buffer with data, program the DMA for BUFSIZE transfer,
\r
239 * and program the DSP for BUFSIZE/2 transfer. We'll get an interrupt in the
\r
240 * middle, while the DSP uses the upper half, and we'll refill the bottom half.
\r
241 * Then continue ping-ponging the two halves of the buffer until we run out of
\r
246 /* TODO: if size <= BUFSIZE, do a single transfer instead */
\r
248 if(!(size = audio_callback(buffer[wrbuf], BUFSIZE))) {
\r
251 addr = (uint32_t)buffer[wrbuf];
\r
252 num_samples = bits == 8 ? size : size / 2;
\r
255 if(!prev_intr_handler) {
\r
256 prev_intr_handler = _dos_getvect(IRQ_TO_INTR(irq));
\r
258 _dos_setvect(IRQ_TO_INTR(irq), intr_handler);
\r
264 cur_mode = bits == 8 ? 0 : DSP4_MODE_SIGNED;
\r
266 cur_mode |= DSP4_MODE_STEREO;
\r
269 write_dsp(DSP_ENABLE_OUTPUT);
\r
270 dma_out(cur_bits == 8 ? dma_chan : dma16_chan, addr, BUFSIZE, DMA_SINGLE | DMA_AUTO);
\r
271 set_output_rate(rate);
\r
272 start_dsp4(cur_bits, cur_mode, num_samples / 2);
\r
276 static void start_dsp4(int bits, unsigned int mode, int num_samples)
\r
278 unsigned char cmd = bits == 8 ? DSP4_START_DMA8 : DSP4_START_DMA16;
\r
279 cmd |= DSP4_AUTO | DSP4_FIFO;
\r
281 /* program the DSP to start the DMA transfer */
\r
285 write_dsp(num_samples & 0xff);
\r
286 write_dsp((num_samples >> 8) & 0xff);
\r
289 static void start_dsp(int nchan, int num_samples)
\r
291 /* program the DSP to start the DMA transfer */
\r
295 static void pause(void)
\r
297 write_dsp(cur_bits == 8 ? DSP_PAUSE_DMA8 : DSP_PAUSE_DMA16);
\r
300 static void cont(void)
\r
302 write_dsp(cur_bits == 8 ? DSP_CONT_DMA8 : DSP_CONT_DMA16);
\r
305 static void stop(void)
\r
307 write_dsp(DSP_DISABLE_OUTPUT);
\r
310 /* TODO: don't _enable, restore state */
\r
312 _dos_setvect(IRQ_TO_INTR(irq), prev_intr_handler);
\r
315 write_dsp(cur_bits == 8 ? DSP_END_DMA8 : DSP_END_DMA16);
\r
319 static int isplaying(void)
\r
324 static void setvolume(int ctl, int vol)
\r
328 if(VER_MAJOR(dsp_ver) >= 4) {
\r
329 /* DSP 4.x - SB16 */
\r
331 if(ctl == AUDIO_PCM) {
\r
332 write_mix(MIX_SB16_VOICE_L, vol);
\r
333 write_mix(MIX_SB16_VOICE_R, vol);
\r
335 write_mix(MIX_SB16_MASTER_L, vol);
\r
336 write_mix(MIX_SB16_MASTER_R, vol);
\r
339 } else if(VER_MAJOR(dsp_ver) >= 3) {
\r
340 /* DSP 3.x - SBPro */
\r
344 if(ctl == AUDIO_PCM) {
\r
345 write_mix(MIX_SBPRO_VOICE, val);
\r
347 write_mix(MIX_SBPRO_MASTER, val);
\r
351 /* DSP 2.x - SB 2.0 */
\r
352 if(ctl == AUDIO_PCM) {
\r
353 val = (vol >> 5) & 6;
\r
354 write_mix(MIX_VOICE, val);
\r
356 val = (vol >> 4) & 0xe;
\r
357 write_mix(MIX_MASTER, val);
\r
362 static int getvolume(int ctl)
\r
367 if(VER_MAJOR(dsp_ver) >= 4) {
\r
368 /* DSP 4.x - SB16 */
\r
370 if(ctl == AUDIO_PCM) {
\r
371 lreg = MIX_SB16_VOICE_L;
\r
372 rreg = MIX_SB16_VOICE_R;
\r
373 } else { /* MASTER or DEFAULT */
\r
374 lreg = MIX_SB16_MASTER_L;
\r
375 rreg = MIX_SB16_MASTER_R;
\r
378 val = read_mix(lreg);
\r
379 left = (val & 0xf8) | ((val >> 3) & 7); /* duplicate last 3 bits */
\r
380 val = read_mix(rreg);
\r
381 right = (val & 0xf8) | ((val >> 3) & 7);
\r
383 } else if(VER_MAJOR(dsp_ver) >= 3) {
\r
384 /* DSP 3.x - SBPro */
\r
385 val = read_mix(ctl == AUDIO_PCM ? MIX_SBPRO_VOICE : MIX_SBPRO_MASTER);
\r
387 /* left is top 3 bits, duplicate twice(-ish) */
\r
388 left = (val & 0xe0) | ((val >> 3) & 0x1c) | (val >> 6);
\r
389 /* right is top 3 bits of the lower nibble */
\r
390 right = (val << 4) | ((val << 1) & 0x1c) | ((val >> 2) & 3);
\r
395 /* DSP 2.x - SB 2.0 */
\r
396 if(ctl == AUDIO_PCM) {
\r
397 /* voice is in bits 1 and 2 */
\r
398 val = read_mix(MIX_VOICE);
\r
399 volume = (val << 5) | ((val << 3) & 0x30) | ((val << 1) & 0xc) | ((val >> 1) & 3);
\r
401 /* master is in the 3 top bits of the lower nibble */
\r
402 val = read_mix(MIX_MASTER);
\r
403 volume = (val << 4) | ((val << 1) & 0x1c) | ((val >> 2) & 3);
\r
408 return (left + right) >> 1;
\r
411 static void INTERRUPT intr_handler()
\r
414 void *bptr = buffer[wrbuf];
\r
415 uint32_t addr = (uint32_t)bptr;
\r
419 /* ask for more data */
\r
420 if(!(size = audio_callback(bptr, BUFSIZE / 2))) {
\r
424 /* acknowledge the interrupt */
\r
425 if(cur_bits == 8) {
\r
429 unsigned char istat;
\r
430 outp(REG_MIXPORT, 0x82);
\r
431 istat = inp(REG_MIXDATA);
\r
439 outp(PIC2_CMD, OCW2_EOI);
\r
441 outp(PIC1_CMD, OCW2_EOI);
\r
444 static void write_dsp(unsigned char val)
\r
446 while(inp(REG_WSTAT) & WSTAT_BUSY);
\r
447 outp(REG_WDATA, val);
\r
450 static unsigned char read_dsp(void)
\r
452 while((inp(REG_RSTAT) & RSTAT_RDY) == 0);
\r
453 return inp(REG_RDATA);
\r
456 static void write_mix(unsigned char val, int reg)
\r
458 outp(REG_MIXPORT, reg);
\r
459 outp(REG_MIXDATA, val);
\r
462 static unsigned char read_mix(int reg)
\r
464 outp(REG_MIXPORT, reg);
\r
465 return inp(REG_MIXDATA);
\r
468 static int get_dsp_version(void)
\r
472 write_dsp(DSP_GET_VER);
\r
473 major = read_dsp();
\r
474 minor = read_dsp();
\r
476 return (major << 8) | minor;
\r
479 static int dsp4_detect_irq(void)
\r
482 static int irqtab[] = {2, 5, 7, 10};
\r
485 irqsel = read_mix(MIX_SB16_IRQ_SEL);
\r
486 for(i=0; i<4; i++) {
\r
487 if(irqsel & (1 << i)) {
\r
493 /* try to force IRQ 5 */
\r
494 write_mix(2, MIX_SB16_IRQ_SEL); /* bit1 selects irq 5 */
\r
496 /* re-read to verify */
\r
497 irqsel = read_mix(MIX_SB16_IRQ_SEL);
\r
507 static int dsp4_detect_dma(void)
\r
509 int i, dmasel, tmp;
\r
510 static int dmatab[] = {0, 1, -1, 3, -1, 5, 6, 7};
\r
514 dmasel = read_mix(MIX_SB16_DMA_SEL);
\r
515 for(i=0; i<4; i++) {
\r
516 if(dmasel & (1 << i)) {
\r
517 dma_chan = dmatab[i];
\r
521 for(i=5; i<8; i++) {
\r
522 if(dmasel & (1 << i)) {
\r
523 dma16_chan = dmatab[i];
\r
527 if(dma_chan == -1) {
\r
528 /* try to force DMA 1 */
\r
531 if(dma16_chan == -1) {
\r
532 /* try to force 16bit DMA 5 */
\r
536 if(dma_chan == -1 || dma16_chan == -1) {
\r
537 write_mix(dmasel, MIX_SB16_DMA_SEL);
\r
539 /* re-read to verify */
\r
540 tmp = read_mix(MIX_SB16_DMA_SEL);
\r
541 if(tmp != dmasel) {
\r
551 static void print_dsp_info(void)
\r
553 printf("sb_detect: %s (DSP v%d.%02d) port %xh, irq %d", sbname(dsp_ver),
\r
554 VER_MAJOR(dsp_ver), VER_MINOR(dsp_ver), base_port, irq);
\r
555 if(VER_MAJOR(dsp_ver) >= 4) {
\r
556 printf(" dma %d/%d\n", dma_chan, dma16_chan);
\r
558 printf(" dma %d\n", dma_chan);
\r
562 #define V(maj, min) (((maj) << 8) | (min))
\r
564 static const char *sbname(int ver)
\r
566 int major = VER_MAJOR(ver);
\r
567 int minor = VER_MINOR(ver);
\r
572 return "Sound Blaster 1.5";
\r
574 return "Sound Blaster 1.0";
\r
577 if(minor == 1 || minor == 2) {
\r
578 return "Sound Blaster 2.0";
\r
585 return "Sound Blaster Pro";
\r
588 return "Sound Blaster Pro 2";
\r
590 return "Gallant SC-6000";
\r
600 return "Sound Blaster 16";
\r
602 return "Sound Blaster 16 SCSI-2";
\r
604 return "Sound Blaster AWE 32";
\r
606 return "Sound Blaster ViBRA16C";
\r
608 return "Sound Blaster AWE 64";
\r
615 return "Unknown Sound Blaster";
\r