+ int left, right;\r
+ unsigned char val;\r
+\r
+ if(dsp_ver >= 0x400) {\r
+ /* DSP 4.x - SB16 */\r
+ int lreg, rreg;\r
+ if(ctl == AUDIO_PCM) {\r
+ lreg = MIX_SB16_VOICE_L;\r
+ rreg = MIX_SB16_VOICE_R;\r
+ } else { /* MASTER or DEFAULT */\r
+ lreg = MIX_SB16_MASTER_L;\r
+ rreg = MIX_SB16_MASTER_R;\r
+ }\r
+\r
+ val = read_mix(lreg);\r
+ left = (val & 0xf8) | (val >> 5);\r
+ val = read_mix(rreg);\r
+ right = (val & 0xf8) | (val >> 5);\r
+\r
+ } else if(dsp_ver >= 0x300) {\r
+ /* DSP 3.x - SBPro */\r
+ val = read_mix(ctl == AUDIO_PCM ? MIX_SBPRO_VOICE : MIX_SBPRO_MASTER);\r
+\r
+ /* left is top 3 bits, duplicate twice(-ish) */\r
+ left = (val & 0xe0) | ((val >> 3) & 0x1c) | (val >> 6);\r
+ /* right is top 3 bits of the lower nibble */\r
+ right = (val << 4) | ((val << 1) & 0x1c) | ((val >> 2) & 3);\r
+\r
+ } else {\r
+ int volume;\r
+\r
+ /* DSP 2.x - SB 2.0 */\r
+ if(ctl == AUDIO_PCM) {\r
+ /* voice is in bits 1 and 2 */\r
+ val = read_mix(MIX_VOICE);\r
+ volume = (val << 5) | ((val << 3) & 0x30) | ((val << 1) & 0xc) | ((val >> 1) & 3);\r
+ } else {\r
+ /* master is in the 3 top bits of the lower nibble */\r
+ val = read_mix(MIX_MASTER);\r
+ volume = (val << 4) | ((val << 1) & 0x1c) | ((val >> 2) & 3);\r
+ }\r
+ return volume;\r
+ }\r
+\r
+ return (left + right) >> 1;\r
+}\r
+\r
+static void set_sbpro_stereo(void)\r
+{\r
+}\r
+\r
+static int start_dsp4(int rate, int bits, unsigned int mode, int num_samples)\r
+{\r
+ unsigned char cmd = bits == 8 ? DSP4_START_DMA8 : DSP4_START_DMA16;\r
+ if(auto_init) {\r
+ cmd |= DSP4_AUTO | DSP4_FIFO;\r
+ }\r
+\r
+ /* set output rate */\r
+ write_dsp(DSP4_OUT_RATE);\r
+ write_dsp(rate >> 8);\r
+ write_dsp(rate & 0xff);\r
+\r
+ /* program the DSP to start the DMA transfer */\r
+ write_dsp(cmd);\r
+ write_dsp(mode);\r
+ num_samples--;\r
+ write_dsp(num_samples & 0xff);\r
+ write_dsp((num_samples >> 8) & 0xff);\r
+\r
+ return 0;\r