2 * Driver for S3 SonicVibes soundcard
3 * Copyright (c) by Jaroslav Kysela <perex@perex.cz>
6 * It looks like 86c617 rev 3 doesn't supports DDMA buffers above 16MB?
7 * Driver sometimes hangs... Nobody knows why at this moment...
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
25 #include <linux/delay.h>
26 #include <linux/init.h>
27 #include <linux/interrupt.h>
28 #include <linux/pci.h>
29 #include <linux/slab.h>
30 #include <linux/gameport.h>
31 #include <linux/moduleparam.h>
32 #include <linux/dma-mapping.h>
34 #include <sound/core.h>
35 #include <sound/pcm.h>
36 #include <sound/info.h>
37 #include <sound/control.h>
38 #include <sound/mpu401.h>
39 #include <sound/opl3.h>
40 #include <sound/initval.h>
44 MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
45 MODULE_DESCRIPTION("S3 SonicVibes PCI");
46 MODULE_LICENSE("GPL");
47 MODULE_SUPPORTED_DEVICE("{{S3,SonicVibes PCI}}");
49 #if defined(CONFIG_GAMEPORT) || (defined(MODULE) && defined(CONFIG_GAMEPORT_MODULE))
50 #define SUPPORT_JOYSTICK 1
53 static int index
[SNDRV_CARDS
] = SNDRV_DEFAULT_IDX
; /* Index 0-MAX */
54 static char *id
[SNDRV_CARDS
] = SNDRV_DEFAULT_STR
; /* ID for this card */
55 static int enable
[SNDRV_CARDS
] = SNDRV_DEFAULT_ENABLE_PNP
; /* Enable this card */
56 static int reverb
[SNDRV_CARDS
];
57 static int mge
[SNDRV_CARDS
];
58 static unsigned int dmaio
= 0x7a00; /* DDMA i/o address */
60 module_param_array(index
, int, NULL
, 0444);
61 MODULE_PARM_DESC(index
, "Index value for S3 SonicVibes soundcard.");
62 module_param_array(id
, charp
, NULL
, 0444);
63 MODULE_PARM_DESC(id
, "ID string for S3 SonicVibes soundcard.");
64 module_param_array(enable
, bool, NULL
, 0444);
65 MODULE_PARM_DESC(enable
, "Enable S3 SonicVibes soundcard.");
66 module_param_array(reverb
, bool, NULL
, 0444);
67 MODULE_PARM_DESC(reverb
, "Enable reverb (SRAM is present) for S3 SonicVibes soundcard.");
68 module_param_array(mge
, bool, NULL
, 0444);
69 MODULE_PARM_DESC(mge
, "MIC Gain Enable for S3 SonicVibes soundcard.");
70 module_param(dmaio
, uint
, 0444);
71 MODULE_PARM_DESC(dmaio
, "DDMA i/o base address for S3 SonicVibes soundcard.");
74 * Enhanced port direct registers
77 #define SV_REG(sonic, x) ((sonic)->enh_port + SV_REG_##x)
79 #define SV_REG_CONTROL 0x00 /* R/W: CODEC/Mixer control register */
80 #define SV_ENHANCED 0x01 /* audio mode select - enhanced mode */
81 #define SV_TEST 0x02 /* test bit */
82 #define SV_REVERB 0x04 /* reverb enable */
83 #define SV_WAVETABLE 0x08 /* wavetable active / FM active if not set */
84 #define SV_INTA 0x20 /* INTA driving - should be always 1 */
85 #define SV_RESET 0x80 /* reset chip */
86 #define SV_REG_IRQMASK 0x01 /* R/W: CODEC/Mixer interrupt mask register */
87 #define SV_DMAA_MASK 0x01 /* mask DMA-A interrupt */
88 #define SV_DMAC_MASK 0x04 /* mask DMA-C interrupt */
89 #define SV_SPEC_MASK 0x08 /* special interrupt mask - should be always masked */
90 #define SV_UD_MASK 0x40 /* Up/Down button interrupt mask */
91 #define SV_MIDI_MASK 0x80 /* mask MIDI interrupt */
92 #define SV_REG_STATUS 0x02 /* R/O: CODEC/Mixer status register */
93 #define SV_DMAA_IRQ 0x01 /* DMA-A interrupt */
94 #define SV_DMAC_IRQ 0x04 /* DMA-C interrupt */
95 #define SV_SPEC_IRQ 0x08 /* special interrupt */
96 #define SV_UD_IRQ 0x40 /* Up/Down interrupt */
97 #define SV_MIDI_IRQ 0x80 /* MIDI interrupt */
98 #define SV_REG_INDEX 0x04 /* R/W: CODEC/Mixer index address register */
99 #define SV_MCE 0x40 /* mode change enable */
100 #define SV_TRD 0x80 /* DMA transfer request disabled */
101 #define SV_REG_DATA 0x05 /* R/W: CODEC/Mixer index data register */
104 * Enhanced port indirect registers
107 #define SV_IREG_LEFT_ADC 0x00 /* Left ADC Input Control */
108 #define SV_IREG_RIGHT_ADC 0x01 /* Right ADC Input Control */
109 #define SV_IREG_LEFT_AUX1 0x02 /* Left AUX1 Input Control */
110 #define SV_IREG_RIGHT_AUX1 0x03 /* Right AUX1 Input Control */
111 #define SV_IREG_LEFT_CD 0x04 /* Left CD Input Control */
112 #define SV_IREG_RIGHT_CD 0x05 /* Right CD Input Control */
113 #define SV_IREG_LEFT_LINE 0x06 /* Left Line Input Control */
114 #define SV_IREG_RIGHT_LINE 0x07 /* Right Line Input Control */
115 #define SV_IREG_MIC 0x08 /* MIC Input Control */
116 #define SV_IREG_GAME_PORT 0x09 /* Game Port Control */
117 #define SV_IREG_LEFT_SYNTH 0x0a /* Left Synth Input Control */
118 #define SV_IREG_RIGHT_SYNTH 0x0b /* Right Synth Input Control */
119 #define SV_IREG_LEFT_AUX2 0x0c /* Left AUX2 Input Control */
120 #define SV_IREG_RIGHT_AUX2 0x0d /* Right AUX2 Input Control */
121 #define SV_IREG_LEFT_ANALOG 0x0e /* Left Analog Mixer Output Control */
122 #define SV_IREG_RIGHT_ANALOG 0x0f /* Right Analog Mixer Output Control */
123 #define SV_IREG_LEFT_PCM 0x10 /* Left PCM Input Control */
124 #define SV_IREG_RIGHT_PCM 0x11 /* Right PCM Input Control */
125 #define SV_IREG_DMA_DATA_FMT 0x12 /* DMA Data Format */
126 #define SV_IREG_PC_ENABLE 0x13 /* Playback/Capture Enable Register */
127 #define SV_IREG_UD_BUTTON 0x14 /* Up/Down Button Register */
128 #define SV_IREG_REVISION 0x15 /* Revision */
129 #define SV_IREG_ADC_OUTPUT_CTRL 0x16 /* ADC Output Control */
130 #define SV_IREG_DMA_A_UPPER 0x18 /* DMA A Upper Base Count */
131 #define SV_IREG_DMA_A_LOWER 0x19 /* DMA A Lower Base Count */
132 #define SV_IREG_DMA_C_UPPER 0x1c /* DMA C Upper Base Count */
133 #define SV_IREG_DMA_C_LOWER 0x1d /* DMA C Lower Base Count */
134 #define SV_IREG_PCM_RATE_LOW 0x1e /* PCM Sampling Rate Low Byte */
135 #define SV_IREG_PCM_RATE_HIGH 0x1f /* PCM Sampling Rate High Byte */
136 #define SV_IREG_SYNTH_RATE_LOW 0x20 /* Synthesizer Sampling Rate Low Byte */
137 #define SV_IREG_SYNTH_RATE_HIGH 0x21 /* Synthesizer Sampling Rate High Byte */
138 #define SV_IREG_ADC_CLOCK 0x22 /* ADC Clock Source Selection */
139 #define SV_IREG_ADC_ALT_RATE 0x23 /* ADC Alternative Sampling Rate Selection */
140 #define SV_IREG_ADC_PLL_M 0x24 /* ADC PLL M Register */
141 #define SV_IREG_ADC_PLL_N 0x25 /* ADC PLL N Register */
142 #define SV_IREG_SYNTH_PLL_M 0x26 /* Synthesizer PLL M Register */
143 #define SV_IREG_SYNTH_PLL_N 0x27 /* Synthesizer PLL N Register */
144 #define SV_IREG_MPU401 0x2a /* MPU-401 UART Operation */
145 #define SV_IREG_DRIVE_CTRL 0x2b /* Drive Control */
146 #define SV_IREG_SRS_SPACE 0x2c /* SRS Space Control */
147 #define SV_IREG_SRS_CENTER 0x2d /* SRS Center Control */
148 #define SV_IREG_WAVE_SOURCE 0x2e /* Wavetable Sample Source Select */
149 #define SV_IREG_ANALOG_POWER 0x30 /* Analog Power Down Control */
150 #define SV_IREG_DIGITAL_POWER 0x31 /* Digital Power Down Control */
152 #define SV_IREG_ADC_PLL SV_IREG_ADC_PLL_M
153 #define SV_IREG_SYNTH_PLL SV_IREG_SYNTH_PLL_M
159 #define SV_DMA_ADDR0 0x00
160 #define SV_DMA_ADDR1 0x01
161 #define SV_DMA_ADDR2 0x02
162 #define SV_DMA_ADDR3 0x03
163 #define SV_DMA_COUNT0 0x04
164 #define SV_DMA_COUNT1 0x05
165 #define SV_DMA_COUNT2 0x06
166 #define SV_DMA_MODE 0x0b
167 #define SV_DMA_RESET 0x0d
168 #define SV_DMA_MASK 0x0f
174 #define SV_RECSRC_RESERVED (0x00<<5)
175 #define SV_RECSRC_CD (0x01<<5)
176 #define SV_RECSRC_DAC (0x02<<5)
177 #define SV_RECSRC_AUX2 (0x03<<5)
178 #define SV_RECSRC_LINE (0x04<<5)
179 #define SV_RECSRC_AUX1 (0x05<<5)
180 #define SV_RECSRC_MIC (0x06<<5)
181 #define SV_RECSRC_OUT (0x07<<5)
187 #define SV_FULLRATE 48000
188 #define SV_REFFREQUENCY 24576000
189 #define SV_ADCMULT 512
191 #define SV_MODE_PLAY 1
192 #define SV_MODE_CAPTURE 2
199 unsigned long dma1size
;
200 unsigned long dma2size
;
203 unsigned long sb_port
;
204 unsigned long enh_port
;
205 unsigned long synth_port
;
206 unsigned long midi_port
;
207 unsigned long game_port
;
208 unsigned int dmaa_port
;
209 struct resource
*res_dmaa
;
210 unsigned int dmac_port
;
211 struct resource
*res_dmac
;
213 unsigned char enable
;
214 unsigned char irqmask
;
215 unsigned char revision
;
216 unsigned char format
;
217 unsigned char srs_space
;
218 unsigned char srs_center
;
219 unsigned char mpu_switch
;
220 unsigned char wave_source
;
225 struct snd_card
*card
;
227 struct snd_pcm_substream
*playback_substream
;
228 struct snd_pcm_substream
*capture_substream
;
229 struct snd_rawmidi
*rmidi
;
230 struct snd_hwdep
*fmsynth
; /* S3FM */
234 unsigned int p_dma_size
;
235 unsigned int c_dma_size
;
237 struct snd_kcontrol
*master_mute
;
238 struct snd_kcontrol
*master_volume
;
240 #ifdef SUPPORT_JOYSTICK
241 struct gameport
*gameport
;
245 static struct pci_device_id snd_sonic_ids
[] = {
246 { 0x5333, 0xca00, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0, },
250 MODULE_DEVICE_TABLE(pci
, snd_sonic_ids
);
252 static struct snd_ratden sonicvibes_adc_clock
= {
253 .num_min
= 4000 * 65536,
254 .num_max
= 48000UL * 65536,
258 static struct snd_pcm_hw_constraint_ratdens snd_sonicvibes_hw_constraints_adc_clock
= {
260 .rats
= &sonicvibes_adc_clock
,
264 * common I/O routines
267 static inline void snd_sonicvibes_setdmaa(struct sonicvibes
* sonic
,
272 outl(addr
, sonic
->dmaa_port
+ SV_DMA_ADDR0
);
273 outl(count
, sonic
->dmaa_port
+ SV_DMA_COUNT0
);
274 outb(0x18, sonic
->dmaa_port
+ SV_DMA_MODE
);
276 printk("program dmaa: addr = 0x%x, paddr = 0x%x\n", addr
, inl(sonic
->dmaa_port
+ SV_DMA_ADDR0
));
280 static inline void snd_sonicvibes_setdmac(struct sonicvibes
* sonic
,
284 /* note: dmac is working in word mode!!! */
287 outl(addr
, sonic
->dmac_port
+ SV_DMA_ADDR0
);
288 outl(count
, sonic
->dmac_port
+ SV_DMA_COUNT0
);
289 outb(0x14, sonic
->dmac_port
+ SV_DMA_MODE
);
291 printk("program dmac: addr = 0x%x, paddr = 0x%x\n", addr
, inl(sonic
->dmac_port
+ SV_DMA_ADDR0
));
295 static inline unsigned int snd_sonicvibes_getdmaa(struct sonicvibes
* sonic
)
297 return (inl(sonic
->dmaa_port
+ SV_DMA_COUNT0
) & 0xffffff) + 1;
300 static inline unsigned int snd_sonicvibes_getdmac(struct sonicvibes
* sonic
)
302 /* note: dmac is working in word mode!!! */
303 return ((inl(sonic
->dmac_port
+ SV_DMA_COUNT0
) & 0xffffff) + 1) << 1;
306 static void snd_sonicvibes_out1(struct sonicvibes
* sonic
,
310 outb(reg
, SV_REG(sonic
, INDEX
));
312 outb(value
, SV_REG(sonic
, DATA
));
316 static void snd_sonicvibes_out(struct sonicvibes
* sonic
,
322 spin_lock_irqsave(&sonic
->reg_lock
, flags
);
323 outb(reg
, SV_REG(sonic
, INDEX
));
325 outb(value
, SV_REG(sonic
, DATA
));
327 spin_unlock_irqrestore(&sonic
->reg_lock
, flags
);
330 static unsigned char snd_sonicvibes_in1(struct sonicvibes
* sonic
, unsigned char reg
)
334 outb(reg
, SV_REG(sonic
, INDEX
));
336 value
= inb(SV_REG(sonic
, DATA
));
341 static unsigned char snd_sonicvibes_in(struct sonicvibes
* sonic
, unsigned char reg
)
346 spin_lock_irqsave(&sonic
->reg_lock
, flags
);
347 outb(reg
, SV_REG(sonic
, INDEX
));
349 value
= inb(SV_REG(sonic
, DATA
));
351 spin_unlock_irqrestore(&sonic
->reg_lock
, flags
);
356 static void snd_sonicvibes_debug(struct sonicvibes
* sonic
)
358 printk("SV REGS: INDEX = 0x%02x ", inb(SV_REG(sonic
, INDEX
)));
359 printk(" STATUS = 0x%02x\n", inb(SV_REG(sonic
, STATUS
)));
360 printk(" 0x00: left input = 0x%02x ", snd_sonicvibes_in(sonic
, 0x00));
361 printk(" 0x20: synth rate low = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x20));
362 printk(" 0x01: right input = 0x%02x ", snd_sonicvibes_in(sonic
, 0x01));
363 printk(" 0x21: synth rate high = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x21));
364 printk(" 0x02: left AUX1 = 0x%02x ", snd_sonicvibes_in(sonic
, 0x02));
365 printk(" 0x22: ADC clock = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x22));
366 printk(" 0x03: right AUX1 = 0x%02x ", snd_sonicvibes_in(sonic
, 0x03));
367 printk(" 0x23: ADC alt rate = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x23));
368 printk(" 0x04: left CD = 0x%02x ", snd_sonicvibes_in(sonic
, 0x04));
369 printk(" 0x24: ADC pll M = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x24));
370 printk(" 0x05: right CD = 0x%02x ", snd_sonicvibes_in(sonic
, 0x05));
371 printk(" 0x25: ADC pll N = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x25));
372 printk(" 0x06: left line = 0x%02x ", snd_sonicvibes_in(sonic
, 0x06));
373 printk(" 0x26: Synth pll M = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x26));
374 printk(" 0x07: right line = 0x%02x ", snd_sonicvibes_in(sonic
, 0x07));
375 printk(" 0x27: Synth pll N = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x27));
376 printk(" 0x08: MIC = 0x%02x ", snd_sonicvibes_in(sonic
, 0x08));
377 printk(" 0x28: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x28));
378 printk(" 0x09: Game port = 0x%02x ", snd_sonicvibes_in(sonic
, 0x09));
379 printk(" 0x29: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x29));
380 printk(" 0x0a: left synth = 0x%02x ", snd_sonicvibes_in(sonic
, 0x0a));
381 printk(" 0x2a: MPU401 = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x2a));
382 printk(" 0x0b: right synth = 0x%02x ", snd_sonicvibes_in(sonic
, 0x0b));
383 printk(" 0x2b: drive ctrl = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x2b));
384 printk(" 0x0c: left AUX2 = 0x%02x ", snd_sonicvibes_in(sonic
, 0x0c));
385 printk(" 0x2c: SRS space = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x2c));
386 printk(" 0x0d: right AUX2 = 0x%02x ", snd_sonicvibes_in(sonic
, 0x0d));
387 printk(" 0x2d: SRS center = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x2d));
388 printk(" 0x0e: left analog = 0x%02x ", snd_sonicvibes_in(sonic
, 0x0e));
389 printk(" 0x2e: wave source = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x2e));
390 printk(" 0x0f: right analog = 0x%02x ", snd_sonicvibes_in(sonic
, 0x0f));
391 printk(" 0x2f: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x2f));
392 printk(" 0x10: left PCM = 0x%02x ", snd_sonicvibes_in(sonic
, 0x10));
393 printk(" 0x30: analog power = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x30));
394 printk(" 0x11: right PCM = 0x%02x ", snd_sonicvibes_in(sonic
, 0x11));
395 printk(" 0x31: analog power = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x31));
396 printk(" 0x12: DMA data format = 0x%02x ", snd_sonicvibes_in(sonic
, 0x12));
397 printk(" 0x32: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x32));
398 printk(" 0x13: P/C enable = 0x%02x ", snd_sonicvibes_in(sonic
, 0x13));
399 printk(" 0x33: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x33));
400 printk(" 0x14: U/D button = 0x%02x ", snd_sonicvibes_in(sonic
, 0x14));
401 printk(" 0x34: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x34));
402 printk(" 0x15: revision = 0x%02x ", snd_sonicvibes_in(sonic
, 0x15));
403 printk(" 0x35: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x35));
404 printk(" 0x16: ADC output ctrl = 0x%02x ", snd_sonicvibes_in(sonic
, 0x16));
405 printk(" 0x36: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x36));
406 printk(" 0x17: --- = 0x%02x ", snd_sonicvibes_in(sonic
, 0x17));
407 printk(" 0x37: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x37));
408 printk(" 0x18: DMA A upper cnt = 0x%02x ", snd_sonicvibes_in(sonic
, 0x18));
409 printk(" 0x38: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x38));
410 printk(" 0x19: DMA A lower cnt = 0x%02x ", snd_sonicvibes_in(sonic
, 0x19));
411 printk(" 0x39: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x39));
412 printk(" 0x1a: --- = 0x%02x ", snd_sonicvibes_in(sonic
, 0x1a));
413 printk(" 0x3a: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x3a));
414 printk(" 0x1b: --- = 0x%02x ", snd_sonicvibes_in(sonic
, 0x1b));
415 printk(" 0x3b: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x3b));
416 printk(" 0x1c: DMA C upper cnt = 0x%02x ", snd_sonicvibes_in(sonic
, 0x1c));
417 printk(" 0x3c: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x3c));
418 printk(" 0x1d: DMA C upper cnt = 0x%02x ", snd_sonicvibes_in(sonic
, 0x1d));
419 printk(" 0x3d: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x3d));
420 printk(" 0x1e: PCM rate low = 0x%02x ", snd_sonicvibes_in(sonic
, 0x1e));
421 printk(" 0x3e: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x3e));
422 printk(" 0x1f: PCM rate high = 0x%02x ", snd_sonicvibes_in(sonic
, 0x1f));
423 printk(" 0x3f: --- = 0x%02x\n", snd_sonicvibes_in(sonic
, 0x3f));
428 static void snd_sonicvibes_setfmt(struct sonicvibes
* sonic
,
434 spin_lock_irqsave(&sonic
->reg_lock
, flags
);
435 outb(SV_MCE
| SV_IREG_DMA_DATA_FMT
, SV_REG(sonic
, INDEX
));
437 sonic
->format
= inb(SV_REG(sonic
, DATA
));
440 sonic
->format
= (sonic
->format
& mask
) | value
;
441 outb(sonic
->format
, SV_REG(sonic
, DATA
));
443 outb(0, SV_REG(sonic
, INDEX
));
445 spin_unlock_irqrestore(&sonic
->reg_lock
, flags
);
448 static void snd_sonicvibes_pll(unsigned int rate
,
453 unsigned int r
, m
= 0, n
= 0;
454 unsigned int xm
, xn
, xr
, xd
, metric
= ~0U;
456 if (rate
< 625000 / SV_ADCMULT
)
457 rate
= 625000 / SV_ADCMULT
;
458 if (rate
> 150000000 / SV_ADCMULT
)
459 rate
= 150000000 / SV_ADCMULT
;
460 /* slight violation of specs, needed for continuous sampling rates */
461 for (r
= 0; rate
< 75000000 / SV_ADCMULT
; r
+= 0x20, rate
<<= 1);
462 for (xn
= 3; xn
< 33; xn
++) /* 35 */
463 for (xm
= 3; xm
< 257; xm
++) {
464 xr
= ((SV_REFFREQUENCY
/ SV_ADCMULT
) * xm
) / xn
;
479 printk("metric = %i, xm = %i, xn = %i\n", metric
, xm
, xn
);
480 printk("pll: m = 0x%x, r = 0x%x, n = 0x%x\n", reg
, m
, r
, n
);
484 static void snd_sonicvibes_setpll(struct sonicvibes
* sonic
,
489 unsigned int r
, m
, n
;
491 snd_sonicvibes_pll(rate
, &r
, &m
, &n
);
493 spin_lock_irqsave(&sonic
->reg_lock
, flags
);
494 snd_sonicvibes_out1(sonic
, reg
, m
);
495 snd_sonicvibes_out1(sonic
, reg
+ 1, r
| n
);
496 spin_unlock_irqrestore(&sonic
->reg_lock
, flags
);
500 static void snd_sonicvibes_set_adc_rate(struct sonicvibes
* sonic
, unsigned int rate
)
509 if ((48000 / div
) == rate
) { /* use the alternate clock */
511 } else { /* use the PLL source */
513 snd_sonicvibes_setpll(sonic
, SV_IREG_ADC_PLL
, rate
);
515 spin_lock_irqsave(&sonic
->reg_lock
, flags
);
516 snd_sonicvibes_out1(sonic
, SV_IREG_ADC_ALT_RATE
, (div
- 1) << 4);
517 snd_sonicvibes_out1(sonic
, SV_IREG_ADC_CLOCK
, clock
);
518 spin_unlock_irqrestore(&sonic
->reg_lock
, flags
);
521 static int snd_sonicvibes_hw_constraint_dac_rate(struct snd_pcm_hw_params
*params
,
522 struct snd_pcm_hw_rule
*rule
)
524 unsigned int rate
, div
, r
, m
, n
;
526 if (hw_param_interval(params
, SNDRV_PCM_HW_PARAM_RATE
)->min
==
527 hw_param_interval(params
, SNDRV_PCM_HW_PARAM_RATE
)->max
) {
528 rate
= hw_param_interval(params
, SNDRV_PCM_HW_PARAM_RATE
)->min
;
532 if ((48000 / div
) == rate
) {
533 params
->rate_num
= rate
;
534 params
->rate_den
= 1;
536 snd_sonicvibes_pll(rate
, &r
, &m
, &n
);
537 snd_assert((SV_REFFREQUENCY
% 16) == 0, return -EINVAL
);
538 snd_assert((SV_ADCMULT
% 512) == 0, return -EINVAL
);
539 params
->rate_num
= (SV_REFFREQUENCY
/16) * (n
+2) * r
;
540 params
->rate_den
= (SV_ADCMULT
/512) * (m
+2);
546 static void snd_sonicvibes_set_dac_rate(struct sonicvibes
* sonic
, unsigned int rate
)
551 div
= (rate
* 65536 + SV_FULLRATE
/ 2) / SV_FULLRATE
;
554 spin_lock_irqsave(&sonic
->reg_lock
, flags
);
555 snd_sonicvibes_out1(sonic
, SV_IREG_PCM_RATE_HIGH
, div
>> 8);
556 snd_sonicvibes_out1(sonic
, SV_IREG_PCM_RATE_LOW
, div
);
557 spin_unlock_irqrestore(&sonic
->reg_lock
, flags
);
560 static int snd_sonicvibes_trigger(struct sonicvibes
* sonic
, int what
, int cmd
)
564 spin_lock(&sonic
->reg_lock
);
565 if (cmd
== SNDRV_PCM_TRIGGER_START
) {
566 if (!(sonic
->enable
& what
)) {
567 sonic
->enable
|= what
;
568 snd_sonicvibes_out1(sonic
, SV_IREG_PC_ENABLE
, sonic
->enable
);
570 } else if (cmd
== SNDRV_PCM_TRIGGER_STOP
) {
571 if (sonic
->enable
& what
) {
572 sonic
->enable
&= ~what
;
573 snd_sonicvibes_out1(sonic
, SV_IREG_PC_ENABLE
, sonic
->enable
);
578 spin_unlock(&sonic
->reg_lock
);
582 static irqreturn_t
snd_sonicvibes_interrupt(int irq
, void *dev_id
)
584 struct sonicvibes
*sonic
= dev_id
;
585 unsigned char status
;
587 status
= inb(SV_REG(sonic
, STATUS
));
588 if (!(status
& (SV_DMAA_IRQ
| SV_DMAC_IRQ
| SV_MIDI_IRQ
)))
590 if (status
== 0xff) { /* failure */
591 outb(sonic
->irqmask
= ~0, SV_REG(sonic
, IRQMASK
));
592 snd_printk(KERN_ERR
"IRQ failure - interrupts disabled!!\n");
596 if (status
& SV_DMAA_IRQ
)
597 snd_pcm_period_elapsed(sonic
->playback_substream
);
598 if (status
& SV_DMAC_IRQ
)
599 snd_pcm_period_elapsed(sonic
->capture_substream
);
602 if (status
& SV_MIDI_IRQ
)
603 snd_mpu401_uart_interrupt(irq
, sonic
->rmidi
->private_data
);
605 if (status
& SV_UD_IRQ
) {
607 int vol
, oleft
, oright
, mleft
, mright
;
609 spin_lock(&sonic
->reg_lock
);
610 udreg
= snd_sonicvibes_in1(sonic
, SV_IREG_UD_BUTTON
);
614 oleft
= mleft
= snd_sonicvibes_in1(sonic
, SV_IREG_LEFT_ANALOG
);
615 oright
= mright
= snd_sonicvibes_in1(sonic
, SV_IREG_RIGHT_ANALOG
);
632 oleft
|= mleft
& 0x80;
633 oright
|= mright
& 0x80;
634 snd_sonicvibes_out1(sonic
, SV_IREG_LEFT_ANALOG
, oleft
);
635 snd_sonicvibes_out1(sonic
, SV_IREG_RIGHT_ANALOG
, oright
);
636 spin_unlock(&sonic
->reg_lock
);
637 snd_ctl_notify(sonic
->card
, SNDRV_CTL_EVENT_MASK_VALUE
, &sonic
->master_mute
->id
);
638 snd_ctl_notify(sonic
->card
, SNDRV_CTL_EVENT_MASK_VALUE
, &sonic
->master_volume
->id
);
647 static int snd_sonicvibes_playback_trigger(struct snd_pcm_substream
*substream
,
650 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
651 return snd_sonicvibes_trigger(sonic
, 1, cmd
);
654 static int snd_sonicvibes_capture_trigger(struct snd_pcm_substream
*substream
,
657 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
658 return snd_sonicvibes_trigger(sonic
, 2, cmd
);
661 static int snd_sonicvibes_hw_params(struct snd_pcm_substream
*substream
,
662 struct snd_pcm_hw_params
*hw_params
)
664 return snd_pcm_lib_malloc_pages(substream
, params_buffer_bytes(hw_params
));
667 static int snd_sonicvibes_hw_free(struct snd_pcm_substream
*substream
)
669 return snd_pcm_lib_free_pages(substream
);
672 static int snd_sonicvibes_playback_prepare(struct snd_pcm_substream
*substream
)
674 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
675 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
676 unsigned char fmt
= 0;
677 unsigned int size
= snd_pcm_lib_buffer_bytes(substream
);
678 unsigned int count
= snd_pcm_lib_period_bytes(substream
);
680 sonic
->p_dma_size
= size
;
682 if (runtime
->channels
> 1)
684 if (snd_pcm_format_width(runtime
->format
) == 16)
686 snd_sonicvibes_setfmt(sonic
, ~3, fmt
);
687 snd_sonicvibes_set_dac_rate(sonic
, runtime
->rate
);
688 spin_lock_irq(&sonic
->reg_lock
);
689 snd_sonicvibes_setdmaa(sonic
, runtime
->dma_addr
, size
);
690 snd_sonicvibes_out1(sonic
, SV_IREG_DMA_A_UPPER
, count
>> 8);
691 snd_sonicvibes_out1(sonic
, SV_IREG_DMA_A_LOWER
, count
);
692 spin_unlock_irq(&sonic
->reg_lock
);
696 static int snd_sonicvibes_capture_prepare(struct snd_pcm_substream
*substream
)
698 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
699 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
700 unsigned char fmt
= 0;
701 unsigned int size
= snd_pcm_lib_buffer_bytes(substream
);
702 unsigned int count
= snd_pcm_lib_period_bytes(substream
);
704 sonic
->c_dma_size
= size
;
707 if (runtime
->channels
> 1)
709 if (snd_pcm_format_width(runtime
->format
) == 16)
711 snd_sonicvibes_setfmt(sonic
, ~0x30, fmt
);
712 snd_sonicvibes_set_adc_rate(sonic
, runtime
->rate
);
713 spin_lock_irq(&sonic
->reg_lock
);
714 snd_sonicvibes_setdmac(sonic
, runtime
->dma_addr
, size
);
715 snd_sonicvibes_out1(sonic
, SV_IREG_DMA_C_UPPER
, count
>> 8);
716 snd_sonicvibes_out1(sonic
, SV_IREG_DMA_C_LOWER
, count
);
717 spin_unlock_irq(&sonic
->reg_lock
);
721 static snd_pcm_uframes_t
snd_sonicvibes_playback_pointer(struct snd_pcm_substream
*substream
)
723 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
726 if (!(sonic
->enable
& 1))
728 ptr
= sonic
->p_dma_size
- snd_sonicvibes_getdmaa(sonic
);
729 return bytes_to_frames(substream
->runtime
, ptr
);
732 static snd_pcm_uframes_t
snd_sonicvibes_capture_pointer(struct snd_pcm_substream
*substream
)
734 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
736 if (!(sonic
->enable
& 2))
738 ptr
= sonic
->c_dma_size
- snd_sonicvibes_getdmac(sonic
);
739 return bytes_to_frames(substream
->runtime
, ptr
);
742 static struct snd_pcm_hardware snd_sonicvibes_playback
=
744 .info
= (SNDRV_PCM_INFO_MMAP
| SNDRV_PCM_INFO_INTERLEAVED
|
745 SNDRV_PCM_INFO_BLOCK_TRANSFER
|
746 SNDRV_PCM_INFO_MMAP_VALID
),
747 .formats
= SNDRV_PCM_FMTBIT_U8
| SNDRV_PCM_FMTBIT_S16_LE
,
748 .rates
= SNDRV_PCM_RATE_CONTINUOUS
| SNDRV_PCM_RATE_8000_48000
,
753 .buffer_bytes_max
= (128*1024),
754 .period_bytes_min
= 32,
755 .period_bytes_max
= (128*1024),
761 static struct snd_pcm_hardware snd_sonicvibes_capture
=
763 .info
= (SNDRV_PCM_INFO_MMAP
| SNDRV_PCM_INFO_INTERLEAVED
|
764 SNDRV_PCM_INFO_BLOCK_TRANSFER
|
765 SNDRV_PCM_INFO_MMAP_VALID
),
766 .formats
= SNDRV_PCM_FMTBIT_U8
| SNDRV_PCM_FMTBIT_S16_LE
,
767 .rates
= SNDRV_PCM_RATE_CONTINUOUS
| SNDRV_PCM_RATE_8000_48000
,
772 .buffer_bytes_max
= (128*1024),
773 .period_bytes_min
= 32,
774 .period_bytes_max
= (128*1024),
780 static int snd_sonicvibes_playback_open(struct snd_pcm_substream
*substream
)
782 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
783 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
785 sonic
->mode
|= SV_MODE_PLAY
;
786 sonic
->playback_substream
= substream
;
787 runtime
->hw
= snd_sonicvibes_playback
;
788 snd_pcm_hw_rule_add(runtime
, 0, SNDRV_PCM_HW_PARAM_RATE
, snd_sonicvibes_hw_constraint_dac_rate
, NULL
, SNDRV_PCM_HW_PARAM_RATE
, -1);
792 static int snd_sonicvibes_capture_open(struct snd_pcm_substream
*substream
)
794 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
795 struct snd_pcm_runtime
*runtime
= substream
->runtime
;
797 sonic
->mode
|= SV_MODE_CAPTURE
;
798 sonic
->capture_substream
= substream
;
799 runtime
->hw
= snd_sonicvibes_capture
;
800 snd_pcm_hw_constraint_ratdens(runtime
, 0, SNDRV_PCM_HW_PARAM_RATE
,
801 &snd_sonicvibes_hw_constraints_adc_clock
);
805 static int snd_sonicvibes_playback_close(struct snd_pcm_substream
*substream
)
807 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
809 sonic
->playback_substream
= NULL
;
810 sonic
->mode
&= ~SV_MODE_PLAY
;
814 static int snd_sonicvibes_capture_close(struct snd_pcm_substream
*substream
)
816 struct sonicvibes
*sonic
= snd_pcm_substream_chip(substream
);
818 sonic
->capture_substream
= NULL
;
819 sonic
->mode
&= ~SV_MODE_CAPTURE
;
823 static struct snd_pcm_ops snd_sonicvibes_playback_ops
= {
824 .open
= snd_sonicvibes_playback_open
,
825 .close
= snd_sonicvibes_playback_close
,
826 .ioctl
= snd_pcm_lib_ioctl
,
827 .hw_params
= snd_sonicvibes_hw_params
,
828 .hw_free
= snd_sonicvibes_hw_free
,
829 .prepare
= snd_sonicvibes_playback_prepare
,
830 .trigger
= snd_sonicvibes_playback_trigger
,
831 .pointer
= snd_sonicvibes_playback_pointer
,
834 static struct snd_pcm_ops snd_sonicvibes_capture_ops
= {
835 .open
= snd_sonicvibes_capture_open
,
836 .close
= snd_sonicvibes_capture_close
,
837 .ioctl
= snd_pcm_lib_ioctl
,
838 .hw_params
= snd_sonicvibes_hw_params
,
839 .hw_free
= snd_sonicvibes_hw_free
,
840 .prepare
= snd_sonicvibes_capture_prepare
,
841 .trigger
= snd_sonicvibes_capture_trigger
,
842 .pointer
= snd_sonicvibes_capture_pointer
,
845 static int __devinit
snd_sonicvibes_pcm(struct sonicvibes
* sonic
, int device
, struct snd_pcm
** rpcm
)
850 if ((err
= snd_pcm_new(sonic
->card
, "s3_86c617", device
, 1, 1, &pcm
)) < 0)
852 snd_assert(pcm
!= NULL
, return -EINVAL
);
854 snd_pcm_set_ops(pcm
, SNDRV_PCM_STREAM_PLAYBACK
, &snd_sonicvibes_playback_ops
);
855 snd_pcm_set_ops(pcm
, SNDRV_PCM_STREAM_CAPTURE
, &snd_sonicvibes_capture_ops
);
857 pcm
->private_data
= sonic
;
859 strcpy(pcm
->name
, "S3 SonicVibes");
862 snd_pcm_lib_preallocate_pages_for_all(pcm
, SNDRV_DMA_TYPE_DEV
,
863 snd_dma_pci_data(sonic
->pci
), 64*1024, 128*1024);
874 #define SONICVIBES_MUX(xname, xindex) \
875 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
876 .info = snd_sonicvibes_info_mux, \
877 .get = snd_sonicvibes_get_mux, .put = snd_sonicvibes_put_mux }
879 static int snd_sonicvibes_info_mux(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_info
*uinfo
)
881 static char *texts
[7] = {
882 "CD", "PCM", "Aux1", "Line", "Aux0", "Mic", "Mix"
885 uinfo
->type
= SNDRV_CTL_ELEM_TYPE_ENUMERATED
;
887 uinfo
->value
.enumerated
.items
= 7;
888 if (uinfo
->value
.enumerated
.item
>= 7)
889 uinfo
->value
.enumerated
.item
= 6;
890 strcpy(uinfo
->value
.enumerated
.name
, texts
[uinfo
->value
.enumerated
.item
]);
894 static int snd_sonicvibes_get_mux(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_value
*ucontrol
)
896 struct sonicvibes
*sonic
= snd_kcontrol_chip(kcontrol
);
898 spin_lock_irq(&sonic
->reg_lock
);
899 ucontrol
->value
.enumerated
.item
[0] = ((snd_sonicvibes_in1(sonic
, SV_IREG_LEFT_ADC
) & SV_RECSRC_OUT
) >> 5) - 1;
900 ucontrol
->value
.enumerated
.item
[1] = ((snd_sonicvibes_in1(sonic
, SV_IREG_RIGHT_ADC
) & SV_RECSRC_OUT
) >> 5) - 1;
901 spin_unlock_irq(&sonic
->reg_lock
);
905 static int snd_sonicvibes_put_mux(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_value
*ucontrol
)
907 struct sonicvibes
*sonic
= snd_kcontrol_chip(kcontrol
);
908 unsigned short left
, right
, oval1
, oval2
;
911 if (ucontrol
->value
.enumerated
.item
[0] >= 7 ||
912 ucontrol
->value
.enumerated
.item
[1] >= 7)
914 left
= (ucontrol
->value
.enumerated
.item
[0] + 1) << 5;
915 right
= (ucontrol
->value
.enumerated
.item
[1] + 1) << 5;
916 spin_lock_irq(&sonic
->reg_lock
);
917 oval1
= snd_sonicvibes_in1(sonic
, SV_IREG_LEFT_ADC
);
918 oval2
= snd_sonicvibes_in1(sonic
, SV_IREG_RIGHT_ADC
);
919 left
= (oval1
& ~SV_RECSRC_OUT
) | left
;
920 right
= (oval2
& ~SV_RECSRC_OUT
) | right
;
921 change
= left
!= oval1
|| right
!= oval2
;
922 snd_sonicvibes_out1(sonic
, SV_IREG_LEFT_ADC
, left
);
923 snd_sonicvibes_out1(sonic
, SV_IREG_RIGHT_ADC
, right
);
924 spin_unlock_irq(&sonic
->reg_lock
);
928 #define SONICVIBES_SINGLE(xname, xindex, reg, shift, mask, invert) \
929 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
930 .info = snd_sonicvibes_info_single, \
931 .get = snd_sonicvibes_get_single, .put = snd_sonicvibes_put_single, \
932 .private_value = reg | (shift << 8) | (mask << 16) | (invert << 24) }
934 static int snd_sonicvibes_info_single(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_info
*uinfo
)
936 int mask
= (kcontrol
->private_value
>> 16) & 0xff;
938 uinfo
->type
= mask
== 1 ? SNDRV_CTL_ELEM_TYPE_BOOLEAN
: SNDRV_CTL_ELEM_TYPE_INTEGER
;
940 uinfo
->value
.integer
.min
= 0;
941 uinfo
->value
.integer
.max
= mask
;
945 static int snd_sonicvibes_get_single(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_value
*ucontrol
)
947 struct sonicvibes
*sonic
= snd_kcontrol_chip(kcontrol
);
948 int reg
= kcontrol
->private_value
& 0xff;
949 int shift
= (kcontrol
->private_value
>> 8) & 0xff;
950 int mask
= (kcontrol
->private_value
>> 16) & 0xff;
951 int invert
= (kcontrol
->private_value
>> 24) & 0xff;
953 spin_lock_irq(&sonic
->reg_lock
);
954 ucontrol
->value
.integer
.value
[0] = (snd_sonicvibes_in1(sonic
, reg
)>> shift
) & mask
;
955 spin_unlock_irq(&sonic
->reg_lock
);
957 ucontrol
->value
.integer
.value
[0] = mask
- ucontrol
->value
.integer
.value
[0];
961 static int snd_sonicvibes_put_single(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_value
*ucontrol
)
963 struct sonicvibes
*sonic
= snd_kcontrol_chip(kcontrol
);
964 int reg
= kcontrol
->private_value
& 0xff;
965 int shift
= (kcontrol
->private_value
>> 8) & 0xff;
966 int mask
= (kcontrol
->private_value
>> 16) & 0xff;
967 int invert
= (kcontrol
->private_value
>> 24) & 0xff;
969 unsigned short val
, oval
;
971 val
= (ucontrol
->value
.integer
.value
[0] & mask
);
975 spin_lock_irq(&sonic
->reg_lock
);
976 oval
= snd_sonicvibes_in1(sonic
, reg
);
977 val
= (oval
& ~(mask
<< shift
)) | val
;
978 change
= val
!= oval
;
979 snd_sonicvibes_out1(sonic
, reg
, val
);
980 spin_unlock_irq(&sonic
->reg_lock
);
984 #define SONICVIBES_DOUBLE(xname, xindex, left_reg, right_reg, shift_left, shift_right, mask, invert) \
985 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
986 .info = snd_sonicvibes_info_double, \
987 .get = snd_sonicvibes_get_double, .put = snd_sonicvibes_put_double, \
988 .private_value = left_reg | (right_reg << 8) | (shift_left << 16) | (shift_right << 19) | (mask << 24) | (invert << 22) }
990 static int snd_sonicvibes_info_double(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_info
*uinfo
)
992 int mask
= (kcontrol
->private_value
>> 24) & 0xff;
994 uinfo
->type
= mask
== 1 ? SNDRV_CTL_ELEM_TYPE_BOOLEAN
: SNDRV_CTL_ELEM_TYPE_INTEGER
;
996 uinfo
->value
.integer
.min
= 0;
997 uinfo
->value
.integer
.max
= mask
;
1001 static int snd_sonicvibes_get_double(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_value
*ucontrol
)
1003 struct sonicvibes
*sonic
= snd_kcontrol_chip(kcontrol
);
1004 int left_reg
= kcontrol
->private_value
& 0xff;
1005 int right_reg
= (kcontrol
->private_value
>> 8) & 0xff;
1006 int shift_left
= (kcontrol
->private_value
>> 16) & 0x07;
1007 int shift_right
= (kcontrol
->private_value
>> 19) & 0x07;
1008 int mask
= (kcontrol
->private_value
>> 24) & 0xff;
1009 int invert
= (kcontrol
->private_value
>> 22) & 1;
1011 spin_lock_irq(&sonic
->reg_lock
);
1012 ucontrol
->value
.integer
.value
[0] = (snd_sonicvibes_in1(sonic
, left_reg
) >> shift_left
) & mask
;
1013 ucontrol
->value
.integer
.value
[1] = (snd_sonicvibes_in1(sonic
, right_reg
) >> shift_right
) & mask
;
1014 spin_unlock_irq(&sonic
->reg_lock
);
1016 ucontrol
->value
.integer
.value
[0] = mask
- ucontrol
->value
.integer
.value
[0];
1017 ucontrol
->value
.integer
.value
[1] = mask
- ucontrol
->value
.integer
.value
[1];
1022 static int snd_sonicvibes_put_double(struct snd_kcontrol
*kcontrol
, struct snd_ctl_elem_value
*ucontrol
)
1024 struct sonicvibes
*sonic
= snd_kcontrol_chip(kcontrol
);
1025 int left_reg
= kcontrol
->private_value
& 0xff;
1026 int right_reg
= (kcontrol
->private_value
>> 8) & 0xff;
1027 int shift_left
= (kcontrol
->private_value
>> 16) & 0x07;
1028 int shift_right
= (kcontrol
->private_value
>> 19) & 0x07;
1029 int mask
= (kcontrol
->private_value
>> 24) & 0xff;
1030 int invert
= (kcontrol
->private_value
>> 22) & 1;
1032 unsigned short val1
, val2
, oval1
, oval2
;
1034 val1
= ucontrol
->value
.integer
.value
[0] & mask
;
1035 val2
= ucontrol
->value
.integer
.value
[1] & mask
;
1040 val1
<<= shift_left
;
1041 val2
<<= shift_right
;
1042 spin_lock_irq(&sonic
->reg_lock
);
1043 oval1
= snd_sonicvibes_in1(sonic
, left_reg
);
1044 oval2
= snd_sonicvibes_in1(sonic
, right_reg
);
1045 val1
= (oval1
& ~(mask
<< shift_left
)) | val1
;
1046 val2
= (oval2
& ~(mask
<< shift_right
)) | val2
;
1047 change
= val1
!= oval1
|| val2
!= oval2
;
1048 snd_sonicvibes_out1(sonic
, left_reg
, val1
);
1049 snd_sonicvibes_out1(sonic
, right_reg
, val2
);
1050 spin_unlock_irq(&sonic
->reg_lock
);
1054 static struct snd_kcontrol_new snd_sonicvibes_controls
[] __devinitdata
= {
1055 SONICVIBES_DOUBLE("Capture Volume", 0, SV_IREG_LEFT_ADC
, SV_IREG_RIGHT_ADC
, 0, 0, 15, 0),
1056 SONICVIBES_DOUBLE("Aux Playback Switch", 0, SV_IREG_LEFT_AUX1
, SV_IREG_RIGHT_AUX1
, 7, 7, 1, 1),
1057 SONICVIBES_DOUBLE("Aux Playback Volume", 0, SV_IREG_LEFT_AUX1
, SV_IREG_RIGHT_AUX1
, 0, 0, 31, 1),
1058 SONICVIBES_DOUBLE("CD Playback Switch", 0, SV_IREG_LEFT_CD
, SV_IREG_RIGHT_CD
, 7, 7, 1, 1),
1059 SONICVIBES_DOUBLE("CD Playback Volume", 0, SV_IREG_LEFT_CD
, SV_IREG_RIGHT_CD
, 0, 0, 31, 1),
1060 SONICVIBES_DOUBLE("Line Playback Switch", 0, SV_IREG_LEFT_LINE
, SV_IREG_RIGHT_LINE
, 7, 7, 1, 1),
1061 SONICVIBES_DOUBLE("Line Playback Volume", 0, SV_IREG_LEFT_LINE
, SV_IREG_RIGHT_LINE
, 0, 0, 31, 1),
1062 SONICVIBES_SINGLE("Mic Playback Switch", 0, SV_IREG_MIC
, 7, 1, 1),
1063 SONICVIBES_SINGLE("Mic Playback Volume", 0, SV_IREG_MIC
, 0, 15, 1),
1064 SONICVIBES_SINGLE("Mic Boost", 0, SV_IREG_LEFT_ADC
, 4, 1, 0),
1065 SONICVIBES_DOUBLE("Synth Playback Switch", 0, SV_IREG_LEFT_SYNTH
, SV_IREG_RIGHT_SYNTH
, 7, 7, 1, 1),
1066 SONICVIBES_DOUBLE("Synth Playback Volume", 0, SV_IREG_LEFT_SYNTH
, SV_IREG_RIGHT_SYNTH
, 0, 0, 31, 1),
1067 SONICVIBES_DOUBLE("Aux Playback Switch", 1, SV_IREG_LEFT_AUX2
, SV_IREG_RIGHT_AUX2
, 7, 7, 1, 1),
1068 SONICVIBES_DOUBLE("Aux Playback Volume", 1, SV_IREG_LEFT_AUX2
, SV_IREG_RIGHT_AUX2
, 0, 0, 31, 1),
1069 SONICVIBES_DOUBLE("Master Playback Switch", 0, SV_IREG_LEFT_ANALOG
, SV_IREG_RIGHT_ANALOG
, 7, 7, 1, 1),
1070 SONICVIBES_DOUBLE("Master Playback Volume", 0, SV_IREG_LEFT_ANALOG
, SV_IREG_RIGHT_ANALOG
, 0, 0, 31, 1),
1071 SONICVIBES_DOUBLE("PCM Playback Switch", 0, SV_IREG_LEFT_PCM
, SV_IREG_RIGHT_PCM
, 7, 7, 1, 1),
1072 SONICVIBES_DOUBLE("PCM Playback Volume", 0, SV_IREG_LEFT_PCM
, SV_IREG_RIGHT_PCM
, 0, 0, 63, 1),
1073 SONICVIBES_SINGLE("Loopback Capture Switch", 0, SV_IREG_ADC_OUTPUT_CTRL
, 0, 1, 0),
1074 SONICVIBES_SINGLE("Loopback Capture Volume", 0, SV_IREG_ADC_OUTPUT_CTRL
, 2, 63, 1),
1075 SONICVIBES_MUX("Capture Source", 0)
1078 static void snd_sonicvibes_master_free(struct snd_kcontrol
*kcontrol
)
1080 struct sonicvibes
*sonic
= snd_kcontrol_chip(kcontrol
);
1081 sonic
->master_mute
= NULL
;
1082 sonic
->master_volume
= NULL
;
1085 static int __devinit
snd_sonicvibes_mixer(struct sonicvibes
* sonic
)
1087 struct snd_card
*card
;
1088 struct snd_kcontrol
*kctl
;
1092 snd_assert(sonic
!= NULL
&& sonic
->card
!= NULL
, return -EINVAL
);
1094 strcpy(card
->mixername
, "S3 SonicVibes");
1096 for (idx
= 0; idx
< ARRAY_SIZE(snd_sonicvibes_controls
); idx
++) {
1097 if ((err
= snd_ctl_add(card
, kctl
= snd_ctl_new1(&snd_sonicvibes_controls
[idx
], sonic
))) < 0)
1101 case 1: kctl
->private_free
= snd_sonicvibes_master_free
; break;
1111 static void snd_sonicvibes_proc_read(struct snd_info_entry
*entry
,
1112 struct snd_info_buffer
*buffer
)
1114 struct sonicvibes
*sonic
= entry
->private_data
;
1117 tmp
= sonic
->srs_space
& 0x0f;
1118 snd_iprintf(buffer
, "SRS 3D : %s\n",
1119 sonic
->srs_space
& 0x80 ? "off" : "on");
1120 snd_iprintf(buffer
, "SRS Space : %s\n",
1121 tmp
== 0x00 ? "100%" :
1122 tmp
== 0x01 ? "75%" :
1123 tmp
== 0x02 ? "50%" :
1124 tmp
== 0x03 ? "25%" : "0%");
1125 tmp
= sonic
->srs_center
& 0x0f;
1126 snd_iprintf(buffer
, "SRS Center : %s\n",
1127 tmp
== 0x00 ? "100%" :
1128 tmp
== 0x01 ? "75%" :
1129 tmp
== 0x02 ? "50%" :
1130 tmp
== 0x03 ? "25%" : "0%");
1131 tmp
= sonic
->wave_source
& 0x03;
1132 snd_iprintf(buffer
, "WaveTable Source : %s\n",
1133 tmp
== 0x00 ? "on-board ROM" :
1134 tmp
== 0x01 ? "PCI bus" : "on-board ROM + PCI bus");
1135 tmp
= sonic
->mpu_switch
;
1136 snd_iprintf(buffer
, "Onboard synth : %s\n", tmp
& 0x01 ? "on" : "off");
1137 snd_iprintf(buffer
, "Ext. Rx to synth : %s\n", tmp
& 0x02 ? "on" : "off");
1138 snd_iprintf(buffer
, "MIDI to ext. Tx : %s\n", tmp
& 0x04 ? "on" : "off");
1141 static void __devinit
snd_sonicvibes_proc_init(struct sonicvibes
* sonic
)
1143 struct snd_info_entry
*entry
;
1145 if (! snd_card_proc_new(sonic
->card
, "sonicvibes", &entry
))
1146 snd_info_set_text_ops(entry
, sonic
, snd_sonicvibes_proc_read
);
1153 #ifdef SUPPORT_JOYSTICK
1154 static struct snd_kcontrol_new snd_sonicvibes_game_control __devinitdata
=
1155 SONICVIBES_SINGLE("Joystick Speed", 0, SV_IREG_GAME_PORT
, 1, 15, 0);
1157 static int __devinit
snd_sonicvibes_create_gameport(struct sonicvibes
*sonic
)
1159 struct gameport
*gp
;
1161 sonic
->gameport
= gp
= gameport_allocate_port();
1163 printk(KERN_ERR
"sonicvibes: cannot allocate memory for gameport\n");
1167 gameport_set_name(gp
, "SonicVibes Gameport");
1168 gameport_set_phys(gp
, "pci%s/gameport0", pci_name(sonic
->pci
));
1169 gameport_set_dev_parent(gp
, &sonic
->pci
->dev
);
1170 gp
->io
= sonic
->game_port
;
1172 gameport_register_port(gp
);
1174 snd_ctl_add(sonic
->card
, snd_ctl_new1(&snd_sonicvibes_game_control
, sonic
));
1179 static void snd_sonicvibes_free_gameport(struct sonicvibes
*sonic
)
1181 if (sonic
->gameport
) {
1182 gameport_unregister_port(sonic
->gameport
);
1183 sonic
->gameport
= NULL
;
1187 static inline int snd_sonicvibes_create_gameport(struct sonicvibes
*sonic
) { return -ENOSYS
; }
1188 static inline void snd_sonicvibes_free_gameport(struct sonicvibes
*sonic
) { }
1191 static int snd_sonicvibes_free(struct sonicvibes
*sonic
)
1193 snd_sonicvibes_free_gameport(sonic
);
1194 pci_write_config_dword(sonic
->pci
, 0x40, sonic
->dmaa_port
);
1195 pci_write_config_dword(sonic
->pci
, 0x48, sonic
->dmac_port
);
1196 if (sonic
->irq
>= 0)
1197 free_irq(sonic
->irq
, sonic
);
1198 release_and_free_resource(sonic
->res_dmaa
);
1199 release_and_free_resource(sonic
->res_dmac
);
1200 pci_release_regions(sonic
->pci
);
1201 pci_disable_device(sonic
->pci
);
1206 static int snd_sonicvibes_dev_free(struct snd_device
*device
)
1208 struct sonicvibes
*sonic
= device
->device_data
;
1209 return snd_sonicvibes_free(sonic
);
1212 static int __devinit
snd_sonicvibes_create(struct snd_card
*card
,
1213 struct pci_dev
*pci
,
1216 struct sonicvibes
** rsonic
)
1218 struct sonicvibes
*sonic
;
1219 unsigned int dmaa
, dmac
;
1221 static struct snd_device_ops ops
= {
1222 .dev_free
= snd_sonicvibes_dev_free
,
1226 /* enable PCI device */
1227 if ((err
= pci_enable_device(pci
)) < 0)
1229 /* check, if we can restrict PCI DMA transfers to 24 bits */
1230 if (pci_set_dma_mask(pci
, DMA_24BIT_MASK
) < 0 ||
1231 pci_set_consistent_dma_mask(pci
, DMA_24BIT_MASK
) < 0) {
1232 snd_printk(KERN_ERR
"architecture does not support 24bit PCI busmaster DMA\n");
1233 pci_disable_device(pci
);
1237 sonic
= kzalloc(sizeof(*sonic
), GFP_KERNEL
);
1238 if (sonic
== NULL
) {
1239 pci_disable_device(pci
);
1242 spin_lock_init(&sonic
->reg_lock
);
1247 if ((err
= pci_request_regions(pci
, "S3 SonicVibes")) < 0) {
1249 pci_disable_device(pci
);
1253 sonic
->sb_port
= pci_resource_start(pci
, 0);
1254 sonic
->enh_port
= pci_resource_start(pci
, 1);
1255 sonic
->synth_port
= pci_resource_start(pci
, 2);
1256 sonic
->midi_port
= pci_resource_start(pci
, 3);
1257 sonic
->game_port
= pci_resource_start(pci
, 4);
1259 if (request_irq(pci
->irq
, snd_sonicvibes_interrupt
, IRQF_SHARED
,
1260 "S3 SonicVibes", sonic
)) {
1261 snd_printk(KERN_ERR
"unable to grab IRQ %d\n", pci
->irq
);
1262 snd_sonicvibes_free(sonic
);
1265 sonic
->irq
= pci
->irq
;
1267 pci_read_config_dword(pci
, 0x40, &dmaa
);
1268 pci_read_config_dword(pci
, 0x48, &dmac
);
1275 snd_printk(KERN_INFO
"BIOS did not allocate DDMA channel A i/o, allocated at 0x%x\n", dmaa
);
1280 snd_printk(KERN_INFO
"BIOS did not allocate DDMA channel C i/o, allocated at 0x%x\n", dmac
);
1282 pci_write_config_dword(pci
, 0x40, dmaa
);
1283 pci_write_config_dword(pci
, 0x48, dmac
);
1285 if ((sonic
->res_dmaa
= request_region(dmaa
, 0x10, "S3 SonicVibes DDMA-A")) == NULL
) {
1286 snd_sonicvibes_free(sonic
);
1287 snd_printk(KERN_ERR
"unable to grab DDMA-A port at 0x%x-0x%x\n", dmaa
, dmaa
+ 0x10 - 1);
1290 if ((sonic
->res_dmac
= request_region(dmac
, 0x10, "S3 SonicVibes DDMA-C")) == NULL
) {
1291 snd_sonicvibes_free(sonic
);
1292 snd_printk(KERN_ERR
"unable to grab DDMA-C port at 0x%x-0x%x\n", dmac
, dmac
+ 0x10 - 1);
1296 pci_read_config_dword(pci
, 0x40, &sonic
->dmaa_port
);
1297 pci_read_config_dword(pci
, 0x48, &sonic
->dmac_port
);
1298 sonic
->dmaa_port
&= ~0x0f;
1299 sonic
->dmac_port
&= ~0x0f;
1300 pci_write_config_dword(pci
, 0x40, sonic
->dmaa_port
| 9); /* enable + enhanced */
1301 pci_write_config_dword(pci
, 0x48, sonic
->dmac_port
| 9); /* enable */
1302 /* ok.. initialize S3 SonicVibes chip */
1303 outb(SV_RESET
, SV_REG(sonic
, CONTROL
)); /* reset chip */
1305 outb(0, SV_REG(sonic
, CONTROL
)); /* release reset */
1307 outb(SV_ENHANCED
| SV_INTA
| (reverb
? SV_REVERB
: 0), SV_REG(sonic
, CONTROL
));
1308 inb(SV_REG(sonic
, STATUS
)); /* clear IRQs */
1310 snd_sonicvibes_out(sonic
, SV_IREG_DRIVE_CTRL
, 0); /* drive current 16mA */
1312 snd_sonicvibes_out(sonic
, SV_IREG_DRIVE_CTRL
, 0x40); /* drive current 8mA */
1314 snd_sonicvibes_out(sonic
, SV_IREG_PC_ENABLE
, sonic
->enable
= 0); /* disable playback & capture */
1315 outb(sonic
->irqmask
= ~(SV_DMAA_MASK
| SV_DMAC_MASK
| SV_UD_MASK
), SV_REG(sonic
, IRQMASK
));
1316 inb(SV_REG(sonic
, STATUS
)); /* clear IRQs */
1317 snd_sonicvibes_out(sonic
, SV_IREG_ADC_CLOCK
, 0); /* use PLL as clock source */
1318 snd_sonicvibes_out(sonic
, SV_IREG_ANALOG_POWER
, 0); /* power up analog parts */
1319 snd_sonicvibes_out(sonic
, SV_IREG_DIGITAL_POWER
, 0); /* power up digital parts */
1320 snd_sonicvibes_setpll(sonic
, SV_IREG_ADC_PLL
, 8000);
1321 snd_sonicvibes_out(sonic
, SV_IREG_SRS_SPACE
, sonic
->srs_space
= 0x80); /* SRS space off */
1322 snd_sonicvibes_out(sonic
, SV_IREG_SRS_CENTER
, sonic
->srs_center
= 0x00);/* SRS center off */
1323 snd_sonicvibes_out(sonic
, SV_IREG_MPU401
, sonic
->mpu_switch
= 0x05); /* MPU-401 switch */
1324 snd_sonicvibes_out(sonic
, SV_IREG_WAVE_SOURCE
, sonic
->wave_source
= 0x00); /* onboard ROM */
1325 snd_sonicvibes_out(sonic
, SV_IREG_PCM_RATE_LOW
, (8000 * 65536 / SV_FULLRATE
) & 0xff);
1326 snd_sonicvibes_out(sonic
, SV_IREG_PCM_RATE_HIGH
, ((8000 * 65536 / SV_FULLRATE
) >> 8) & 0xff);
1327 snd_sonicvibes_out(sonic
, SV_IREG_LEFT_ADC
, mge
? 0xd0 : 0xc0);
1328 snd_sonicvibes_out(sonic
, SV_IREG_RIGHT_ADC
, 0xc0);
1329 snd_sonicvibes_out(sonic
, SV_IREG_LEFT_AUX1
, 0x9f);
1330 snd_sonicvibes_out(sonic
, SV_IREG_RIGHT_AUX1
, 0x9f);
1331 snd_sonicvibes_out(sonic
, SV_IREG_LEFT_CD
, 0x9f);
1332 snd_sonicvibes_out(sonic
, SV_IREG_RIGHT_CD
, 0x9f);
1333 snd_sonicvibes_out(sonic
, SV_IREG_LEFT_LINE
, 0x9f);
1334 snd_sonicvibes_out(sonic
, SV_IREG_RIGHT_LINE
, 0x9f);
1335 snd_sonicvibes_out(sonic
, SV_IREG_MIC
, 0x8f);
1336 snd_sonicvibes_out(sonic
, SV_IREG_LEFT_SYNTH
, 0x9f);
1337 snd_sonicvibes_out(sonic
, SV_IREG_RIGHT_SYNTH
, 0x9f);
1338 snd_sonicvibes_out(sonic
, SV_IREG_LEFT_AUX2
, 0x9f);
1339 snd_sonicvibes_out(sonic
, SV_IREG_RIGHT_AUX2
, 0x9f);
1340 snd_sonicvibes_out(sonic
, SV_IREG_LEFT_ANALOG
, 0x9f);
1341 snd_sonicvibes_out(sonic
, SV_IREG_RIGHT_ANALOG
, 0x9f);
1342 snd_sonicvibes_out(sonic
, SV_IREG_LEFT_PCM
, 0xbf);
1343 snd_sonicvibes_out(sonic
, SV_IREG_RIGHT_PCM
, 0xbf);
1344 snd_sonicvibes_out(sonic
, SV_IREG_ADC_OUTPUT_CTRL
, 0xfc);
1346 snd_sonicvibes_debug(sonic
);
1348 sonic
->revision
= snd_sonicvibes_in(sonic
, SV_IREG_REVISION
);
1350 if ((err
= snd_device_new(card
, SNDRV_DEV_LOWLEVEL
, sonic
, &ops
)) < 0) {
1351 snd_sonicvibes_free(sonic
);
1355 snd_sonicvibes_proc_init(sonic
);
1357 snd_card_set_dev(card
, &pci
->dev
);
1367 static struct snd_kcontrol_new snd_sonicvibes_midi_controls
[] __devinitdata
= {
1368 SONICVIBES_SINGLE("SonicVibes Wave Source RAM", 0, SV_IREG_WAVE_SOURCE
, 0, 1, 0),
1369 SONICVIBES_SINGLE("SonicVibes Wave Source RAM+ROM", 0, SV_IREG_WAVE_SOURCE
, 1, 1, 0),
1370 SONICVIBES_SINGLE("SonicVibes Onboard Synth", 0, SV_IREG_MPU401
, 0, 1, 0),
1371 SONICVIBES_SINGLE("SonicVibes External Rx to Synth", 0, SV_IREG_MPU401
, 1, 1, 0),
1372 SONICVIBES_SINGLE("SonicVibes External Tx", 0, SV_IREG_MPU401
, 2, 1, 0)
1375 static int snd_sonicvibes_midi_input_open(struct snd_mpu401
* mpu
)
1377 struct sonicvibes
*sonic
= mpu
->private_data
;
1378 outb(sonic
->irqmask
&= ~SV_MIDI_MASK
, SV_REG(sonic
, IRQMASK
));
1382 static void snd_sonicvibes_midi_input_close(struct snd_mpu401
* mpu
)
1384 struct sonicvibes
*sonic
= mpu
->private_data
;
1385 outb(sonic
->irqmask
|= SV_MIDI_MASK
, SV_REG(sonic
, IRQMASK
));
1388 static int __devinit
snd_sonicvibes_midi(struct sonicvibes
* sonic
,
1389 struct snd_rawmidi
*rmidi
)
1391 struct snd_mpu401
* mpu
= rmidi
->private_data
;
1392 struct snd_card
*card
= sonic
->card
;
1393 struct snd_rawmidi_str
*dir
;
1397 mpu
->private_data
= sonic
;
1398 mpu
->open_input
= snd_sonicvibes_midi_input_open
;
1399 mpu
->close_input
= snd_sonicvibes_midi_input_close
;
1400 dir
= &rmidi
->streams
[SNDRV_RAWMIDI_STREAM_OUTPUT
];
1401 for (idx
= 0; idx
< ARRAY_SIZE(snd_sonicvibes_midi_controls
); idx
++)
1402 if ((err
= snd_ctl_add(card
, snd_ctl_new1(&snd_sonicvibes_midi_controls
[idx
], sonic
))) < 0)
1407 static int __devinit
snd_sonic_probe(struct pci_dev
*pci
,
1408 const struct pci_device_id
*pci_id
)
1411 struct snd_card
*card
;
1412 struct sonicvibes
*sonic
;
1413 struct snd_rawmidi
*midi_uart
;
1414 struct snd_opl3
*opl3
;
1417 if (dev
>= SNDRV_CARDS
)
1424 card
= snd_card_new(index
[dev
], id
[dev
], THIS_MODULE
, 0);
1427 for (idx
= 0; idx
< 5; idx
++) {
1428 if (pci_resource_start(pci
, idx
) == 0 ||
1429 !(pci_resource_flags(pci
, idx
) & IORESOURCE_IO
)) {
1430 snd_card_free(card
);
1434 if ((err
= snd_sonicvibes_create(card
, pci
,
1435 reverb
[dev
] ? 1 : 0,
1438 snd_card_free(card
);
1442 strcpy(card
->driver
, "SonicVibes");
1443 strcpy(card
->shortname
, "S3 SonicVibes");
1444 sprintf(card
->longname
, "%s rev %i at 0x%llx, irq %i",
1447 (unsigned long long)pci_resource_start(pci
, 1),
1450 if ((err
= snd_sonicvibes_pcm(sonic
, 0, NULL
)) < 0) {
1451 snd_card_free(card
);
1454 if ((err
= snd_sonicvibes_mixer(sonic
)) < 0) {
1455 snd_card_free(card
);
1458 if ((err
= snd_mpu401_uart_new(card
, 0, MPU401_HW_SONICVIBES
,
1459 sonic
->midi_port
, MPU401_INFO_INTEGRATED
,
1462 snd_card_free(card
);
1465 snd_sonicvibes_midi(sonic
, midi_uart
);
1466 if ((err
= snd_opl3_create(card
, sonic
->synth_port
,
1467 sonic
->synth_port
+ 2,
1468 OPL3_HW_OPL3_SV
, 1, &opl3
)) < 0) {
1469 snd_card_free(card
);
1472 if ((err
= snd_opl3_hwdep_new(opl3
, 0, 1, NULL
)) < 0) {
1473 snd_card_free(card
);
1477 snd_sonicvibes_create_gameport(sonic
);
1479 if ((err
= snd_card_register(card
)) < 0) {
1480 snd_card_free(card
);
1484 pci_set_drvdata(pci
, card
);
1489 static void __devexit
snd_sonic_remove(struct pci_dev
*pci
)
1491 snd_card_free(pci_get_drvdata(pci
));
1492 pci_set_drvdata(pci
, NULL
);
1495 static struct pci_driver driver
= {
1496 .name
= "S3 SonicVibes",
1497 .id_table
= snd_sonic_ids
,
1498 .probe
= snd_sonic_probe
,
1499 .remove
= __devexit_p(snd_sonic_remove
),
1502 static int __init
alsa_card_sonicvibes_init(void)
1504 return pci_register_driver(&driver
);
1507 static void __exit
alsa_card_sonicvibes_exit(void)
1509 pci_unregister_driver(&driver
);
1512 module_init(alsa_card_sonicvibes_init
)
1513 module_exit(alsa_card_sonicvibes_exit
)