1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Driver for ESS Maestro 1/2/2E Sound Card (started 21.8.99)
4 * Copyright (c) by Matze Braun <MatzeBraun@gmx.de>.
5 * Takashi Iwai <tiwai@suse.de>
7 * Most of the driver code comes from Zach Brown(zab@redhat.com)
9 * Rewritted from card-es1938.c source.
14 * Notes from Zach Brown about the driver code
16 * Hardware Description
18 * A working Maestro setup contains the Maestro chip wired to a
19 * codec or 2. In the Maestro we have the APUs, the ASSP, and the
20 * Wavecache. The APUs can be though of as virtual audio routing
21 * channels. They can take data from a number of sources and perform
22 * basic encodings of the data. The wavecache is a storehouse for
23 * PCM data. Typically it deals with PCI and interracts with the
24 * APUs. The ASSP is a wacky DSP like device that ESS is loth
25 * to release docs on. Thankfully it isn't required on the Maestro
26 * until you start doing insane things like FM emulation and surround
27 * encoding. The codecs are almost always AC-97 compliant codecs,
28 * but it appears that early Maestros may have had PT101 (an ESS
29 * part?) wired to them. The only real difference in the Maestro
30 * families is external goop like docking capability, memory for
31 * the ASSP, and initialization differences.
35 * We only drive the APU/Wavecache as typical DACs and drive the
36 * mixers in the codecs. There are 64 APUs. We assign 6 to each
37 * /dev/dsp? device. 2 channels for output, and 4 channels for
40 * Each APU can do a number of things, but we only really use
41 * 3 basic functions. For playback we use them to convert PCM
42 * data fetched over PCI by the wavecahche into analog data that
43 * is handed to the codec. One APU for mono, and a pair for stereo.
44 * When in stereo, the combination of smarts in the APU and Wavecache
45 * decide which wavecache gets the left or right channel.
47 * For record we still use the old overly mono system. For each in
48 * coming channel the data comes in from the codec, through a 'input'
49 * APU, through another rate converter APU, and then into memory via
50 * the wavecache and PCI. If its stereo, we mash it back into LRLR in
51 * software. The pass between the 2 APUs is supposedly what requires us
52 * to have a 512 byte buffer sitting around in wavecache/memory.
54 * The wavecache makes our life even more fun. First off, it can
55 * only address the first 28 bits of PCI address space, making it
56 * useless on quite a few architectures. Secondly, its insane.
57 * It claims to fetch from 4 regions of PCI space, each 4 meg in length.
58 * But that doesn't really work. You can only use 1 region. So all our
59 * allocations have to be in 4meg of each other. Booo. Hiss.
60 * So we have a module parameter, dsps_order, that is the order of
61 * the number of dsps to provide. All their buffer space is allocated
62 * on open time. The sonicvibes OSS routines we inherited really want
63 * power of 2 buffers, so we have all those next to each other, then
64 * 512 byte regions for the recording wavecaches. This ends up
65 * wasting quite a bit of memory. The only fixes I can see would be
66 * getting a kernel allocator that could work in zones, or figuring out
67 * just how to coerce the WP into doing what we want.
69 * The indirection of the various registers means we have to spinlock
70 * nearly all register accesses. We have the main register indirection
71 * like the wave cache, maestro registers, etc. Then we have beasts
72 * like the APU interface that is indirect registers gotten at through
73 * the main maestro indirection. Ouch. We spinlock around the actual
74 * ports on a per card basis. This means spinlock activity at each IO
75 * operation, but the only IO operation clusters are in non critical
76 * paths and it makes the code far easier to follow. Interrupts are
77 * blocked while holding the locks because the int handler has to
78 * get at some of them :(. The mixer interface doesn't, however.
79 * We also have an OSS state lock that is thrown around in a few
84 #include <linux/delay.h>
85 #include <linux/interrupt.h>
86 #include <linux/init.h>
87 #include <linux/pci.h>
88 #include <linux/dma-mapping.h>
89 #include <linux/slab.h>
90 #include <linux/gameport.h>
91 #include <linux/module.h>
92 #include <linux/mutex.h>
93 #include <linux/input.h>
95 #include <sound/core.h>
96 #include <sound/pcm.h>
97 #include <sound/mpu401.h>
98 #include <sound/ac97_codec.h>
99 #include <sound/initval.h>
101 #ifdef CONFIG_SND_ES1968_RADIO
102 #include <media/drv-intf/tea575x.h>
105 #define CARD_NAME "ESS Maestro1/2"
106 #define DRIVER_NAME "ES1968"
108 MODULE_DESCRIPTION("ESS Maestro");
109 MODULE_LICENSE("GPL");
110 MODULE_SUPPORTED_DEVICE("{{ESS,Maestro 2e},"
115 #if IS_REACHABLE(CONFIG_GAMEPORT)
116 #define SUPPORT_JOYSTICK 1
119 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 1-MAX */
120 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* ID for this card */
121 static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; /* Enable this card */
122 static int total_bufsize[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 1024 };
123 static int pcm_substreams_p[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 4 };
124 static int pcm_substreams_c[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 1 };
125 static int clock[SNDRV_CARDS];
126 static int use_pm[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 2};
127 static int enable_mpu[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 2};
128 #ifdef SUPPORT_JOYSTICK
129 static bool joystick[SNDRV_CARDS];
131 static int radio_nr[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = -1};
133 module_param_array(index, int, NULL, 0444);
134 MODULE_PARM_DESC(index, "Index value for " CARD_NAME " soundcard.");
135 module_param_array(id, charp, NULL, 0444);
136 MODULE_PARM_DESC(id, "ID string for " CARD_NAME " soundcard.");
137 module_param_array(enable, bool, NULL, 0444);
138 MODULE_PARM_DESC(enable, "Enable " CARD_NAME " soundcard.");
139 module_param_array(total_bufsize, int, NULL, 0444);
140 MODULE_PARM_DESC(total_bufsize, "Total buffer size in kB.");
141 module_param_array(pcm_substreams_p, int, NULL, 0444);
142 MODULE_PARM_DESC(pcm_substreams_p, "PCM Playback substreams for " CARD_NAME " soundcard.");
143 module_param_array(pcm_substreams_c, int, NULL, 0444);
144 MODULE_PARM_DESC(pcm_substreams_c, "PCM Capture substreams for " CARD_NAME " soundcard.");
145 module_param_array(clock, int, NULL, 0444);
146 MODULE_PARM_DESC(clock, "Clock on " CARD_NAME " soundcard. (0 = auto-detect)");
147 module_param_array(use_pm, int, NULL, 0444);
148 MODULE_PARM_DESC(use_pm, "Toggle power-management. (0 = off, 1 = on, 2 = auto)");
149 module_param_array(enable_mpu, int, NULL, 0444);
150 MODULE_PARM_DESC(enable_mpu, "Enable MPU401. (0 = off, 1 = on, 2 = auto)");
151 #ifdef SUPPORT_JOYSTICK
152 module_param_array(joystick, bool, NULL, 0444);
153 MODULE_PARM_DESC(joystick, "Enable joystick.");
155 module_param_array(radio_nr, int, NULL, 0444);
156 MODULE_PARM_DESC(radio_nr, "Radio device numbers");
161 #define NR_APU_REGS 16
164 #define NEC_VERSA_SUBID1 0x80581033
165 #define NEC_VERSA_SUBID2 0x803c1033
168 #define ESS_FMT_STEREO 0x01
169 #define ESS_FMT_16BIT 0x02
171 #define DAC_RUNNING 1
172 #define ADC_RUNNING 2
174 /* Values for the ESM_LEGACY_AUDIO_CONTROL */
176 #define ESS_DISABLE_AUDIO 0x8000
177 #define ESS_ENABLE_SERIAL_IRQ 0x4000
178 #define IO_ADRESS_ALIAS 0x0020
179 #define MPU401_IRQ_ENABLE 0x0010
180 #define MPU401_IO_ENABLE 0x0008
181 #define GAME_IO_ENABLE 0x0004
182 #define FM_IO_ENABLE 0x0002
183 #define SB_IO_ENABLE 0x0001
185 /* Values for the ESM_CONFIG_A */
187 #define PIC_SNOOP1 0x4000
188 #define PIC_SNOOP2 0x2000
189 #define SAFEGUARD 0x0800
190 #define DMA_CLEAR 0x0700
191 #define DMA_DDMA 0x0000
192 #define DMA_TDMA 0x0100
193 #define DMA_PCPCI 0x0200
194 #define POST_WRITE 0x0080
195 #define PCI_TIMING 0x0040
196 #define SWAP_LR 0x0020
197 #define SUBTR_DECODE 0x0002
199 /* Values for the ESM_CONFIG_B */
201 #define SPDIF_CONFB 0x0100
202 #define HWV_CONFB 0x0080
203 #define DEBOUNCE 0x0040
204 #define GPIO_CONFB 0x0020
205 #define CHI_CONFB 0x0010
206 #define IDMA_CONFB 0x0008 /*undoc */
207 #define MIDI_FIX 0x0004 /*undoc */
208 #define IRQ_TO_ISA 0x0001 /*undoc */
210 /* Values for Ring Bus Control B */
211 #define RINGB_2CODEC_ID_MASK 0x0003
212 #define RINGB_DIS_VALIDATION 0x0008
213 #define RINGB_EN_SPDIF 0x0010
214 #define RINGB_EN_2CODEC 0x0020
215 #define RINGB_SING_BIT_DUAL 0x0040
217 /* ****Port Addresses**** */
220 #define ESM_INDEX 0x02
221 #define ESM_DATA 0x00
224 #define ESM_AC97_INDEX 0x30
225 #define ESM_AC97_DATA 0x32
226 #define ESM_RING_BUS_DEST 0x34
227 #define ESM_RING_BUS_CONTR_A 0x36
228 #define ESM_RING_BUS_CONTR_B 0x38
229 #define ESM_RING_BUS_SDO 0x3A
232 #define WC_INDEX 0x10
234 #define WC_CONTROL 0x14
237 #define ASSP_INDEX 0x80
238 #define ASSP_MEMORY 0x82
239 #define ASSP_DATA 0x84
240 #define ASSP_CONTROL_A 0xA2
241 #define ASSP_CONTROL_B 0xA4
242 #define ASSP_CONTROL_C 0xA6
243 #define ASSP_HOSTW_INDEX 0xA8
244 #define ASSP_HOSTW_DATA 0xAA
245 #define ASSP_HOSTW_IRQ 0xAC
247 #define ESM_MPU401_PORT 0x98
249 #define ESM_PORT_HOST_IRQ 0x18
251 #define IDR0_DATA_PORT 0x00
252 #define IDR1_CRAM_POINTER 0x01
253 #define IDR2_CRAM_DATA 0x02
254 #define IDR3_WAVE_DATA 0x03
255 #define IDR4_WAVE_PTR_LOW 0x04
256 #define IDR5_WAVE_PTR_HI 0x05
257 #define IDR6_TIMER_CTRL 0x06
258 #define IDR7_WAVE_ROMRAM 0x07
260 #define WRITEABLE_MAP 0xEFFFFF
261 #define READABLE_MAP 0x64003F
265 #define ESM_LEGACY_AUDIO_CONTROL 0x40
266 #define ESM_ACPI_COMMAND 0x54
267 #define ESM_CONFIG_A 0x50
268 #define ESM_CONFIG_B 0x52
269 #define ESM_DDMA 0x60
272 #define ESM_BOB_ENABLE 0x0001
273 #define ESM_BOB_START 0x0001
275 /* Host IRQ Control Bits */
276 #define ESM_RESET_MAESTRO 0x8000
277 #define ESM_RESET_DIRECTSOUND 0x4000
278 #define ESM_HIRQ_ClkRun 0x0100
279 #define ESM_HIRQ_HW_VOLUME 0x0040
280 #define ESM_HIRQ_HARPO 0x0030 /* What's that? */
281 #define ESM_HIRQ_ASSP 0x0010
282 #define ESM_HIRQ_DSIE 0x0004
283 #define ESM_HIRQ_MPU401 0x0002
284 #define ESM_HIRQ_SB 0x0001
286 /* Host IRQ Status Bits */
287 #define ESM_MPU401_IRQ 0x02
288 #define ESM_SB_IRQ 0x01
289 #define ESM_SOUND_IRQ 0x04
290 #define ESM_ASSP_IRQ 0x10
291 #define ESM_HWVOL_IRQ 0x40
293 #define ESS_SYSCLK 50000000
294 #define ESM_BOB_FREQ 200
295 #define ESM_BOB_FREQ_MAX 800
297 #define ESM_FREQ_ESM1 (49152000L / 1024L) /* default rate 48000 */
298 #define ESM_FREQ_ESM2 (50000000L / 1024L)
300 /* APU Modes: reg 0x00, bit 4-7 */
301 #define ESM_APU_MODE_SHIFT 4
302 #define ESM_APU_MODE_MASK (0xf << 4)
303 #define ESM_APU_OFF 0x00
304 #define ESM_APU_16BITLINEAR 0x01 /* 16-Bit Linear Sample Player */
305 #define ESM_APU_16BITSTEREO 0x02 /* 16-Bit Stereo Sample Player */
306 #define ESM_APU_8BITLINEAR 0x03 /* 8-Bit Linear Sample Player */
307 #define ESM_APU_8BITSTEREO 0x04 /* 8-Bit Stereo Sample Player */
308 #define ESM_APU_8BITDIFF 0x05 /* 8-Bit Differential Sample Playrer */
309 #define ESM_APU_DIGITALDELAY 0x06 /* Digital Delay Line */
310 #define ESM_APU_DUALTAP 0x07 /* Dual Tap Reader */
311 #define ESM_APU_CORRELATOR 0x08 /* Correlator */
312 #define ESM_APU_INPUTMIXER 0x09 /* Input Mixer */
313 #define ESM_APU_WAVETABLE 0x0A /* Wave Table Mode */
314 #define ESM_APU_SRCONVERTOR 0x0B /* Sample Rate Convertor */
315 #define ESM_APU_16BITPINGPONG 0x0C /* 16-Bit Ping-Pong Sample Player */
316 #define ESM_APU_RESERVED1 0x0D /* Reserved 1 */
317 #define ESM_APU_RESERVED2 0x0E /* Reserved 2 */
318 #define ESM_APU_RESERVED3 0x0F /* Reserved 3 */
321 #define ESM_APU_FILTER_Q_SHIFT 0
322 #define ESM_APU_FILTER_Q_MASK (3 << 0)
323 /* APU Filtey Q Control */
324 #define ESM_APU_FILTER_LESSQ 0x00
325 #define ESM_APU_FILTER_MOREQ 0x03
327 #define ESM_APU_FILTER_TYPE_SHIFT 2
328 #define ESM_APU_FILTER_TYPE_MASK (3 << 2)
329 #define ESM_APU_ENV_TYPE_SHIFT 8
330 #define ESM_APU_ENV_TYPE_MASK (3 << 8)
331 #define ESM_APU_ENV_STATE_SHIFT 10
332 #define ESM_APU_ENV_STATE_MASK (3 << 10)
333 #define ESM_APU_END_CURVE (1 << 12)
334 #define ESM_APU_INT_ON_LOOP (1 << 13)
335 #define ESM_APU_DMA_ENABLE (1 << 14)
338 #define ESM_APU_SUBMIX_GROUP_SHIRT 0
339 #define ESM_APU_SUBMIX_GROUP_MASK (7 << 0)
340 #define ESM_APU_SUBMIX_MODE (1 << 3)
341 #define ESM_APU_6dB (1 << 4)
342 #define ESM_APU_DUAL_EFFECT (1 << 5)
343 #define ESM_APU_EFFECT_CHANNELS_SHIFT 6
344 #define ESM_APU_EFFECT_CHANNELS_MASK (3 << 6)
347 #define ESM_APU_STEP_SIZE_MASK 0x0fff
350 #define ESM_APU_PHASE_SHIFT 0
351 #define ESM_APU_PHASE_MASK (0xff << 0)
352 #define ESM_APU_WAVE64K_PAGE_SHIFT 8 /* most 8bit of wave start offset */
353 #define ESM_APU_WAVE64K_PAGE_MASK (0xff << 8)
355 /* reg 0x05 - wave start offset */
356 /* reg 0x06 - wave end offset */
357 /* reg 0x07 - wave loop length */
360 #define ESM_APU_EFFECT_GAIN_SHIFT 0
361 #define ESM_APU_EFFECT_GAIN_MASK (0xff << 0)
362 #define ESM_APU_TREMOLO_DEPTH_SHIFT 8
363 #define ESM_APU_TREMOLO_DEPTH_MASK (0xf << 8)
364 #define ESM_APU_TREMOLO_RATE_SHIFT 12
365 #define ESM_APU_TREMOLO_RATE_MASK (0xf << 12)
368 /* bit 0-7 amplitude dest? */
369 #define ESM_APU_AMPLITUDE_NOW_SHIFT 8
370 #define ESM_APU_AMPLITUDE_NOW_MASK (0xff << 8)
373 #define ESM_APU_POLAR_PAN_SHIFT 0
374 #define ESM_APU_POLAR_PAN_MASK (0x3f << 0)
375 /* Polar Pan Control */
376 #define ESM_APU_PAN_CENTER_CIRCLE 0x00
377 #define ESM_APU_PAN_MIDDLE_RADIUS 0x01
378 #define ESM_APU_PAN_OUTSIDE_RADIUS 0x02
380 #define ESM_APU_FILTER_TUNING_SHIFT 8
381 #define ESM_APU_FILTER_TUNING_MASK (0xff << 8)
384 #define ESM_APU_DATA_SRC_A_SHIFT 0
385 #define ESM_APU_DATA_SRC_A_MASK (0x7f << 0)
386 #define ESM_APU_INV_POL_A (1 << 7)
387 #define ESM_APU_DATA_SRC_B_SHIFT 8
388 #define ESM_APU_DATA_SRC_B_MASK (0x7f << 8)
389 #define ESM_APU_INV_POL_B (1 << 15)
391 #define ESM_APU_VIBRATO_RATE_SHIFT 0
392 #define ESM_APU_VIBRATO_RATE_MASK (0xf << 0)
393 #define ESM_APU_VIBRATO_DEPTH_SHIFT 4
394 #define ESM_APU_VIBRATO_DEPTH_MASK (0xf << 4)
395 #define ESM_APU_VIBRATO_PHASE_SHIFT 8
396 #define ESM_APU_VIBRATO_PHASE_MASK (0xff << 8)
399 #define ESM_APU_RADIUS_SELECT (1 << 6)
401 /* APU Filter Control */
402 #define ESM_APU_FILTER_2POLE_LOPASS 0x00
403 #define ESM_APU_FILTER_2POLE_BANDPASS 0x01
404 #define ESM_APU_FILTER_2POLE_HIPASS 0x02
405 #define ESM_APU_FILTER_1POLE_LOPASS 0x03
406 #define ESM_APU_FILTER_1POLE_HIPASS 0x04
407 #define ESM_APU_FILTER_OFF 0x05
410 #define ESM_APU_ATFP_AMPLITUDE 0x00
411 #define ESM_APU_ATFP_TREMELO 0x01
412 #define ESM_APU_ATFP_FILTER 0x02
413 #define ESM_APU_ATFP_PAN 0x03
416 #define ESM_APU_ATFP_FLG_OFF 0x00
417 #define ESM_APU_ATFP_FLG_WAIT 0x01
418 #define ESM_APU_ATFP_FLG_DONE 0x02
419 #define ESM_APU_ATFP_FLG_INPROCESS 0x03
422 /* capture mixing buffer size */
423 #define ESM_MEM_ALIGN 0x1000
424 #define ESM_MIXBUF_SIZE 0x400
426 #define ESM_MODE_PLAY 0
427 #define ESM_MODE_CAPTURE 1
430 /* APU use in the driver */
431 enum snd_enum_apu_type {
434 ESM_APU_PCM_RATECONV,
440 TYPE_MAESTRO, TYPE_MAESTRO2, TYPE_MAESTRO2E
445 struct snd_dma_buffer buf;
446 int empty; /* status */
447 struct list_head list;
450 /* Playback Channel */
457 /* playback/capture pcm buffer */
458 struct esm_memory *memory;
459 /* capture mixer buffer */
460 struct esm_memory *mixbuf;
462 unsigned int hwptr; /* current hw pointer in bytes */
463 unsigned int count; /* sample counter in bytes */
464 unsigned int dma_size; /* total buffer size in bytes */
465 unsigned int frag_size; /* period size in bytes */
466 unsigned int wav_shift;
467 u16 base[4]; /* offset for ptr */
469 /* stereo/16bit flag */
471 int mode; /* playback / capture */
473 int bob_freq; /* required timer frequency */
475 struct snd_pcm_substream *substream;
478 struct list_head list;
480 #ifdef CONFIG_PM_SLEEP
487 int total_bufsize; /* in bytes */
489 int playback_streams, capture_streams;
491 unsigned int clock; /* clock */
492 /* for clock measurement */
493 unsigned int in_measurement: 1;
494 unsigned int measure_apu;
495 unsigned int measure_lastpos;
496 unsigned int measure_count;
499 struct snd_dma_buffer dma;
503 unsigned long io_port;
506 struct snd_card *card;
508 int do_pm; /* power-management enabled */
510 /* DMA memory block */
511 struct list_head buf_list;
514 struct snd_ac97 *ac97;
515 struct snd_rawmidi *rmidi;
518 unsigned int in_suspend;
522 int bobclient; /* active timer instancs */
523 int bob_freq; /* timer frequency */
524 struct mutex memory_mutex; /* memory lock */
527 unsigned char apu[NR_APUS];
529 /* active substreams */
530 struct list_head substream_list;
531 spinlock_t substream_lock;
533 #ifdef CONFIG_PM_SLEEP
534 u16 apu_map[NR_APUS][NR_APU_REGS];
537 #ifdef SUPPORT_JOYSTICK
538 struct gameport *gameport;
541 #ifdef CONFIG_SND_ES1968_INPUT
542 struct input_dev *input_dev;
543 char phys[64]; /* physical device path */
545 struct snd_kcontrol *master_switch; /* for h/w volume control */
546 struct snd_kcontrol *master_volume;
548 struct work_struct hwvol_work;
550 #ifdef CONFIG_SND_ES1968_RADIO
551 struct v4l2_device v4l2_dev;
552 struct snd_tea575x tea;
553 unsigned int tea575x_tuner;
557 static irqreturn_t snd_es1968_interrupt(int irq, void *dev_id);
559 static const struct pci_device_id snd_es1968_ids[] = {
561 { 0x1285, 0x0100, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO },
563 { 0x125d, 0x1968, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO2 },
565 { 0x125d, 0x1978, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO2E },
569 MODULE_DEVICE_TABLE(pci, snd_es1968_ids);
571 /* *********************
573 *********************/
576 static void __maestro_write(struct es1968 *chip, u16 reg, u16 data)
578 outw(reg, chip->io_port + ESM_INDEX);
579 outw(data, chip->io_port + ESM_DATA);
580 chip->maestro_map[reg] = data;
583 static inline void maestro_write(struct es1968 *chip, u16 reg, u16 data)
586 spin_lock_irqsave(&chip->reg_lock, flags);
587 __maestro_write(chip, reg, data);
588 spin_unlock_irqrestore(&chip->reg_lock, flags);
592 static u16 __maestro_read(struct es1968 *chip, u16 reg)
594 if (READABLE_MAP & (1 << reg)) {
595 outw(reg, chip->io_port + ESM_INDEX);
596 chip->maestro_map[reg] = inw(chip->io_port + ESM_DATA);
598 return chip->maestro_map[reg];
601 static inline u16 maestro_read(struct es1968 *chip, u16 reg)
605 spin_lock_irqsave(&chip->reg_lock, flags);
606 result = __maestro_read(chip, reg);
607 spin_unlock_irqrestore(&chip->reg_lock, flags);
611 /* Wait for the codec bus to be free */
612 static int snd_es1968_ac97_wait(struct es1968 *chip)
614 int timeout = 100000;
616 while (timeout-- > 0) {
617 if (!(inb(chip->io_port + ESM_AC97_INDEX) & 1))
621 dev_dbg(chip->card->dev, "ac97 timeout\n");
622 return 1; /* timeout */
625 static int snd_es1968_ac97_wait_poll(struct es1968 *chip)
627 int timeout = 100000;
629 while (timeout-- > 0) {
630 if (!(inb(chip->io_port + ESM_AC97_INDEX) & 1))
633 dev_dbg(chip->card->dev, "ac97 timeout\n");
634 return 1; /* timeout */
637 static void snd_es1968_ac97_write(struct snd_ac97 *ac97, unsigned short reg, unsigned short val)
639 struct es1968 *chip = ac97->private_data;
641 snd_es1968_ac97_wait(chip);
644 outw(val, chip->io_port + ESM_AC97_DATA);
646 outb(reg, chip->io_port + ESM_AC97_INDEX);
650 static unsigned short snd_es1968_ac97_read(struct snd_ac97 *ac97, unsigned short reg)
653 struct es1968 *chip = ac97->private_data;
655 snd_es1968_ac97_wait(chip);
657 outb(reg | 0x80, chip->io_port + ESM_AC97_INDEX);
660 if (!snd_es1968_ac97_wait_poll(chip)) {
661 data = inw(chip->io_port + ESM_AC97_DATA);
669 static void apu_index_set(struct es1968 *chip, u16 index)
672 __maestro_write(chip, IDR1_CRAM_POINTER, index);
673 for (i = 0; i < 1000; i++)
674 if (__maestro_read(chip, IDR1_CRAM_POINTER) == index)
676 dev_dbg(chip->card->dev, "APU register select failed. (Timeout)\n");
680 static void apu_data_set(struct es1968 *chip, u16 data)
683 for (i = 0; i < 1000; i++) {
684 if (__maestro_read(chip, IDR0_DATA_PORT) == data)
686 __maestro_write(chip, IDR0_DATA_PORT, data);
688 dev_dbg(chip->card->dev, "APU register set probably failed (Timeout)!\n");
692 static void __apu_set_register(struct es1968 *chip, u16 channel, u8 reg, u16 data)
694 if (snd_BUG_ON(channel >= NR_APUS))
696 #ifdef CONFIG_PM_SLEEP
697 chip->apu_map[channel][reg] = data;
699 reg |= (channel << 4);
700 apu_index_set(chip, reg);
701 apu_data_set(chip, data);
704 static void apu_set_register(struct es1968 *chip, u16 channel, u8 reg, u16 data)
707 spin_lock_irqsave(&chip->reg_lock, flags);
708 __apu_set_register(chip, channel, reg, data);
709 spin_unlock_irqrestore(&chip->reg_lock, flags);
712 static u16 __apu_get_register(struct es1968 *chip, u16 channel, u8 reg)
714 if (snd_BUG_ON(channel >= NR_APUS))
716 reg |= (channel << 4);
717 apu_index_set(chip, reg);
718 return __maestro_read(chip, IDR0_DATA_PORT);
721 static u16 apu_get_register(struct es1968 *chip, u16 channel, u8 reg)
725 spin_lock_irqsave(&chip->reg_lock, flags);
726 v = __apu_get_register(chip, channel, reg);
727 spin_unlock_irqrestore(&chip->reg_lock, flags);
731 #if 0 /* ASSP is not supported */
733 static void assp_set_register(struct es1968 *chip, u32 reg, u32 value)
737 spin_lock_irqsave(&chip->reg_lock, flags);
738 outl(reg, chip->io_port + ASSP_INDEX);
739 outl(value, chip->io_port + ASSP_DATA);
740 spin_unlock_irqrestore(&chip->reg_lock, flags);
743 static u32 assp_get_register(struct es1968 *chip, u32 reg)
748 spin_lock_irqsave(&chip->reg_lock, flags);
749 outl(reg, chip->io_port + ASSP_INDEX);
750 value = inl(chip->io_port + ASSP_DATA);
751 spin_unlock_irqrestore(&chip->reg_lock, flags);
758 static void wave_set_register(struct es1968 *chip, u16 reg, u16 value)
762 spin_lock_irqsave(&chip->reg_lock, flags);
763 outw(reg, chip->io_port + WC_INDEX);
764 outw(value, chip->io_port + WC_DATA);
765 spin_unlock_irqrestore(&chip->reg_lock, flags);
768 static u16 wave_get_register(struct es1968 *chip, u16 reg)
773 spin_lock_irqsave(&chip->reg_lock, flags);
774 outw(reg, chip->io_port + WC_INDEX);
775 value = inw(chip->io_port + WC_DATA);
776 spin_unlock_irqrestore(&chip->reg_lock, flags);
781 /* *******************
785 static void snd_es1968_bob_stop(struct es1968 *chip)
789 reg = __maestro_read(chip, 0x11);
790 reg &= ~ESM_BOB_ENABLE;
791 __maestro_write(chip, 0x11, reg);
792 reg = __maestro_read(chip, 0x17);
793 reg &= ~ESM_BOB_START;
794 __maestro_write(chip, 0x17, reg);
797 static void snd_es1968_bob_start(struct es1968 *chip)
802 /* compute ideal interrupt frequency for buffer size & play rate */
803 /* first, find best prescaler value to match freq */
804 for (prescale = 5; prescale < 12; prescale++)
805 if (chip->bob_freq > (ESS_SYSCLK >> (prescale + 9)))
808 /* next, back off prescaler whilst getting divider into optimum range */
810 while ((prescale > 5) && (divide < 32)) {
816 /* now fine-tune the divider for best match */
817 for (; divide < 31; divide++)
819 ((ESS_SYSCLK >> (prescale + 9)) / (divide + 1))) break;
821 /* divide = 0 is illegal, but don't let prescale = 4! */
826 } else if (divide > 1)
829 __maestro_write(chip, 6, 0x9000 | (prescale << 5) | divide); /* set reg */
831 /* Now set IDR 11/17 */
832 __maestro_write(chip, 0x11, __maestro_read(chip, 0x11) | 1);
833 __maestro_write(chip, 0x17, __maestro_read(chip, 0x17) | 1);
836 /* call with substream spinlock */
837 static void snd_es1968_bob_inc(struct es1968 *chip, int freq)
840 if (chip->bobclient == 1) {
841 chip->bob_freq = freq;
842 snd_es1968_bob_start(chip);
843 } else if (chip->bob_freq < freq) {
844 snd_es1968_bob_stop(chip);
845 chip->bob_freq = freq;
846 snd_es1968_bob_start(chip);
850 /* call with substream spinlock */
851 static void snd_es1968_bob_dec(struct es1968 *chip)
854 if (chip->bobclient <= 0)
855 snd_es1968_bob_stop(chip);
856 else if (chip->bob_freq > ESM_BOB_FREQ) {
857 /* check reduction of timer frequency */
858 int max_freq = ESM_BOB_FREQ;
860 list_for_each_entry(es, &chip->substream_list, list) {
861 if (max_freq < es->bob_freq)
862 max_freq = es->bob_freq;
864 if (max_freq != chip->bob_freq) {
865 snd_es1968_bob_stop(chip);
866 chip->bob_freq = max_freq;
867 snd_es1968_bob_start(chip);
873 snd_es1968_calc_bob_rate(struct es1968 *chip, struct esschan *es,
874 struct snd_pcm_runtime *runtime)
876 /* we acquire 4 interrupts per period for precise control.. */
877 int freq = runtime->rate * 4;
878 if (es->fmt & ESS_FMT_STEREO)
880 if (es->fmt & ESS_FMT_16BIT)
882 freq /= es->frag_size;
883 if (freq < ESM_BOB_FREQ)
885 else if (freq > ESM_BOB_FREQ_MAX)
886 freq = ESM_BOB_FREQ_MAX;
895 static u32 snd_es1968_compute_rate(struct es1968 *chip, u32 freq)
897 u32 rate = (freq << 16) / chip->clock;
898 #if 0 /* XXX: do we need this? */
905 /* get current pointer */
906 static inline unsigned int
907 snd_es1968_get_dma_ptr(struct es1968 *chip, struct esschan *es)
911 offset = apu_get_register(chip, es->apu[0], 5);
913 offset -= es->base[0];
915 return (offset & 0xFFFE); /* hardware is in words */
918 static void snd_es1968_apu_set_freq(struct es1968 *chip, int apu, int freq)
920 apu_set_register(chip, apu, 2,
921 (apu_get_register(chip, apu, 2) & 0x00FF) |
922 ((freq & 0xff) << 8) | 0x10);
923 apu_set_register(chip, apu, 3, freq >> 8);
927 static inline void snd_es1968_trigger_apu(struct es1968 *esm, int apu, int mode)
929 /* set the APU mode */
930 __apu_set_register(esm, apu, 0,
931 (__apu_get_register(esm, apu, 0) & 0xff0f) |
935 static void snd_es1968_pcm_start(struct es1968 *chip, struct esschan *es)
937 spin_lock(&chip->reg_lock);
938 __apu_set_register(chip, es->apu[0], 5, es->base[0]);
939 snd_es1968_trigger_apu(chip, es->apu[0], es->apu_mode[0]);
940 if (es->mode == ESM_MODE_CAPTURE) {
941 __apu_set_register(chip, es->apu[2], 5, es->base[2]);
942 snd_es1968_trigger_apu(chip, es->apu[2], es->apu_mode[2]);
944 if (es->fmt & ESS_FMT_STEREO) {
945 __apu_set_register(chip, es->apu[1], 5, es->base[1]);
946 snd_es1968_trigger_apu(chip, es->apu[1], es->apu_mode[1]);
947 if (es->mode == ESM_MODE_CAPTURE) {
948 __apu_set_register(chip, es->apu[3], 5, es->base[3]);
949 snd_es1968_trigger_apu(chip, es->apu[3], es->apu_mode[3]);
952 spin_unlock(&chip->reg_lock);
955 static void snd_es1968_pcm_stop(struct es1968 *chip, struct esschan *es)
957 spin_lock(&chip->reg_lock);
958 snd_es1968_trigger_apu(chip, es->apu[0], 0);
959 snd_es1968_trigger_apu(chip, es->apu[1], 0);
960 if (es->mode == ESM_MODE_CAPTURE) {
961 snd_es1968_trigger_apu(chip, es->apu[2], 0);
962 snd_es1968_trigger_apu(chip, es->apu[3], 0);
964 spin_unlock(&chip->reg_lock);
967 /* set the wavecache control reg */
968 static void snd_es1968_program_wavecache(struct es1968 *chip, struct esschan *es,
969 int channel, u32 addr, int capture)
971 u32 tmpval = (addr - 0x10) & 0xFFF8;
974 if (!(es->fmt & ESS_FMT_16BIT))
975 tmpval |= 4; /* 8bit */
976 if (es->fmt & ESS_FMT_STEREO)
977 tmpval |= 2; /* stereo */
980 /* set the wavecache control reg */
981 wave_set_register(chip, es->apu[channel] << 3, tmpval);
983 #ifdef CONFIG_PM_SLEEP
984 es->wc_map[channel] = tmpval;
989 static void snd_es1968_playback_setup(struct es1968 *chip, struct esschan *es,
990 struct snd_pcm_runtime *runtime)
999 size = es->dma_size >> es->wav_shift;
1001 if (es->fmt & ESS_FMT_STEREO)
1004 for (channel = 0; channel <= high_apu; channel++) {
1005 apu = es->apu[channel];
1007 snd_es1968_program_wavecache(chip, es, channel, es->memory->buf.addr, 0);
1009 /* Offset to PCMBAR */
1010 pa = es->memory->buf.addr;
1011 pa -= chip->dma.addr;
1012 pa >>= 1; /* words */
1014 pa |= 0x00400000; /* System RAM (Bit 22) */
1016 if (es->fmt & ESS_FMT_STEREO) {
1019 pa |= 0x00800000; /* (Bit 23) */
1020 if (es->fmt & ESS_FMT_16BIT)
1024 /* base offset of dma calcs when reading the pointer
1026 es->base[channel] = pa & 0xFFFF;
1028 for (i = 0; i < 16; i++)
1029 apu_set_register(chip, apu, i, 0x0000);
1031 /* Load the buffer into the wave engine */
1032 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xFF) << 8);
1033 apu_set_register(chip, apu, 5, pa & 0xFFFF);
1034 apu_set_register(chip, apu, 6, (pa + size) & 0xFFFF);
1035 /* setting loop == sample len */
1036 apu_set_register(chip, apu, 7, size);
1038 /* clear effects/env.. */
1039 apu_set_register(chip, apu, 8, 0x0000);
1040 /* set amp now to 0xd0 (?), low byte is 'amplitude dest'? */
1041 apu_set_register(chip, apu, 9, 0xD000);
1043 /* clear routing stuff */
1044 apu_set_register(chip, apu, 11, 0x0000);
1045 /* dma on, no envelopes, filter to all 1s) */
1046 apu_set_register(chip, apu, 0, 0x400F);
1048 if (es->fmt & ESS_FMT_16BIT)
1049 es->apu_mode[channel] = ESM_APU_16BITLINEAR;
1051 es->apu_mode[channel] = ESM_APU_8BITLINEAR;
1053 if (es->fmt & ESS_FMT_STEREO) {
1054 /* set panning: left or right */
1055 /* Check: different panning. On my Canyon 3D Chipset the
1056 Channels are swapped. I don't know, about the output
1057 to the SPDif Link. Perhaps you have to change this
1058 and not the APU Regs 4-5. */
1059 apu_set_register(chip, apu, 10,
1060 0x8F00 | (channel ? 0 : 0x10));
1061 es->apu_mode[channel] += 1; /* stereo */
1063 apu_set_register(chip, apu, 10, 0x8F08);
1066 spin_lock_irqsave(&chip->reg_lock, flags);
1067 /* clear WP interrupts */
1068 outw(1, chip->io_port + 0x04);
1069 /* enable WP ints */
1070 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ);
1071 spin_unlock_irqrestore(&chip->reg_lock, flags);
1073 freq = runtime->rate;
1081 if (!(es->fmt & ESS_FMT_16BIT) && !(es->fmt & ESS_FMT_STEREO))
1084 freq = snd_es1968_compute_rate(chip, freq);
1086 /* Load the frequency, turn on 6dB */
1087 snd_es1968_apu_set_freq(chip, es->apu[0], freq);
1088 snd_es1968_apu_set_freq(chip, es->apu[1], freq);
1092 static void init_capture_apu(struct es1968 *chip, struct esschan *es, int channel,
1093 unsigned int pa, unsigned int bsize,
1094 int mode, int route)
1096 int i, apu = es->apu[channel];
1098 es->apu_mode[channel] = mode;
1100 /* set the wavecache control reg */
1101 snd_es1968_program_wavecache(chip, es, channel, pa, 1);
1103 /* Offset to PCMBAR */
1104 pa -= chip->dma.addr;
1105 pa >>= 1; /* words */
1107 /* base offset of dma calcs when reading the pointer
1109 es->base[channel] = pa & 0xFFFF;
1110 pa |= 0x00400000; /* bit 22 -> System RAM */
1112 /* Begin loading the APU */
1113 for (i = 0; i < 16; i++)
1114 apu_set_register(chip, apu, i, 0x0000);
1116 /* need to enable subgroups.. and we should probably
1117 have different groups for different /dev/dsps.. */
1118 apu_set_register(chip, apu, 2, 0x8);
1120 /* Load the buffer into the wave engine */
1121 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xFF) << 8);
1122 apu_set_register(chip, apu, 5, pa & 0xFFFF);
1123 apu_set_register(chip, apu, 6, (pa + bsize) & 0xFFFF);
1124 apu_set_register(chip, apu, 7, bsize);
1125 /* clear effects/env.. */
1126 apu_set_register(chip, apu, 8, 0x00F0);
1127 /* amplitude now? sure. why not. */
1128 apu_set_register(chip, apu, 9, 0x0000);
1129 /* set filter tune, radius, polar pan */
1130 apu_set_register(chip, apu, 10, 0x8F08);
1132 apu_set_register(chip, apu, 11, route);
1133 /* dma on, no envelopes, filter to all 1s) */
1134 apu_set_register(chip, apu, 0, 0x400F);
1137 static void snd_es1968_capture_setup(struct es1968 *chip, struct esschan *es,
1138 struct snd_pcm_runtime *runtime)
1142 unsigned long flags;
1144 size = es->dma_size >> es->wav_shift;
1149 2 = mono/left Input Mixer
1150 3 = right Input Mixer
1152 /* data seems to flow from the codec, through an apu into
1153 the 'mixbuf' bit of page, then through the SRC apu
1154 and out to the real 'buffer'. ok. sure. */
1156 /* input mixer (left/mono) */
1157 /* parallel in crap, see maestro reg 0xC [8-11] */
1158 init_capture_apu(chip, es, 2,
1159 es->mixbuf->buf.addr, ESM_MIXBUF_SIZE/4, /* in words */
1160 ESM_APU_INPUTMIXER, 0x14);
1161 /* SRC (left/mono); get input from inputing apu */
1162 init_capture_apu(chip, es, 0, es->memory->buf.addr, size,
1163 ESM_APU_SRCONVERTOR, es->apu[2]);
1164 if (es->fmt & ESS_FMT_STEREO) {
1165 /* input mixer (right) */
1166 init_capture_apu(chip, es, 3,
1167 es->mixbuf->buf.addr + ESM_MIXBUF_SIZE/2,
1168 ESM_MIXBUF_SIZE/4, /* in words */
1169 ESM_APU_INPUTMIXER, 0x15);
1171 init_capture_apu(chip, es, 1,
1172 es->memory->buf.addr + size*2, size,
1173 ESM_APU_SRCONVERTOR, es->apu[3]);
1176 freq = runtime->rate;
1177 /* Sample Rate conversion APUs don't like 0x10000 for their rate */
1183 freq = snd_es1968_compute_rate(chip, freq);
1185 /* Load the frequency, turn on 6dB */
1186 snd_es1968_apu_set_freq(chip, es->apu[0], freq);
1187 snd_es1968_apu_set_freq(chip, es->apu[1], freq);
1189 /* fix mixer rate at 48khz. and its _must_ be 0x10000. */
1191 snd_es1968_apu_set_freq(chip, es->apu[2], freq);
1192 snd_es1968_apu_set_freq(chip, es->apu[3], freq);
1194 spin_lock_irqsave(&chip->reg_lock, flags);
1195 /* clear WP interrupts */
1196 outw(1, chip->io_port + 0x04);
1197 /* enable WP ints */
1198 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ);
1199 spin_unlock_irqrestore(&chip->reg_lock, flags);
1202 /*******************
1204 *******************/
1206 static int snd_es1968_pcm_prepare(struct snd_pcm_substream *substream)
1208 struct es1968 *chip = snd_pcm_substream_chip(substream);
1209 struct snd_pcm_runtime *runtime = substream->runtime;
1210 struct esschan *es = runtime->private_data;
1212 es->dma_size = snd_pcm_lib_buffer_bytes(substream);
1213 es->frag_size = snd_pcm_lib_period_bytes(substream);
1215 es->wav_shift = 1; /* maestro handles always 16bit */
1217 if (snd_pcm_format_width(runtime->format) == 16)
1218 es->fmt |= ESS_FMT_16BIT;
1219 if (runtime->channels > 1) {
1220 es->fmt |= ESS_FMT_STEREO;
1221 if (es->fmt & ESS_FMT_16BIT) /* 8bit is already word shifted */
1224 es->bob_freq = snd_es1968_calc_bob_rate(chip, es, runtime);
1228 snd_es1968_playback_setup(chip, es, runtime);
1230 case ESM_MODE_CAPTURE:
1231 snd_es1968_capture_setup(chip, es, runtime);
1238 static int snd_es1968_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
1240 struct es1968 *chip = snd_pcm_substream_chip(substream);
1241 struct esschan *es = substream->runtime->private_data;
1243 spin_lock(&chip->substream_lock);
1245 case SNDRV_PCM_TRIGGER_START:
1246 case SNDRV_PCM_TRIGGER_RESUME:
1249 snd_es1968_bob_inc(chip, es->bob_freq);
1252 snd_es1968_pcm_start(chip, es);
1255 case SNDRV_PCM_TRIGGER_STOP:
1256 case SNDRV_PCM_TRIGGER_SUSPEND:
1259 snd_es1968_pcm_stop(chip, es);
1261 snd_es1968_bob_dec(chip);
1264 spin_unlock(&chip->substream_lock);
1268 static snd_pcm_uframes_t snd_es1968_pcm_pointer(struct snd_pcm_substream *substream)
1270 struct es1968 *chip = snd_pcm_substream_chip(substream);
1271 struct esschan *es = substream->runtime->private_data;
1274 ptr = snd_es1968_get_dma_ptr(chip, es) << es->wav_shift;
1276 return bytes_to_frames(substream->runtime, ptr % es->dma_size);
1279 static const struct snd_pcm_hardware snd_es1968_playback = {
1280 .info = (SNDRV_PCM_INFO_MMAP |
1281 SNDRV_PCM_INFO_MMAP_VALID |
1282 SNDRV_PCM_INFO_INTERLEAVED |
1283 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1284 /*SNDRV_PCM_INFO_PAUSE |*/
1285 SNDRV_PCM_INFO_RESUME),
1286 .formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE,
1287 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
1292 .buffer_bytes_max = 65536,
1293 .period_bytes_min = 256,
1294 .period_bytes_max = 65536,
1296 .periods_max = 1024,
1300 static const struct snd_pcm_hardware snd_es1968_capture = {
1301 .info = (SNDRV_PCM_INFO_NONINTERLEAVED |
1302 SNDRV_PCM_INFO_MMAP |
1303 SNDRV_PCM_INFO_MMAP_VALID |
1304 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1305 /*SNDRV_PCM_INFO_PAUSE |*/
1306 SNDRV_PCM_INFO_RESUME),
1307 .formats = /*SNDRV_PCM_FMTBIT_U8 |*/ SNDRV_PCM_FMTBIT_S16_LE,
1308 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
1313 .buffer_bytes_max = 65536,
1314 .period_bytes_min = 256,
1315 .period_bytes_max = 65536,
1317 .periods_max = 1024,
1321 /* *************************
1322 * DMA memory management *
1323 *************************/
1325 /* Because the Maestro can only take addresses relative to the PCM base address
1328 static int calc_available_memory_size(struct es1968 *chip)
1331 struct esm_memory *buf;
1333 mutex_lock(&chip->memory_mutex);
1334 list_for_each_entry(buf, &chip->buf_list, list) {
1335 if (buf->empty && buf->buf.bytes > max_size)
1336 max_size = buf->buf.bytes;
1338 mutex_unlock(&chip->memory_mutex);
1339 if (max_size >= 128*1024)
1340 max_size = 127*1024;
1344 /* allocate a new memory chunk with the specified size */
1345 static struct esm_memory *snd_es1968_new_memory(struct es1968 *chip, int size)
1347 struct esm_memory *buf;
1349 size = ALIGN(size, ESM_MEM_ALIGN);
1350 mutex_lock(&chip->memory_mutex);
1351 list_for_each_entry(buf, &chip->buf_list, list) {
1352 if (buf->empty && buf->buf.bytes >= size)
1355 mutex_unlock(&chip->memory_mutex);
1359 if (buf->buf.bytes > size) {
1360 struct esm_memory *chunk = kmalloc(sizeof(*chunk), GFP_KERNEL);
1361 if (chunk == NULL) {
1362 mutex_unlock(&chip->memory_mutex);
1365 chunk->buf = buf->buf;
1366 chunk->buf.bytes -= size;
1367 chunk->buf.area += size;
1368 chunk->buf.addr += size;
1370 buf->buf.bytes = size;
1371 list_add(&chunk->list, &buf->list);
1374 mutex_unlock(&chip->memory_mutex);
1378 /* free a memory chunk */
1379 static void snd_es1968_free_memory(struct es1968 *chip, struct esm_memory *buf)
1381 struct esm_memory *chunk;
1383 mutex_lock(&chip->memory_mutex);
1385 if (buf->list.prev != &chip->buf_list) {
1386 chunk = list_entry(buf->list.prev, struct esm_memory, list);
1388 chunk->buf.bytes += buf->buf.bytes;
1389 list_del(&buf->list);
1394 if (buf->list.next != &chip->buf_list) {
1395 chunk = list_entry(buf->list.next, struct esm_memory, list);
1397 buf->buf.bytes += chunk->buf.bytes;
1398 list_del(&chunk->list);
1402 mutex_unlock(&chip->memory_mutex);
1405 static void snd_es1968_free_dmabuf(struct es1968 *chip)
1407 struct list_head *p;
1409 if (! chip->dma.area)
1411 snd_dma_free_pages(&chip->dma);
1412 while ((p = chip->buf_list.next) != &chip->buf_list) {
1413 struct esm_memory *chunk = list_entry(p, struct esm_memory, list);
1420 snd_es1968_init_dmabuf(struct es1968 *chip)
1423 struct esm_memory *chunk;
1425 err = snd_dma_alloc_pages_fallback(SNDRV_DMA_TYPE_DEV,
1427 chip->total_bufsize, &chip->dma);
1428 if (err < 0 || ! chip->dma.area) {
1429 dev_err(chip->card->dev,
1430 "can't allocate dma pages for size %d\n",
1431 chip->total_bufsize);
1434 if ((chip->dma.addr + chip->dma.bytes - 1) & ~((1 << 28) - 1)) {
1435 snd_dma_free_pages(&chip->dma);
1436 dev_err(chip->card->dev, "DMA buffer beyond 256MB.\n");
1440 INIT_LIST_HEAD(&chip->buf_list);
1441 /* allocate an empty chunk */
1442 chunk = kmalloc(sizeof(*chunk), GFP_KERNEL);
1443 if (chunk == NULL) {
1444 snd_es1968_free_dmabuf(chip);
1447 memset(chip->dma.area, 0, ESM_MEM_ALIGN);
1448 chunk->buf = chip->dma;
1449 chunk->buf.area += ESM_MEM_ALIGN;
1450 chunk->buf.addr += ESM_MEM_ALIGN;
1451 chunk->buf.bytes -= ESM_MEM_ALIGN;
1453 list_add(&chunk->list, &chip->buf_list);
1458 /* setup the dma_areas */
1459 /* buffer is extracted from the pre-allocated memory chunk */
1460 static int snd_es1968_hw_params(struct snd_pcm_substream *substream,
1461 struct snd_pcm_hw_params *hw_params)
1463 struct es1968 *chip = snd_pcm_substream_chip(substream);
1464 struct snd_pcm_runtime *runtime = substream->runtime;
1465 struct esschan *chan = runtime->private_data;
1466 int size = params_buffer_bytes(hw_params);
1469 if (chan->memory->buf.bytes >= size) {
1470 runtime->dma_bytes = size;
1473 snd_es1968_free_memory(chip, chan->memory);
1475 chan->memory = snd_es1968_new_memory(chip, size);
1476 if (chan->memory == NULL) {
1477 dev_dbg(chip->card->dev,
1478 "cannot allocate dma buffer: size = %d\n", size);
1481 snd_pcm_set_runtime_buffer(substream, &chan->memory->buf);
1482 return 1; /* area was changed */
1485 /* remove dma areas if allocated */
1486 static int snd_es1968_hw_free(struct snd_pcm_substream *substream)
1488 struct es1968 *chip = snd_pcm_substream_chip(substream);
1489 struct snd_pcm_runtime *runtime = substream->runtime;
1490 struct esschan *chan;
1492 if (runtime->private_data == NULL)
1494 chan = runtime->private_data;
1496 snd_es1968_free_memory(chip, chan->memory);
1497 chan->memory = NULL;
1506 static int snd_es1968_alloc_apu_pair(struct es1968 *chip, int type)
1510 for (apu = 0; apu < NR_APUS; apu += 2) {
1511 if (chip->apu[apu] == ESM_APU_FREE &&
1512 chip->apu[apu + 1] == ESM_APU_FREE) {
1513 chip->apu[apu] = chip->apu[apu + 1] = type;
1523 static void snd_es1968_free_apu_pair(struct es1968 *chip, int apu)
1525 chip->apu[apu] = chip->apu[apu + 1] = ESM_APU_FREE;
1533 static int snd_es1968_playback_open(struct snd_pcm_substream *substream)
1535 struct es1968 *chip = snd_pcm_substream_chip(substream);
1536 struct snd_pcm_runtime *runtime = substream->runtime;
1541 apu1 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_PLAY);
1545 es = kzalloc(sizeof(*es), GFP_KERNEL);
1547 snd_es1968_free_apu_pair(chip, apu1);
1552 es->apu[1] = apu1 + 1;
1553 es->apu_mode[0] = 0;
1554 es->apu_mode[1] = 0;
1556 es->substream = substream;
1557 es->mode = ESM_MODE_PLAY;
1559 runtime->private_data = es;
1560 runtime->hw = snd_es1968_playback;
1561 runtime->hw.buffer_bytes_max = runtime->hw.period_bytes_max =
1562 calc_available_memory_size(chip);
1564 spin_lock_irq(&chip->substream_lock);
1565 list_add(&es->list, &chip->substream_list);
1566 spin_unlock_irq(&chip->substream_lock);
1571 static int snd_es1968_capture_open(struct snd_pcm_substream *substream)
1573 struct snd_pcm_runtime *runtime = substream->runtime;
1574 struct es1968 *chip = snd_pcm_substream_chip(substream);
1578 apu1 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_CAPTURE);
1581 apu2 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_RATECONV);
1583 snd_es1968_free_apu_pair(chip, apu1);
1587 es = kzalloc(sizeof(*es), GFP_KERNEL);
1589 snd_es1968_free_apu_pair(chip, apu1);
1590 snd_es1968_free_apu_pair(chip, apu2);
1595 es->apu[1] = apu1 + 1;
1597 es->apu[3] = apu2 + 1;
1598 es->apu_mode[0] = 0;
1599 es->apu_mode[1] = 0;
1600 es->apu_mode[2] = 0;
1601 es->apu_mode[3] = 0;
1603 es->substream = substream;
1604 es->mode = ESM_MODE_CAPTURE;
1607 if ((es->mixbuf = snd_es1968_new_memory(chip, ESM_MIXBUF_SIZE)) == NULL) {
1608 snd_es1968_free_apu_pair(chip, apu1);
1609 snd_es1968_free_apu_pair(chip, apu2);
1613 memset(es->mixbuf->buf.area, 0, ESM_MIXBUF_SIZE);
1615 runtime->private_data = es;
1616 runtime->hw = snd_es1968_capture;
1617 runtime->hw.buffer_bytes_max = runtime->hw.period_bytes_max =
1618 calc_available_memory_size(chip) - 1024; /* keep MIXBUF size */
1619 snd_pcm_hw_constraint_pow2(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
1621 spin_lock_irq(&chip->substream_lock);
1622 list_add(&es->list, &chip->substream_list);
1623 spin_unlock_irq(&chip->substream_lock);
1628 static int snd_es1968_playback_close(struct snd_pcm_substream *substream)
1630 struct es1968 *chip = snd_pcm_substream_chip(substream);
1633 if (substream->runtime->private_data == NULL)
1635 es = substream->runtime->private_data;
1636 spin_lock_irq(&chip->substream_lock);
1637 list_del(&es->list);
1638 spin_unlock_irq(&chip->substream_lock);
1639 snd_es1968_free_apu_pair(chip, es->apu[0]);
1645 static int snd_es1968_capture_close(struct snd_pcm_substream *substream)
1647 struct es1968 *chip = snd_pcm_substream_chip(substream);
1650 if (substream->runtime->private_data == NULL)
1652 es = substream->runtime->private_data;
1653 spin_lock_irq(&chip->substream_lock);
1654 list_del(&es->list);
1655 spin_unlock_irq(&chip->substream_lock);
1656 snd_es1968_free_memory(chip, es->mixbuf);
1657 snd_es1968_free_apu_pair(chip, es->apu[0]);
1658 snd_es1968_free_apu_pair(chip, es->apu[2]);
1664 static const struct snd_pcm_ops snd_es1968_playback_ops = {
1665 .open = snd_es1968_playback_open,
1666 .close = snd_es1968_playback_close,
1667 .hw_params = snd_es1968_hw_params,
1668 .hw_free = snd_es1968_hw_free,
1669 .prepare = snd_es1968_pcm_prepare,
1670 .trigger = snd_es1968_pcm_trigger,
1671 .pointer = snd_es1968_pcm_pointer,
1674 static const struct snd_pcm_ops snd_es1968_capture_ops = {
1675 .open = snd_es1968_capture_open,
1676 .close = snd_es1968_capture_close,
1677 .hw_params = snd_es1968_hw_params,
1678 .hw_free = snd_es1968_hw_free,
1679 .prepare = snd_es1968_pcm_prepare,
1680 .trigger = snd_es1968_pcm_trigger,
1681 .pointer = snd_es1968_pcm_pointer,
1688 #define CLOCK_MEASURE_BUFSIZE 16768 /* enough large for a single shot */
1690 static void es1968_measure_clock(struct es1968 *chip)
1693 unsigned int pa, offset, t;
1694 struct esm_memory *memory;
1695 ktime_t start_time, stop_time;
1698 if (chip->clock == 0)
1699 chip->clock = 48000; /* default clock value */
1701 /* search 2 APUs (although one apu is enough) */
1702 if ((apu = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_PLAY)) < 0) {
1703 dev_err(chip->card->dev, "Hmm, cannot find empty APU pair!?\n");
1706 if ((memory = snd_es1968_new_memory(chip, CLOCK_MEASURE_BUFSIZE)) == NULL) {
1707 dev_warn(chip->card->dev,
1708 "cannot allocate dma buffer - using default clock %d\n",
1710 snd_es1968_free_apu_pair(chip, apu);
1714 memset(memory->buf.area, 0, CLOCK_MEASURE_BUFSIZE);
1716 wave_set_register(chip, apu << 3, (memory->buf.addr - 0x10) & 0xfff8);
1718 pa = (unsigned int)((memory->buf.addr - chip->dma.addr) >> 1);
1719 pa |= 0x00400000; /* System RAM (Bit 22) */
1721 /* initialize apu */
1722 for (i = 0; i < 16; i++)
1723 apu_set_register(chip, apu, i, 0x0000);
1725 apu_set_register(chip, apu, 0, 0x400f);
1726 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xff) << 8);
1727 apu_set_register(chip, apu, 5, pa & 0xffff);
1728 apu_set_register(chip, apu, 6, (pa + CLOCK_MEASURE_BUFSIZE/2) & 0xffff);
1729 apu_set_register(chip, apu, 7, CLOCK_MEASURE_BUFSIZE/2);
1730 apu_set_register(chip, apu, 8, 0x0000);
1731 apu_set_register(chip, apu, 9, 0xD000);
1732 apu_set_register(chip, apu, 10, 0x8F08);
1733 apu_set_register(chip, apu, 11, 0x0000);
1734 spin_lock_irq(&chip->reg_lock);
1735 outw(1, chip->io_port + 0x04); /* clear WP interrupts */
1736 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ); /* enable WP ints */
1737 spin_unlock_irq(&chip->reg_lock);
1739 snd_es1968_apu_set_freq(chip, apu, ((unsigned int)48000 << 16) / chip->clock); /* 48000 Hz */
1741 chip->in_measurement = 1;
1742 chip->measure_apu = apu;
1743 spin_lock_irq(&chip->reg_lock);
1744 snd_es1968_bob_inc(chip, ESM_BOB_FREQ);
1745 __apu_set_register(chip, apu, 5, pa & 0xffff);
1746 snd_es1968_trigger_apu(chip, apu, ESM_APU_16BITLINEAR);
1747 start_time = ktime_get();
1748 spin_unlock_irq(&chip->reg_lock);
1750 spin_lock_irq(&chip->reg_lock);
1751 offset = __apu_get_register(chip, apu, 5);
1752 stop_time = ktime_get();
1753 snd_es1968_trigger_apu(chip, apu, 0); /* stop */
1754 snd_es1968_bob_dec(chip);
1755 chip->in_measurement = 0;
1756 spin_unlock_irq(&chip->reg_lock);
1758 /* check the current position */
1759 offset -= (pa & 0xffff);
1761 offset += chip->measure_count * (CLOCK_MEASURE_BUFSIZE/2);
1763 diff = ktime_sub(stop_time, start_time);
1764 t = ktime_to_us(diff);
1766 dev_err(chip->card->dev, "?? calculation error..\n");
1769 offset = (offset / t) * 1000 + ((offset % t) * 1000) / t;
1770 if (offset < 47500 || offset > 48500) {
1771 if (offset >= 40000 && offset <= 50000)
1772 chip->clock = (chip->clock * offset) / 48000;
1774 dev_info(chip->card->dev, "clocking to %d\n", chip->clock);
1776 snd_es1968_free_memory(chip, memory);
1777 snd_es1968_free_apu_pair(chip, apu);
1784 static void snd_es1968_pcm_free(struct snd_pcm *pcm)
1786 struct es1968 *esm = pcm->private_data;
1787 snd_es1968_free_dmabuf(esm);
1792 snd_es1968_pcm(struct es1968 *chip, int device)
1794 struct snd_pcm *pcm;
1797 /* get DMA buffer */
1798 if ((err = snd_es1968_init_dmabuf(chip)) < 0)
1802 wave_set_register(chip, 0x01FC, chip->dma.addr >> 12);
1803 wave_set_register(chip, 0x01FD, chip->dma.addr >> 12);
1804 wave_set_register(chip, 0x01FE, chip->dma.addr >> 12);
1805 wave_set_register(chip, 0x01FF, chip->dma.addr >> 12);
1807 if ((err = snd_pcm_new(chip->card, "ESS Maestro", device,
1808 chip->playback_streams,
1809 chip->capture_streams, &pcm)) < 0)
1812 pcm->private_data = chip;
1813 pcm->private_free = snd_es1968_pcm_free;
1815 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_es1968_playback_ops);
1816 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_es1968_capture_ops);
1818 pcm->info_flags = 0;
1820 strcpy(pcm->name, "ESS Maestro");
1827 * suppress jitter on some maestros when playing stereo
1829 static void snd_es1968_suppress_jitter(struct es1968 *chip, struct esschan *es)
1835 cp1 = __apu_get_register(chip, 0, 5);
1836 cp2 = __apu_get_register(chip, 1, 5);
1837 diff = (cp1 > cp2 ? cp1 - cp2 : cp2 - cp1);
1840 __maestro_write(chip, IDR0_DATA_PORT, cp1);
1846 static void snd_es1968_update_pcm(struct es1968 *chip, struct esschan *es)
1850 struct snd_pcm_substream *subs = es->substream;
1852 if (subs == NULL || !es->running)
1855 hwptr = snd_es1968_get_dma_ptr(chip, es) << es->wav_shift;
1856 hwptr %= es->dma_size;
1858 diff = (es->dma_size + hwptr - es->hwptr) % es->dma_size;
1863 if (es->count > es->frag_size) {
1864 spin_unlock(&chip->substream_lock);
1865 snd_pcm_period_elapsed(subs);
1866 spin_lock(&chip->substream_lock);
1867 es->count %= es->frag_size;
1871 /* The hardware volume works by incrementing / decrementing 2 counters
1872 (without wrap around) in response to volume button presses and then
1873 generating an interrupt. The pair of counters is stored in bits 1-3 and 5-7
1874 of a byte wide register. The meaning of bits 0 and 4 is unknown. */
1875 static void es1968_update_hw_volume(struct work_struct *work)
1877 struct es1968 *chip = container_of(work, struct es1968, hwvol_work);
1880 /* Figure out which volume control button was pushed,
1881 based on differences from the default register
1883 x = inb(chip->io_port + 0x1c) & 0xee;
1884 /* Reset the volume control registers. */
1885 outb(0x88, chip->io_port + 0x1c);
1886 outb(0x88, chip->io_port + 0x1d);
1887 outb(0x88, chip->io_port + 0x1e);
1888 outb(0x88, chip->io_port + 0x1f);
1890 if (chip->in_suspend)
1893 #ifndef CONFIG_SND_ES1968_INPUT
1894 if (! chip->master_switch || ! chip->master_volume)
1897 val = snd_ac97_read(chip->ac97, AC97_MASTER);
1905 if ((val & 0x7f) > 0)
1907 if ((val & 0x7f00) > 0)
1912 if ((val & 0x7f) < 0x1f)
1914 if ((val & 0x7f00) < 0x1f00)
1918 if (snd_ac97_update(chip->ac97, AC97_MASTER, val))
1919 snd_ctl_notify(chip->card, SNDRV_CTL_EVENT_MASK_VALUE,
1920 &chip->master_volume->id);
1922 if (!chip->input_dev)
1928 /* The counters have not changed, yet we've received a HV
1929 interrupt. According to tests run by various people this
1930 happens when pressing the mute button. */
1934 /* counters increased by 1 -> volume up */
1938 /* counters decreased by 1 -> volume down */
1939 val = KEY_VOLUMEDOWN;
1944 input_report_key(chip->input_dev, val, 1);
1945 input_sync(chip->input_dev);
1946 input_report_key(chip->input_dev, val, 0);
1947 input_sync(chip->input_dev);
1955 static irqreturn_t snd_es1968_interrupt(int irq, void *dev_id)
1957 struct es1968 *chip = dev_id;
1960 if (!(event = inb(chip->io_port + 0x1A)))
1963 outw(inw(chip->io_port + 4) & 1, chip->io_port + 4);
1965 if (event & ESM_HWVOL_IRQ)
1966 schedule_work(&chip->hwvol_work);
1968 /* else ack 'em all, i imagine */
1969 outb(0xFF, chip->io_port + 0x1A);
1971 if ((event & ESM_MPU401_IRQ) && chip->rmidi) {
1972 snd_mpu401_uart_interrupt(irq, chip->rmidi->private_data);
1975 if (event & ESM_SOUND_IRQ) {
1977 spin_lock(&chip->substream_lock);
1978 list_for_each_entry(es, &chip->substream_list, list) {
1980 snd_es1968_update_pcm(chip, es);
1981 if (es->fmt & ESS_FMT_STEREO)
1982 snd_es1968_suppress_jitter(chip, es);
1985 spin_unlock(&chip->substream_lock);
1986 if (chip->in_measurement) {
1987 unsigned int curp = __apu_get_register(chip, chip->measure_apu, 5);
1988 if (curp < chip->measure_lastpos)
1989 chip->measure_count++;
1990 chip->measure_lastpos = curp;
2002 snd_es1968_mixer(struct es1968 *chip)
2004 struct snd_ac97_bus *pbus;
2005 struct snd_ac97_template ac97;
2006 #ifndef CONFIG_SND_ES1968_INPUT
2007 struct snd_ctl_elem_id elem_id;
2010 static const struct snd_ac97_bus_ops ops = {
2011 .write = snd_es1968_ac97_write,
2012 .read = snd_es1968_ac97_read,
2015 if ((err = snd_ac97_bus(chip->card, 0, &ops, NULL, &pbus)) < 0)
2017 pbus->no_vra = 1; /* ES1968 doesn't need VRA */
2019 memset(&ac97, 0, sizeof(ac97));
2020 ac97.private_data = chip;
2021 if ((err = snd_ac97_mixer(pbus, &ac97, &chip->ac97)) < 0)
2024 #ifndef CONFIG_SND_ES1968_INPUT
2025 /* attach master switch / volumes for h/w volume control */
2026 memset(&elem_id, 0, sizeof(elem_id));
2027 elem_id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
2028 strcpy(elem_id.name, "Master Playback Switch");
2029 chip->master_switch = snd_ctl_find_id(chip->card, &elem_id);
2030 memset(&elem_id, 0, sizeof(elem_id));
2031 elem_id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
2032 strcpy(elem_id.name, "Master Playback Volume");
2033 chip->master_volume = snd_ctl_find_id(chip->card, &elem_id);
2043 static void snd_es1968_ac97_reset(struct es1968 *chip)
2045 unsigned long ioaddr = chip->io_port;
2047 unsigned short save_ringbus_a;
2048 unsigned short save_68;
2052 /* save configuration */
2053 save_ringbus_a = inw(ioaddr + 0x36);
2055 //outw(inw(ioaddr + 0x38) & 0xfffc, ioaddr + 0x38); /* clear second codec id? */
2056 /* set command/status address i/o to 1st codec */
2057 outw(inw(ioaddr + 0x3a) & 0xfffc, ioaddr + 0x3a);
2058 outw(inw(ioaddr + 0x3c) & 0xfffc, ioaddr + 0x3c);
2060 /* disable ac link */
2061 outw(0x0000, ioaddr + 0x36);
2062 save_68 = inw(ioaddr + 0x68);
2063 pci_read_config_word(chip->pci, 0x58, &w); /* something magical with gpio and bus arb. */
2064 pci_read_config_dword(chip->pci, PCI_SUBSYSTEM_VENDOR_ID, &vend);
2067 outw(0xfffe, ioaddr + 0x64); /* unmask gpio 0 */
2068 outw(0x0001, ioaddr + 0x68); /* gpio write */
2069 outw(0x0000, ioaddr + 0x60); /* write 0 to gpio 0 */
2071 outw(0x0001, ioaddr + 0x60); /* write 1 to gpio 1 */
2074 outw(save_68 | 0x1, ioaddr + 0x68); /* now restore .. */
2075 outw((inw(ioaddr + 0x38) & 0xfffc) | 0x1, ioaddr + 0x38);
2076 outw((inw(ioaddr + 0x3a) & 0xfffc) | 0x1, ioaddr + 0x3a);
2077 outw((inw(ioaddr + 0x3c) & 0xfffc) | 0x1, ioaddr + 0x3c);
2079 /* now the second codec */
2080 /* disable ac link */
2081 outw(0x0000, ioaddr + 0x36);
2082 outw(0xfff7, ioaddr + 0x64); /* unmask gpio 3 */
2083 save_68 = inw(ioaddr + 0x68);
2084 outw(0x0009, ioaddr + 0x68); /* gpio write 0 & 3 ?? */
2085 outw(0x0001, ioaddr + 0x60); /* write 1 to gpio */
2087 outw(0x0009, ioaddr + 0x60); /* write 9 to gpio */
2089 //outw(inw(ioaddr + 0x38) & 0xfffc, ioaddr + 0x38);
2090 outw(inw(ioaddr + 0x3a) & 0xfffc, ioaddr + 0x3a);
2091 outw(inw(ioaddr + 0x3c) & 0xfffc, ioaddr + 0x3c);
2093 #if 0 /* the loop here needs to be much better if we want it.. */
2094 dev_info(chip->card->dev, "trying software reset\n");
2095 /* try and do a software reset */
2096 outb(0x80 | 0x7c, ioaddr + 0x30);
2098 if ((inw(ioaddr + 0x30) & 1) == 0) {
2099 if (inb(ioaddr + 0x32) != 0)
2102 outb(0x80 | 0x7d, ioaddr + 0x30);
2103 if (((inw(ioaddr + 0x30) & 1) == 0)
2104 && (inb(ioaddr + 0x32) != 0))
2106 outb(0x80 | 0x7f, ioaddr + 0x30);
2107 if (((inw(ioaddr + 0x30) & 1) == 0)
2108 && (inb(ioaddr + 0x32) != 0))
2113 outb(inb(ioaddr + 0x37) | 0x08, ioaddr + 0x37); /* do a software reset */
2114 msleep(500); /* oh my.. */
2115 outb(inb(ioaddr + 0x37) & ~0x08,
2118 outw(0x80, ioaddr + 0x30);
2119 for (w = 0; w < 10000; w++) {
2120 if ((inw(ioaddr + 0x30) & 1) == 0)
2126 if (vend == NEC_VERSA_SUBID1 || vend == NEC_VERSA_SUBID2) {
2127 /* turn on external amp? */
2128 outw(0xf9ff, ioaddr + 0x64);
2129 outw(inw(ioaddr + 0x68) | 0x600, ioaddr + 0x68);
2130 outw(0x0209, ioaddr + 0x60);
2134 outw(save_ringbus_a, ioaddr + 0x36);
2136 /* Turn on the 978 docking chip.
2137 First frob the "master output enable" bit,
2138 then set most of the playback volume control registers to max. */
2139 outb(inb(ioaddr+0xc0)|(1<<5), ioaddr+0xc0);
2140 outb(0xff, ioaddr+0xc3);
2141 outb(0xff, ioaddr+0xc4);
2142 outb(0xff, ioaddr+0xc6);
2143 outb(0xff, ioaddr+0xc8);
2144 outb(0x3f, ioaddr+0xcf);
2145 outb(0x3f, ioaddr+0xd0);
2148 static void snd_es1968_reset(struct es1968 *chip)
2151 outw(ESM_RESET_MAESTRO | ESM_RESET_DIRECTSOUND,
2152 chip->io_port + ESM_PORT_HOST_IRQ);
2154 outw(0x0000, chip->io_port + ESM_PORT_HOST_IRQ);
2159 * initialize maestro chip
2161 static void snd_es1968_chip_init(struct es1968 *chip)
2163 struct pci_dev *pci = chip->pci;
2165 unsigned long iobase = chip->io_port;
2169 /* We used to muck around with pci config space that
2170 * we had no business messing with. We don't know enough
2171 * about the machine to know which DMA mode is appropriate,
2172 * etc. We were guessing wrong on some machines and making
2173 * them unhappy. We now trust in the BIOS to do things right,
2174 * which almost certainly means a new host of problems will
2175 * arise with broken BIOS implementations. screw 'em.
2176 * We're already intolerant of machines that don't assign
2181 pci_read_config_word(pci, ESM_CONFIG_A, &w);
2183 w &= ~DMA_CLEAR; /* Clear DMA bits */
2184 w &= ~(PIC_SNOOP1 | PIC_SNOOP2); /* Clear Pic Snoop Mode Bits */
2185 w &= ~SAFEGUARD; /* Safeguard off */
2186 w |= POST_WRITE; /* Posted write */
2187 w |= PCI_TIMING; /* PCI timing on */
2188 /* XXX huh? claims to be reserved.. */
2189 w &= ~SWAP_LR; /* swap left/right
2190 seems to only have effect on SB
2192 w &= ~SUBTR_DECODE; /* Subtractive decode off */
2194 pci_write_config_word(pci, ESM_CONFIG_A, w);
2198 pci_read_config_word(pci, ESM_CONFIG_B, &w);
2200 w &= ~(1 << 15); /* Turn off internal clock multiplier */
2201 /* XXX how do we know which to use? */
2202 w &= ~(1 << 14); /* External clock */
2204 w &= ~SPDIF_CONFB; /* disable S/PDIF output */
2205 w |= HWV_CONFB; /* HWV on */
2206 w |= DEBOUNCE; /* Debounce off: easier to push the HW buttons */
2207 w &= ~GPIO_CONFB; /* GPIO 4:5 */
2208 w |= CHI_CONFB; /* Disconnect from the CHI. Enabling this made a dell 7500 work. */
2209 w &= ~IDMA_CONFB; /* IDMA off (undocumented) */
2210 w &= ~MIDI_FIX; /* MIDI fix off (undoc) */
2211 w &= ~(1 << 1); /* reserved, always write 0 */
2212 w &= ~IRQ_TO_ISA; /* IRQ to ISA off (undoc) */
2214 pci_write_config_word(pci, ESM_CONFIG_B, w);
2218 pci_read_config_word(pci, ESM_DDMA, &w);
2220 pci_write_config_word(pci, ESM_DDMA, w);
2226 pci_read_config_word(pci, ESM_LEGACY_AUDIO_CONTROL, &w);
2228 w |= ESS_DISABLE_AUDIO; /* Disable Legacy Audio */
2229 w &= ~ESS_ENABLE_SERIAL_IRQ; /* Disable SIRQ */
2230 w &= ~(0x1f); /* disable mpu irq/io, game port, fm, SB */
2232 pci_write_config_word(pci, ESM_LEGACY_AUDIO_CONTROL, w);
2234 /* Set up 978 docking control chip. */
2235 pci_read_config_word(pci, 0x58, &w);
2236 w|=1<<2; /* Enable 978. */
2237 w|=1<<3; /* Turn on 978 hardware volume control. */
2238 w&=~(1<<11); /* Turn on 978 mixer volume control. */
2239 pci_write_config_word(pci, 0x58, w);
2243 snd_es1968_reset(chip);
2249 /* setup usual 0x34 stuff.. 0x36 may be chip specific */
2250 outw(0xC090, iobase + ESM_RING_BUS_DEST); /* direct sound, stereo */
2252 outw(0x3000, iobase + ESM_RING_BUS_CONTR_A); /* enable ringbus/serial */
2259 snd_es1968_ac97_reset(chip);
2261 /* Ring Bus Control B */
2263 n = inl(iobase + ESM_RING_BUS_CONTR_B);
2264 n &= ~RINGB_EN_SPDIF; /* SPDIF off */
2265 //w |= RINGB_EN_2CODEC; /* enable 2nd codec */
2266 outl(n, iobase + ESM_RING_BUS_CONTR_B);
2268 /* Set hardware volume control registers to midpoints.
2269 We can tell which button was pushed based on how they change. */
2270 outb(0x88, iobase+0x1c);
2271 outb(0x88, iobase+0x1d);
2272 outb(0x88, iobase+0x1e);
2273 outb(0x88, iobase+0x1f);
2275 /* it appears some maestros (dell 7500) only work if these are set,
2276 regardless of whether we use the assp or not. */
2278 outb(0, iobase + ASSP_CONTROL_B);
2279 outb(3, iobase + ASSP_CONTROL_A); /* M: Reserved bits... */
2280 outb(0, iobase + ASSP_CONTROL_C); /* M: Disable ASSP, ASSP IRQ's and FM Port */
2285 for (i = 0; i < 16; i++) {
2286 /* Write 0 into the buffer area 0x1E0->1EF */
2287 outw(0x01E0 + i, iobase + WC_INDEX);
2288 outw(0x0000, iobase + WC_DATA);
2290 /* The 1.10 test program seem to write 0 into the buffer area
2291 * 0x1D0-0x1DF too.*/
2292 outw(0x01D0 + i, iobase + WC_INDEX);
2293 outw(0x0000, iobase + WC_DATA);
2295 wave_set_register(chip, IDR7_WAVE_ROMRAM,
2296 (wave_get_register(chip, IDR7_WAVE_ROMRAM) & 0xFF00));
2297 wave_set_register(chip, IDR7_WAVE_ROMRAM,
2298 wave_get_register(chip, IDR7_WAVE_ROMRAM) | 0x100);
2299 wave_set_register(chip, IDR7_WAVE_ROMRAM,
2300 wave_get_register(chip, IDR7_WAVE_ROMRAM) & ~0x200);
2301 wave_set_register(chip, IDR7_WAVE_ROMRAM,
2302 wave_get_register(chip, IDR7_WAVE_ROMRAM) | ~0x400);
2305 maestro_write(chip, IDR2_CRAM_DATA, 0x0000);
2306 /* Now back to the DirectSound stuff */
2307 /* audio serial configuration.. ? */
2308 maestro_write(chip, 0x08, 0xB004);
2309 maestro_write(chip, 0x09, 0x001B);
2310 maestro_write(chip, 0x0A, 0x8000);
2311 maestro_write(chip, 0x0B, 0x3F37);
2312 maestro_write(chip, 0x0C, 0x0098);
2314 /* parallel in, has something to do with recording :) */
2315 maestro_write(chip, 0x0C,
2316 (maestro_read(chip, 0x0C) & ~0xF000) | 0x8000);
2318 maestro_write(chip, 0x0C,
2319 (maestro_read(chip, 0x0C) & ~0x0F00) | 0x0500);
2321 maestro_write(chip, 0x0D, 0x7632);
2323 /* Wave cache control on - test off, sg off,
2324 enable, enable extra chans 1Mb */
2326 w = inw(iobase + WC_CONTROL);
2328 w &= ~0xFA00; /* Seems to be reserved? I don't know */
2329 w |= 0xA000; /* reserved... I don't know */
2330 w &= ~0x0200; /* Channels 56,57,58,59 as Extra Play,Rec Channel enable
2331 Seems to crash the Computer if enabled... */
2332 w |= 0x0100; /* Wave Cache Operation Enabled */
2333 w |= 0x0080; /* Channels 60/61 as Placback/Record enabled */
2334 w &= ~0x0060; /* Clear Wavtable Size */
2335 w |= 0x0020; /* Wavetable Size : 1MB */
2336 /* Bit 4 is reserved */
2337 w &= ~0x000C; /* DMA Stuff? I don't understand what the datasheet means */
2338 /* Bit 1 is reserved */
2339 w &= ~0x0001; /* Test Mode off */
2341 outw(w, iobase + WC_CONTROL);
2343 /* Now clear the APU control ram */
2344 for (i = 0; i < NR_APUS; i++) {
2345 for (w = 0; w < NR_APU_REGS; w++)
2346 apu_set_register(chip, i, w, 0);
2352 static void snd_es1968_start_irq(struct es1968 *chip)
2355 w = ESM_HIRQ_DSIE | ESM_HIRQ_HW_VOLUME;
2357 w |= ESM_HIRQ_MPU401;
2358 outb(w, chip->io_port + 0x1A);
2359 outw(w, chip->io_port + ESM_PORT_HOST_IRQ);
2362 #ifdef CONFIG_PM_SLEEP
2366 static int es1968_suspend(struct device *dev)
2368 struct snd_card *card = dev_get_drvdata(dev);
2369 struct es1968 *chip = card->private_data;
2374 chip->in_suspend = 1;
2375 cancel_work_sync(&chip->hwvol_work);
2376 snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
2377 snd_ac97_suspend(chip->ac97);
2378 snd_es1968_bob_stop(chip);
2382 static int es1968_resume(struct device *dev)
2384 struct snd_card *card = dev_get_drvdata(dev);
2385 struct es1968 *chip = card->private_data;
2391 snd_es1968_chip_init(chip);
2393 /* need to restore the base pointers.. */
2394 if (chip->dma.addr) {
2396 wave_set_register(chip, 0x01FC, chip->dma.addr >> 12);
2399 snd_es1968_start_irq(chip);
2401 /* restore ac97 state */
2402 snd_ac97_resume(chip->ac97);
2404 list_for_each_entry(es, &chip->substream_list, list) {
2407 snd_es1968_playback_setup(chip, es, es->substream->runtime);
2409 case ESM_MODE_CAPTURE:
2410 snd_es1968_capture_setup(chip, es, es->substream->runtime);
2415 /* start timer again */
2416 if (chip->bobclient)
2417 snd_es1968_bob_start(chip);
2419 snd_power_change_state(card, SNDRV_CTL_POWER_D0);
2420 chip->in_suspend = 0;
2424 static SIMPLE_DEV_PM_OPS(es1968_pm, es1968_suspend, es1968_resume);
2425 #define ES1968_PM_OPS &es1968_pm
2427 #define ES1968_PM_OPS NULL
2428 #endif /* CONFIG_PM_SLEEP */
2430 #ifdef SUPPORT_JOYSTICK
2431 #define JOYSTICK_ADDR 0x200
2432 static int snd_es1968_create_gameport(struct es1968 *chip, int dev)
2434 struct gameport *gp;
2441 r = request_region(JOYSTICK_ADDR, 8, "ES1968 gameport");
2445 chip->gameport = gp = gameport_allocate_port();
2447 dev_err(chip->card->dev,
2448 "cannot allocate memory for gameport\n");
2449 release_and_free_resource(r);
2453 pci_read_config_word(chip->pci, ESM_LEGACY_AUDIO_CONTROL, &val);
2454 pci_write_config_word(chip->pci, ESM_LEGACY_AUDIO_CONTROL, val | 0x04);
2456 gameport_set_name(gp, "ES1968 Gameport");
2457 gameport_set_phys(gp, "pci%s/gameport0", pci_name(chip->pci));
2458 gameport_set_dev_parent(gp, &chip->pci->dev);
2459 gp->io = JOYSTICK_ADDR;
2460 gameport_set_port_data(gp, r);
2462 gameport_register_port(gp);
2467 static void snd_es1968_free_gameport(struct es1968 *chip)
2469 if (chip->gameport) {
2470 struct resource *r = gameport_get_port_data(chip->gameport);
2472 gameport_unregister_port(chip->gameport);
2473 chip->gameport = NULL;
2475 release_and_free_resource(r);
2479 static inline int snd_es1968_create_gameport(struct es1968 *chip, int dev) { return -ENOSYS; }
2480 static inline void snd_es1968_free_gameport(struct es1968 *chip) { }
2483 #ifdef CONFIG_SND_ES1968_INPUT
2484 static int snd_es1968_input_register(struct es1968 *chip)
2486 struct input_dev *input_dev;
2489 input_dev = input_allocate_device();
2493 snprintf(chip->phys, sizeof(chip->phys), "pci-%s/input0",
2494 pci_name(chip->pci));
2496 input_dev->name = chip->card->driver;
2497 input_dev->phys = chip->phys;
2498 input_dev->id.bustype = BUS_PCI;
2499 input_dev->id.vendor = chip->pci->vendor;
2500 input_dev->id.product = chip->pci->device;
2501 input_dev->dev.parent = &chip->pci->dev;
2503 __set_bit(EV_KEY, input_dev->evbit);
2504 __set_bit(KEY_MUTE, input_dev->keybit);
2505 __set_bit(KEY_VOLUMEDOWN, input_dev->keybit);
2506 __set_bit(KEY_VOLUMEUP, input_dev->keybit);
2508 err = input_register_device(input_dev);
2510 input_free_device(input_dev);
2514 chip->input_dev = input_dev;
2517 #endif /* CONFIG_SND_ES1968_INPUT */
2519 #ifdef CONFIG_SND_ES1968_RADIO
2520 #define GPIO_DATA 0x60
2521 #define IO_MASK 4 /* mask register offset from GPIO_DATA
2522 bits 1=unmask write to given bit */
2523 #define IO_DIR 8 /* direction register offset from GPIO_DATA
2524 bits 0/1=read/write direction */
2526 /* GPIO to TEA575x maps */
2527 struct snd_es1968_tea575x_gpio {
2528 u8 data, clk, wren, most;
2532 static struct snd_es1968_tea575x_gpio snd_es1968_tea575x_gpios[] = {
2533 { .data = 6, .clk = 7, .wren = 8, .most = 9, .name = "SF64-PCE2" },
2534 { .data = 7, .clk = 8, .wren = 6, .most = 10, .name = "M56VAP" },
2537 #define get_tea575x_gpio(chip) \
2538 (&snd_es1968_tea575x_gpios[(chip)->tea575x_tuner])
2541 static void snd_es1968_tea575x_set_pins(struct snd_tea575x *tea, u8 pins)
2543 struct es1968 *chip = tea->private_data;
2544 struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
2547 val |= (pins & TEA575X_DATA) ? (1 << gpio.data) : 0;
2548 val |= (pins & TEA575X_CLK) ? (1 << gpio.clk) : 0;
2549 val |= (pins & TEA575X_WREN) ? (1 << gpio.wren) : 0;
2551 outw(val, chip->io_port + GPIO_DATA);
2554 static u8 snd_es1968_tea575x_get_pins(struct snd_tea575x *tea)
2556 struct es1968 *chip = tea->private_data;
2557 struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
2558 u16 val = inw(chip->io_port + GPIO_DATA);
2561 if (val & (1 << gpio.data))
2562 ret |= TEA575X_DATA;
2563 if (val & (1 << gpio.most))
2564 ret |= TEA575X_MOST;
2569 static void snd_es1968_tea575x_set_direction(struct snd_tea575x *tea, bool output)
2571 struct es1968 *chip = tea->private_data;
2572 unsigned long io = chip->io_port + GPIO_DATA;
2573 u16 odir = inw(io + IO_DIR);
2574 struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
2577 outw(~((1 << gpio.data) | (1 << gpio.clk) | (1 << gpio.wren)),
2579 outw(odir | (1 << gpio.data) | (1 << gpio.clk) | (1 << gpio.wren),
2582 outw(~((1 << gpio.clk) | (1 << gpio.wren) | (1 << gpio.data) | (1 << gpio.most)),
2584 outw((odir & ~((1 << gpio.data) | (1 << gpio.most)))
2585 | (1 << gpio.clk) | (1 << gpio.wren), io + IO_DIR);
2589 static const struct snd_tea575x_ops snd_es1968_tea_ops = {
2590 .set_pins = snd_es1968_tea575x_set_pins,
2591 .get_pins = snd_es1968_tea575x_get_pins,
2592 .set_direction = snd_es1968_tea575x_set_direction,
2596 static int snd_es1968_free(struct es1968 *chip)
2598 cancel_work_sync(&chip->hwvol_work);
2599 #ifdef CONFIG_SND_ES1968_INPUT
2600 if (chip->input_dev)
2601 input_unregister_device(chip->input_dev);
2604 if (chip->io_port) {
2605 outw(1, chip->io_port + 0x04); /* clear WP interrupts */
2606 outw(0, chip->io_port + ESM_PORT_HOST_IRQ); /* disable IRQ */
2609 #ifdef CONFIG_SND_ES1968_RADIO
2610 snd_tea575x_exit(&chip->tea);
2611 v4l2_device_unregister(&chip->v4l2_dev);
2615 free_irq(chip->irq, chip);
2616 snd_es1968_free_gameport(chip);
2617 pci_release_regions(chip->pci);
2618 pci_disable_device(chip->pci);
2623 static int snd_es1968_dev_free(struct snd_device *device)
2625 struct es1968 *chip = device->device_data;
2626 return snd_es1968_free(chip);
2629 struct ess_device_list {
2630 unsigned short type; /* chip type */
2631 unsigned short vendor; /* subsystem vendor id */
2634 static struct ess_device_list pm_whitelist[] = {
2635 { TYPE_MAESTRO2E, 0x0e11 }, /* Compaq Armada */
2636 { TYPE_MAESTRO2E, 0x1028 },
2637 { TYPE_MAESTRO2E, 0x103c },
2638 { TYPE_MAESTRO2E, 0x1179 },
2639 { TYPE_MAESTRO2E, 0x14c0 }, /* HP omnibook 4150 */
2640 { TYPE_MAESTRO2E, 0x1558 },
2641 { TYPE_MAESTRO2E, 0x125d }, /* a PCI card, e.g. Terratec DMX */
2642 { TYPE_MAESTRO2, 0x125d }, /* a PCI card, e.g. SF64-PCE2 */
2645 static struct ess_device_list mpu_blacklist[] = {
2646 { TYPE_MAESTRO2, 0x125d },
2649 static int snd_es1968_create(struct snd_card *card,
2650 struct pci_dev *pci,
2657 struct es1968 **chip_ret)
2659 static const struct snd_device_ops ops = {
2660 .dev_free = snd_es1968_dev_free,
2662 struct es1968 *chip;
2667 /* enable PCI device */
2668 if ((err = pci_enable_device(pci)) < 0)
2670 /* check, if we can restrict PCI DMA transfers to 28 bits */
2671 if (dma_set_mask(&pci->dev, DMA_BIT_MASK(28)) < 0 ||
2672 dma_set_coherent_mask(&pci->dev, DMA_BIT_MASK(28)) < 0) {
2674 "architecture does not support 28bit PCI busmaster DMA\n");
2675 pci_disable_device(pci);
2679 chip = kzalloc(sizeof(*chip), GFP_KERNEL);
2681 pci_disable_device(pci);
2686 chip->type = chip_type;
2687 spin_lock_init(&chip->reg_lock);
2688 spin_lock_init(&chip->substream_lock);
2689 INIT_LIST_HEAD(&chip->buf_list);
2690 INIT_LIST_HEAD(&chip->substream_list);
2691 mutex_init(&chip->memory_mutex);
2692 INIT_WORK(&chip->hwvol_work, es1968_update_hw_volume);
2696 chip->total_bufsize = total_bufsize; /* in bytes */
2697 chip->playback_streams = play_streams;
2698 chip->capture_streams = capt_streams;
2700 if ((err = pci_request_regions(pci, "ESS Maestro")) < 0) {
2702 pci_disable_device(pci);
2705 chip->io_port = pci_resource_start(pci, 0);
2706 if (request_irq(pci->irq, snd_es1968_interrupt, IRQF_SHARED,
2707 KBUILD_MODNAME, chip)) {
2708 dev_err(card->dev, "unable to grab IRQ %d\n", pci->irq);
2709 snd_es1968_free(chip);
2712 chip->irq = pci->irq;
2713 card->sync_irq = chip->irq;
2715 /* Clear Maestro_map */
2716 for (i = 0; i < 32; i++)
2717 chip->maestro_map[i] = 0;
2720 for (i = 0; i < NR_APUS; i++)
2721 chip->apu[i] = ESM_APU_FREE;
2723 /* just to be sure */
2724 pci_set_master(pci);
2727 /* disable power-management if not on the whitelist */
2728 unsigned short vend;
2729 pci_read_config_word(chip->pci, PCI_SUBSYSTEM_VENDOR_ID, &vend);
2730 for (i = 0; i < (int)ARRAY_SIZE(pm_whitelist); i++) {
2731 if (chip->type == pm_whitelist[i].type &&
2732 vend == pm_whitelist[i].vendor) {
2738 /* not matched; disabling pm */
2739 dev_info(card->dev, "not attempting power management.\n");
2743 chip->do_pm = do_pm;
2745 snd_es1968_chip_init(chip);
2747 if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops)) < 0) {
2748 snd_es1968_free(chip);
2752 #ifdef CONFIG_SND_ES1968_RADIO
2753 /* don't play with GPIOs on laptops */
2754 if (chip->pci->subsystem_vendor != 0x125d)
2756 err = v4l2_device_register(&pci->dev, &chip->v4l2_dev);
2758 snd_es1968_free(chip);
2761 chip->tea.v4l2_dev = &chip->v4l2_dev;
2762 chip->tea.private_data = chip;
2763 chip->tea.radio_nr = radio_nr;
2764 chip->tea.ops = &snd_es1968_tea_ops;
2765 sprintf(chip->tea.bus_info, "PCI:%s", pci_name(pci));
2766 for (i = 0; i < ARRAY_SIZE(snd_es1968_tea575x_gpios); i++) {
2767 chip->tea575x_tuner = i;
2768 if (!snd_tea575x_init(&chip->tea, THIS_MODULE)) {
2769 dev_info(card->dev, "detected TEA575x radio type %s\n",
2770 get_tea575x_gpio(chip)->name);
2771 strlcpy(chip->tea.card, get_tea575x_gpio(chip)->name,
2772 sizeof(chip->tea.card));
2787 static int snd_es1968_probe(struct pci_dev *pci,
2788 const struct pci_device_id *pci_id)
2791 struct snd_card *card;
2792 struct es1968 *chip;
2796 if (dev >= SNDRV_CARDS)
2803 err = snd_card_new(&pci->dev, index[dev], id[dev], THIS_MODULE,
2808 if (total_bufsize[dev] < 128)
2809 total_bufsize[dev] = 128;
2810 if (total_bufsize[dev] > 4096)
2811 total_bufsize[dev] = 4096;
2812 if ((err = snd_es1968_create(card, pci,
2813 total_bufsize[dev] * 1024, /* in bytes */
2814 pcm_substreams_p[dev],
2815 pcm_substreams_c[dev],
2816 pci_id->driver_data,
2820 snd_card_free(card);
2823 card->private_data = chip;
2825 switch (chip->type) {
2826 case TYPE_MAESTRO2E:
2827 strcpy(card->driver, "ES1978");
2828 strcpy(card->shortname, "ESS ES1978 (Maestro 2E)");
2831 strcpy(card->driver, "ES1968");
2832 strcpy(card->shortname, "ESS ES1968 (Maestro 2)");
2835 strcpy(card->driver, "ESM1");
2836 strcpy(card->shortname, "ESS Maestro 1");
2840 if ((err = snd_es1968_pcm(chip, 0)) < 0) {
2841 snd_card_free(card);
2845 if ((err = snd_es1968_mixer(chip)) < 0) {
2846 snd_card_free(card);
2850 if (enable_mpu[dev] == 2) {
2851 /* check the black list */
2852 unsigned short vend;
2853 pci_read_config_word(chip->pci, PCI_SUBSYSTEM_VENDOR_ID, &vend);
2854 for (i = 0; i < ARRAY_SIZE(mpu_blacklist); i++) {
2855 if (chip->type == mpu_blacklist[i].type &&
2856 vend == mpu_blacklist[i].vendor) {
2857 enable_mpu[dev] = 0;
2862 if (enable_mpu[dev]) {
2863 if ((err = snd_mpu401_uart_new(card, 0, MPU401_HW_MPU401,
2864 chip->io_port + ESM_MPU401_PORT,
2865 MPU401_INFO_INTEGRATED |
2866 MPU401_INFO_IRQ_HOOK,
2867 -1, &chip->rmidi)) < 0) {
2868 dev_warn(card->dev, "skipping MPU-401 MIDI support..\n");
2872 snd_es1968_create_gameport(chip, dev);
2874 #ifdef CONFIG_SND_ES1968_INPUT
2875 err = snd_es1968_input_register(chip);
2878 "Input device registration failed with error %i", err);
2881 snd_es1968_start_irq(chip);
2883 chip->clock = clock[dev];
2885 es1968_measure_clock(chip);
2887 sprintf(card->longname, "%s at 0x%lx, irq %i",
2888 card->shortname, chip->io_port, chip->irq);
2890 if ((err = snd_card_register(card)) < 0) {
2891 snd_card_free(card);
2894 pci_set_drvdata(pci, card);
2899 static void snd_es1968_remove(struct pci_dev *pci)
2901 snd_card_free(pci_get_drvdata(pci));
2904 static struct pci_driver es1968_driver = {
2905 .name = KBUILD_MODNAME,
2906 .id_table = snd_es1968_ids,
2907 .probe = snd_es1968_probe,
2908 .remove = snd_es1968_remove,
2910 .pm = ES1968_PM_OPS,
2914 module_pci_driver(es1968_driver);