1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97#include <asm/io.h>
98#include <linux/delay.h>
99#include <linux/interrupt.h>
100#include <linux/init.h>
101#include <linux/pci.h>
102#include <linux/dma-mapping.h>
103#include <linux/slab.h>
104#include <linux/gameport.h>
105#include <linux/module.h>
106#include <linux/mutex.h>
107#include <linux/input.h>
108
109#include <sound/core.h>
110#include <sound/pcm.h>
111#include <sound/mpu401.h>
112#include <sound/ac97_codec.h>
113#include <sound/initval.h>
114
115#ifdef CONFIG_SND_ES1968_RADIO
116#include <sound/tea575x-tuner.h>
117#endif
118
119#define CARD_NAME "ESS Maestro1/2"
120#define DRIVER_NAME "ES1968"
121
122MODULE_DESCRIPTION("ESS Maestro");
123MODULE_LICENSE("GPL");
124MODULE_SUPPORTED_DEVICE("{{ESS,Maestro 2e},"
125 "{ESS,Maestro 2},"
126 "{ESS,Maestro 1},"
127 "{TerraTec,DMX}}");
128
129#if defined(CONFIG_GAMEPORT) || (defined(MODULE) && defined(CONFIG_GAMEPORT_MODULE))
130#define SUPPORT_JOYSTICK 1
131#endif
132
133static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
134static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
135static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
136static int total_bufsize[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 1024 };
137static int pcm_substreams_p[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 4 };
138static int pcm_substreams_c[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 1 };
139static int clock[SNDRV_CARDS];
140static int use_pm[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 2};
141static int enable_mpu[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 2};
142#ifdef SUPPORT_JOYSTICK
143static bool joystick[SNDRV_CARDS];
144#endif
145static int radio_nr[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = -1};
146
147module_param_array(index, int, NULL, 0444);
148MODULE_PARM_DESC(index, "Index value for " CARD_NAME " soundcard.");
149module_param_array(id, charp, NULL, 0444);
150MODULE_PARM_DESC(id, "ID string for " CARD_NAME " soundcard.");
151module_param_array(enable, bool, NULL, 0444);
152MODULE_PARM_DESC(enable, "Enable " CARD_NAME " soundcard.");
153module_param_array(total_bufsize, int, NULL, 0444);
154MODULE_PARM_DESC(total_bufsize, "Total buffer size in kB.");
155module_param_array(pcm_substreams_p, int, NULL, 0444);
156MODULE_PARM_DESC(pcm_substreams_p, "PCM Playback substreams for " CARD_NAME " soundcard.");
157module_param_array(pcm_substreams_c, int, NULL, 0444);
158MODULE_PARM_DESC(pcm_substreams_c, "PCM Capture substreams for " CARD_NAME " soundcard.");
159module_param_array(clock, int, NULL, 0444);
160MODULE_PARM_DESC(clock, "Clock on " CARD_NAME " soundcard. (0 = auto-detect)");
161module_param_array(use_pm, int, NULL, 0444);
162MODULE_PARM_DESC(use_pm, "Toggle power-management. (0 = off, 1 = on, 2 = auto)");
163module_param_array(enable_mpu, int, NULL, 0444);
164MODULE_PARM_DESC(enable_mpu, "Enable MPU401. (0 = off, 1 = on, 2 = auto)");
165#ifdef SUPPORT_JOYSTICK
166module_param_array(joystick, bool, NULL, 0444);
167MODULE_PARM_DESC(joystick, "Enable joystick.");
168#endif
169module_param_array(radio_nr, int, NULL, 0444);
170MODULE_PARM_DESC(radio_nr, "Radio device numbers");
171
172
173
174#define NR_APUS 64
175#define NR_APU_REGS 16
176
177
178#define NEC_VERSA_SUBID1 0x80581033
179#define NEC_VERSA_SUBID2 0x803c1033
180
181
182#define ESS_FMT_STEREO 0x01
183#define ESS_FMT_16BIT 0x02
184
185#define DAC_RUNNING 1
186#define ADC_RUNNING 2
187
188
189
190#define ESS_DISABLE_AUDIO 0x8000
191#define ESS_ENABLE_SERIAL_IRQ 0x4000
192#define IO_ADRESS_ALIAS 0x0020
193#define MPU401_IRQ_ENABLE 0x0010
194#define MPU401_IO_ENABLE 0x0008
195#define GAME_IO_ENABLE 0x0004
196#define FM_IO_ENABLE 0x0002
197#define SB_IO_ENABLE 0x0001
198
199
200
201#define PIC_SNOOP1 0x4000
202#define PIC_SNOOP2 0x2000
203#define SAFEGUARD 0x0800
204#define DMA_CLEAR 0x0700
205#define DMA_DDMA 0x0000
206#define DMA_TDMA 0x0100
207#define DMA_PCPCI 0x0200
208#define POST_WRITE 0x0080
209#define PCI_TIMING 0x0040
210#define SWAP_LR 0x0020
211#define SUBTR_DECODE 0x0002
212
213
214
215#define SPDIF_CONFB 0x0100
216#define HWV_CONFB 0x0080
217#define DEBOUNCE 0x0040
218#define GPIO_CONFB 0x0020
219#define CHI_CONFB 0x0010
220#define IDMA_CONFB 0x0008
221#define MIDI_FIX 0x0004
222#define IRQ_TO_ISA 0x0001
223
224
225#define RINGB_2CODEC_ID_MASK 0x0003
226#define RINGB_DIS_VALIDATION 0x0008
227#define RINGB_EN_SPDIF 0x0010
228#define RINGB_EN_2CODEC 0x0020
229#define RINGB_SING_BIT_DUAL 0x0040
230
231
232
233
234#define ESM_INDEX 0x02
235#define ESM_DATA 0x00
236
237
238#define ESM_AC97_INDEX 0x30
239#define ESM_AC97_DATA 0x32
240#define ESM_RING_BUS_DEST 0x34
241#define ESM_RING_BUS_CONTR_A 0x36
242#define ESM_RING_BUS_CONTR_B 0x38
243#define ESM_RING_BUS_SDO 0x3A
244
245
246#define WC_INDEX 0x10
247#define WC_DATA 0x12
248#define WC_CONTROL 0x14
249
250
251#define ASSP_INDEX 0x80
252#define ASSP_MEMORY 0x82
253#define ASSP_DATA 0x84
254#define ASSP_CONTROL_A 0xA2
255#define ASSP_CONTROL_B 0xA4
256#define ASSP_CONTROL_C 0xA6
257#define ASSP_HOSTW_INDEX 0xA8
258#define ASSP_HOSTW_DATA 0xAA
259#define ASSP_HOSTW_IRQ 0xAC
260
261#define ESM_MPU401_PORT 0x98
262
263#define ESM_PORT_HOST_IRQ 0x18
264
265#define IDR0_DATA_PORT 0x00
266#define IDR1_CRAM_POINTER 0x01
267#define IDR2_CRAM_DATA 0x02
268#define IDR3_WAVE_DATA 0x03
269#define IDR4_WAVE_PTR_LOW 0x04
270#define IDR5_WAVE_PTR_HI 0x05
271#define IDR6_TIMER_CTRL 0x06
272#define IDR7_WAVE_ROMRAM 0x07
273
274#define WRITEABLE_MAP 0xEFFFFF
275#define READABLE_MAP 0x64003F
276
277
278
279#define ESM_LEGACY_AUDIO_CONTROL 0x40
280#define ESM_ACPI_COMMAND 0x54
281#define ESM_CONFIG_A 0x50
282#define ESM_CONFIG_B 0x52
283#define ESM_DDMA 0x60
284
285
286#define ESM_BOB_ENABLE 0x0001
287#define ESM_BOB_START 0x0001
288
289
290#define ESM_RESET_MAESTRO 0x8000
291#define ESM_RESET_DIRECTSOUND 0x4000
292#define ESM_HIRQ_ClkRun 0x0100
293#define ESM_HIRQ_HW_VOLUME 0x0040
294#define ESM_HIRQ_HARPO 0x0030
295#define ESM_HIRQ_ASSP 0x0010
296#define ESM_HIRQ_DSIE 0x0004
297#define ESM_HIRQ_MPU401 0x0002
298#define ESM_HIRQ_SB 0x0001
299
300
301#define ESM_MPU401_IRQ 0x02
302#define ESM_SB_IRQ 0x01
303#define ESM_SOUND_IRQ 0x04
304#define ESM_ASSP_IRQ 0x10
305#define ESM_HWVOL_IRQ 0x40
306
307#define ESS_SYSCLK 50000000
308#define ESM_BOB_FREQ 200
309#define ESM_BOB_FREQ_MAX 800
310
311#define ESM_FREQ_ESM1 (49152000L / 1024L)
312#define ESM_FREQ_ESM2 (50000000L / 1024L)
313
314
315#define ESM_APU_MODE_SHIFT 4
316#define ESM_APU_MODE_MASK (0xf << 4)
317#define ESM_APU_OFF 0x00
318#define ESM_APU_16BITLINEAR 0x01
319#define ESM_APU_16BITSTEREO 0x02
320#define ESM_APU_8BITLINEAR 0x03
321#define ESM_APU_8BITSTEREO 0x04
322#define ESM_APU_8BITDIFF 0x05
323#define ESM_APU_DIGITALDELAY 0x06
324#define ESM_APU_DUALTAP 0x07
325#define ESM_APU_CORRELATOR 0x08
326#define ESM_APU_INPUTMIXER 0x09
327#define ESM_APU_WAVETABLE 0x0A
328#define ESM_APU_SRCONVERTOR 0x0B
329#define ESM_APU_16BITPINGPONG 0x0C
330#define ESM_APU_RESERVED1 0x0D
331#define ESM_APU_RESERVED2 0x0E
332#define ESM_APU_RESERVED3 0x0F
333
334
335#define ESM_APU_FILTER_Q_SHIFT 0
336#define ESM_APU_FILTER_Q_MASK (3 << 0)
337
338#define ESM_APU_FILTER_LESSQ 0x00
339#define ESM_APU_FILTER_MOREQ 0x03
340
341#define ESM_APU_FILTER_TYPE_SHIFT 2
342#define ESM_APU_FILTER_TYPE_MASK (3 << 2)
343#define ESM_APU_ENV_TYPE_SHIFT 8
344#define ESM_APU_ENV_TYPE_MASK (3 << 8)
345#define ESM_APU_ENV_STATE_SHIFT 10
346#define ESM_APU_ENV_STATE_MASK (3 << 10)
347#define ESM_APU_END_CURVE (1 << 12)
348#define ESM_APU_INT_ON_LOOP (1 << 13)
349#define ESM_APU_DMA_ENABLE (1 << 14)
350
351
352#define ESM_APU_SUBMIX_GROUP_SHIRT 0
353#define ESM_APU_SUBMIX_GROUP_MASK (7 << 0)
354#define ESM_APU_SUBMIX_MODE (1 << 3)
355#define ESM_APU_6dB (1 << 4)
356#define ESM_APU_DUAL_EFFECT (1 << 5)
357#define ESM_APU_EFFECT_CHANNELS_SHIFT 6
358#define ESM_APU_EFFECT_CHANNELS_MASK (3 << 6)
359
360
361#define ESM_APU_STEP_SIZE_MASK 0x0fff
362
363
364#define ESM_APU_PHASE_SHIFT 0
365#define ESM_APU_PHASE_MASK (0xff << 0)
366#define ESM_APU_WAVE64K_PAGE_SHIFT 8
367#define ESM_APU_WAVE64K_PAGE_MASK (0xff << 8)
368
369
370
371
372
373
374#define ESM_APU_EFFECT_GAIN_SHIFT 0
375#define ESM_APU_EFFECT_GAIN_MASK (0xff << 0)
376#define ESM_APU_TREMOLO_DEPTH_SHIFT 8
377#define ESM_APU_TREMOLO_DEPTH_MASK (0xf << 8)
378#define ESM_APU_TREMOLO_RATE_SHIFT 12
379#define ESM_APU_TREMOLO_RATE_MASK (0xf << 12)
380
381
382
383#define ESM_APU_AMPLITUDE_NOW_SHIFT 8
384#define ESM_APU_AMPLITUDE_NOW_MASK (0xff << 8)
385
386
387#define ESM_APU_POLAR_PAN_SHIFT 0
388#define ESM_APU_POLAR_PAN_MASK (0x3f << 0)
389
390#define ESM_APU_PAN_CENTER_CIRCLE 0x00
391#define ESM_APU_PAN_MIDDLE_RADIUS 0x01
392#define ESM_APU_PAN_OUTSIDE_RADIUS 0x02
393
394#define ESM_APU_FILTER_TUNING_SHIFT 8
395#define ESM_APU_FILTER_TUNING_MASK (0xff << 8)
396
397
398#define ESM_APU_DATA_SRC_A_SHIFT 0
399#define ESM_APU_DATA_SRC_A_MASK (0x7f << 0)
400#define ESM_APU_INV_POL_A (1 << 7)
401#define ESM_APU_DATA_SRC_B_SHIFT 8
402#define ESM_APU_DATA_SRC_B_MASK (0x7f << 8)
403#define ESM_APU_INV_POL_B (1 << 15)
404
405#define ESM_APU_VIBRATO_RATE_SHIFT 0
406#define ESM_APU_VIBRATO_RATE_MASK (0xf << 0)
407#define ESM_APU_VIBRATO_DEPTH_SHIFT 4
408#define ESM_APU_VIBRATO_DEPTH_MASK (0xf << 4)
409#define ESM_APU_VIBRATO_PHASE_SHIFT 8
410#define ESM_APU_VIBRATO_PHASE_MASK (0xff << 8)
411
412
413#define ESM_APU_RADIUS_SELECT (1 << 6)
414
415
416#define ESM_APU_FILTER_2POLE_LOPASS 0x00
417#define ESM_APU_FILTER_2POLE_BANDPASS 0x01
418#define ESM_APU_FILTER_2POLE_HIPASS 0x02
419#define ESM_APU_FILTER_1POLE_LOPASS 0x03
420#define ESM_APU_FILTER_1POLE_HIPASS 0x04
421#define ESM_APU_FILTER_OFF 0x05
422
423
424#define ESM_APU_ATFP_AMPLITUDE 0x00
425#define ESM_APU_ATFP_TREMELO 0x01
426#define ESM_APU_ATFP_FILTER 0x02
427#define ESM_APU_ATFP_PAN 0x03
428
429
430#define ESM_APU_ATFP_FLG_OFF 0x00
431#define ESM_APU_ATFP_FLG_WAIT 0x01
432#define ESM_APU_ATFP_FLG_DONE 0x02
433#define ESM_APU_ATFP_FLG_INPROCESS 0x03
434
435
436
437#define ESM_MEM_ALIGN 0x1000
438#define ESM_MIXBUF_SIZE 0x400
439
440#define ESM_MODE_PLAY 0
441#define ESM_MODE_CAPTURE 1
442
443
444
445enum snd_enum_apu_type {
446 ESM_APU_PCM_PLAY,
447 ESM_APU_PCM_CAPTURE,
448 ESM_APU_PCM_RATECONV,
449 ESM_APU_FREE
450};
451
452
453enum {
454 TYPE_MAESTRO, TYPE_MAESTRO2, TYPE_MAESTRO2E
455};
456
457
458struct esm_memory {
459 struct snd_dma_buffer buf;
460 int empty;
461 struct list_head list;
462};
463
464
465struct esschan {
466 int running;
467
468 u8 apu[4];
469 u8 apu_mode[4];
470
471
472 struct esm_memory *memory;
473
474 struct esm_memory *mixbuf;
475
476 unsigned int hwptr;
477 unsigned int count;
478 unsigned int dma_size;
479 unsigned int frag_size;
480 unsigned int wav_shift;
481 u16 base[4];
482
483
484 unsigned char fmt;
485 int mode;
486
487 int bob_freq;
488
489 struct snd_pcm_substream *substream;
490
491
492 struct list_head list;
493
494#ifdef CONFIG_PM_SLEEP
495 u16 wc_map[4];
496#endif
497};
498
499struct es1968 {
500
501 int total_bufsize;
502
503 int playback_streams, capture_streams;
504
505 unsigned int clock;
506
507 unsigned int in_measurement: 1;
508 unsigned int measure_apu;
509 unsigned int measure_lastpos;
510 unsigned int measure_count;
511
512
513 struct snd_dma_buffer dma;
514
515
516 int irq;
517 unsigned long io_port;
518 int type;
519 struct pci_dev *pci;
520 struct snd_card *card;
521 struct snd_pcm *pcm;
522 int do_pm;
523
524
525 struct list_head buf_list;
526
527
528 struct snd_ac97 *ac97;
529 struct snd_rawmidi *rmidi;
530
531 spinlock_t reg_lock;
532 unsigned int in_suspend;
533
534
535 u16 maestro_map[32];
536 int bobclient;
537 int bob_freq;
538 struct mutex memory_mutex;
539
540
541 unsigned char apu[NR_APUS];
542
543
544 struct list_head substream_list;
545 spinlock_t substream_lock;
546
547#ifdef CONFIG_PM_SLEEP
548 u16 apu_map[NR_APUS][NR_APU_REGS];
549#endif
550
551#ifdef SUPPORT_JOYSTICK
552 struct gameport *gameport;
553#endif
554
555#ifdef CONFIG_SND_ES1968_INPUT
556 struct input_dev *input_dev;
557 char phys[64];
558#else
559 struct snd_kcontrol *master_switch;
560 struct snd_kcontrol *master_volume;
561#endif
562 struct work_struct hwvol_work;
563
564#ifdef CONFIG_SND_ES1968_RADIO
565 struct v4l2_device v4l2_dev;
566 struct snd_tea575x tea;
567#endif
568};
569
570static irqreturn_t snd_es1968_interrupt(int irq, void *dev_id);
571
572static DEFINE_PCI_DEVICE_TABLE(snd_es1968_ids) = {
573
574 { 0x1285, 0x0100, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO },
575
576 { 0x125d, 0x1968, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO2 },
577
578 { 0x125d, 0x1978, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO2E },
579 { 0, }
580};
581
582MODULE_DEVICE_TABLE(pci, snd_es1968_ids);
583
584
585
586
587
588
589static void __maestro_write(struct es1968 *chip, u16 reg, u16 data)
590{
591 outw(reg, chip->io_port + ESM_INDEX);
592 outw(data, chip->io_port + ESM_DATA);
593 chip->maestro_map[reg] = data;
594}
595
596static inline void maestro_write(struct es1968 *chip, u16 reg, u16 data)
597{
598 unsigned long flags;
599 spin_lock_irqsave(&chip->reg_lock, flags);
600 __maestro_write(chip, reg, data);
601 spin_unlock_irqrestore(&chip->reg_lock, flags);
602}
603
604
605static u16 __maestro_read(struct es1968 *chip, u16 reg)
606{
607 if (READABLE_MAP & (1 << reg)) {
608 outw(reg, chip->io_port + ESM_INDEX);
609 chip->maestro_map[reg] = inw(chip->io_port + ESM_DATA);
610 }
611 return chip->maestro_map[reg];
612}
613
614static inline u16 maestro_read(struct es1968 *chip, u16 reg)
615{
616 unsigned long flags;
617 u16 result;
618 spin_lock_irqsave(&chip->reg_lock, flags);
619 result = __maestro_read(chip, reg);
620 spin_unlock_irqrestore(&chip->reg_lock, flags);
621 return result;
622}
623
624
625static int snd_es1968_ac97_wait(struct es1968 *chip)
626{
627 int timeout = 100000;
628
629 while (timeout-- > 0) {
630 if (!(inb(chip->io_port + ESM_AC97_INDEX) & 1))
631 return 0;
632 cond_resched();
633 }
634 snd_printd("es1968: ac97 timeout\n");
635 return 1;
636}
637
638static int snd_es1968_ac97_wait_poll(struct es1968 *chip)
639{
640 int timeout = 100000;
641
642 while (timeout-- > 0) {
643 if (!(inb(chip->io_port + ESM_AC97_INDEX) & 1))
644 return 0;
645 }
646 snd_printd("es1968: ac97 timeout\n");
647 return 1;
648}
649
650static void snd_es1968_ac97_write(struct snd_ac97 *ac97, unsigned short reg, unsigned short val)
651{
652 struct es1968 *chip = ac97->private_data;
653
654 snd_es1968_ac97_wait(chip);
655
656
657 outw(val, chip->io_port + ESM_AC97_DATA);
658
659 outb(reg, chip->io_port + ESM_AC97_INDEX);
660
661}
662
663static unsigned short snd_es1968_ac97_read(struct snd_ac97 *ac97, unsigned short reg)
664{
665 u16 data = 0;
666 struct es1968 *chip = ac97->private_data;
667
668 snd_es1968_ac97_wait(chip);
669
670 outb(reg | 0x80, chip->io_port + ESM_AC97_INDEX);
671
672
673 if (!snd_es1968_ac97_wait_poll(chip)) {
674 data = inw(chip->io_port + ESM_AC97_DATA);
675
676 }
677
678 return data;
679}
680
681
682static void apu_index_set(struct es1968 *chip, u16 index)
683{
684 int i;
685 __maestro_write(chip, IDR1_CRAM_POINTER, index);
686 for (i = 0; i < 1000; i++)
687 if (__maestro_read(chip, IDR1_CRAM_POINTER) == index)
688 return;
689 snd_printd("es1968: APU register select failed. (Timeout)\n");
690}
691
692
693static void apu_data_set(struct es1968 *chip, u16 data)
694{
695 int i;
696 for (i = 0; i < 1000; i++) {
697 if (__maestro_read(chip, IDR0_DATA_PORT) == data)
698 return;
699 __maestro_write(chip, IDR0_DATA_PORT, data);
700 }
701 snd_printd("es1968: APU register set probably failed (Timeout)!\n");
702}
703
704
705static void __apu_set_register(struct es1968 *chip, u16 channel, u8 reg, u16 data)
706{
707 if (snd_BUG_ON(channel >= NR_APUS))
708 return;
709#ifdef CONFIG_PM_SLEEP
710 chip->apu_map[channel][reg] = data;
711#endif
712 reg |= (channel << 4);
713 apu_index_set(chip, reg);
714 apu_data_set(chip, data);
715}
716
717static void apu_set_register(struct es1968 *chip, u16 channel, u8 reg, u16 data)
718{
719 unsigned long flags;
720 spin_lock_irqsave(&chip->reg_lock, flags);
721 __apu_set_register(chip, channel, reg, data);
722 spin_unlock_irqrestore(&chip->reg_lock, flags);
723}
724
725static u16 __apu_get_register(struct es1968 *chip, u16 channel, u8 reg)
726{
727 if (snd_BUG_ON(channel >= NR_APUS))
728 return 0;
729 reg |= (channel << 4);
730 apu_index_set(chip, reg);
731 return __maestro_read(chip, IDR0_DATA_PORT);
732}
733
734static u16 apu_get_register(struct es1968 *chip, u16 channel, u8 reg)
735{
736 unsigned long flags;
737 u16 v;
738 spin_lock_irqsave(&chip->reg_lock, flags);
739 v = __apu_get_register(chip, channel, reg);
740 spin_unlock_irqrestore(&chip->reg_lock, flags);
741 return v;
742}
743
744#if 0
745
746static void assp_set_register(struct es1968 *chip, u32 reg, u32 value)
747{
748 unsigned long flags;
749
750 spin_lock_irqsave(&chip->reg_lock, flags);
751 outl(reg, chip->io_port + ASSP_INDEX);
752 outl(value, chip->io_port + ASSP_DATA);
753 spin_unlock_irqrestore(&chip->reg_lock, flags);
754}
755
756static u32 assp_get_register(struct es1968 *chip, u32 reg)
757{
758 unsigned long flags;
759 u32 value;
760
761 spin_lock_irqsave(&chip->reg_lock, flags);
762 outl(reg, chip->io_port + ASSP_INDEX);
763 value = inl(chip->io_port + ASSP_DATA);
764 spin_unlock_irqrestore(&chip->reg_lock, flags);
765
766 return value;
767}
768
769#endif
770
771static void wave_set_register(struct es1968 *chip, u16 reg, u16 value)
772{
773 unsigned long flags;
774
775 spin_lock_irqsave(&chip->reg_lock, flags);
776 outw(reg, chip->io_port + WC_INDEX);
777 outw(value, chip->io_port + WC_DATA);
778 spin_unlock_irqrestore(&chip->reg_lock, flags);
779}
780
781static u16 wave_get_register(struct es1968 *chip, u16 reg)
782{
783 unsigned long flags;
784 u16 value;
785
786 spin_lock_irqsave(&chip->reg_lock, flags);
787 outw(reg, chip->io_port + WC_INDEX);
788 value = inw(chip->io_port + WC_DATA);
789 spin_unlock_irqrestore(&chip->reg_lock, flags);
790
791 return value;
792}
793
794
795
796
797
798static void snd_es1968_bob_stop(struct es1968 *chip)
799{
800 u16 reg;
801
802 reg = __maestro_read(chip, 0x11);
803 reg &= ~ESM_BOB_ENABLE;
804 __maestro_write(chip, 0x11, reg);
805 reg = __maestro_read(chip, 0x17);
806 reg &= ~ESM_BOB_START;
807 __maestro_write(chip, 0x17, reg);
808}
809
810static void snd_es1968_bob_start(struct es1968 *chip)
811{
812 int prescale;
813 int divide;
814
815
816
817 for (prescale = 5; prescale < 12; prescale++)
818 if (chip->bob_freq > (ESS_SYSCLK >> (prescale + 9)))
819 break;
820
821
822 divide = 1;
823 while ((prescale > 5) && (divide < 32)) {
824 prescale--;
825 divide <<= 1;
826 }
827 divide >>= 1;
828
829
830 for (; divide < 31; divide++)
831 if (chip->bob_freq >
832 ((ESS_SYSCLK >> (prescale + 9)) / (divide + 1))) break;
833
834
835 if (divide == 0) {
836 divide++;
837 if (prescale > 5)
838 prescale--;
839 } else if (divide > 1)
840 divide--;
841
842 __maestro_write(chip, 6, 0x9000 | (prescale << 5) | divide);
843
844
845 __maestro_write(chip, 0x11, __maestro_read(chip, 0x11) | 1);
846 __maestro_write(chip, 0x17, __maestro_read(chip, 0x17) | 1);
847}
848
849
850static void snd_es1968_bob_inc(struct es1968 *chip, int freq)
851{
852 chip->bobclient++;
853 if (chip->bobclient == 1) {
854 chip->bob_freq = freq;
855 snd_es1968_bob_start(chip);
856 } else if (chip->bob_freq < freq) {
857 snd_es1968_bob_stop(chip);
858 chip->bob_freq = freq;
859 snd_es1968_bob_start(chip);
860 }
861}
862
863
864static void snd_es1968_bob_dec(struct es1968 *chip)
865{
866 chip->bobclient--;
867 if (chip->bobclient <= 0)
868 snd_es1968_bob_stop(chip);
869 else if (chip->bob_freq > ESM_BOB_FREQ) {
870
871 int max_freq = ESM_BOB_FREQ;
872 struct esschan *es;
873 list_for_each_entry(es, &chip->substream_list, list) {
874 if (max_freq < es->bob_freq)
875 max_freq = es->bob_freq;
876 }
877 if (max_freq != chip->bob_freq) {
878 snd_es1968_bob_stop(chip);
879 chip->bob_freq = max_freq;
880 snd_es1968_bob_start(chip);
881 }
882 }
883}
884
885static int
886snd_es1968_calc_bob_rate(struct es1968 *chip, struct esschan *es,
887 struct snd_pcm_runtime *runtime)
888{
889
890 int freq = runtime->rate * 4;
891 if (es->fmt & ESS_FMT_STEREO)
892 freq <<= 1;
893 if (es->fmt & ESS_FMT_16BIT)
894 freq <<= 1;
895 freq /= es->frag_size;
896 if (freq < ESM_BOB_FREQ)
897 freq = ESM_BOB_FREQ;
898 else if (freq > ESM_BOB_FREQ_MAX)
899 freq = ESM_BOB_FREQ_MAX;
900 return freq;
901}
902
903
904
905
906
907
908static u32 snd_es1968_compute_rate(struct es1968 *chip, u32 freq)
909{
910 u32 rate = (freq << 16) / chip->clock;
911#if 0
912 if (rate > 0x10000)
913 rate = 0x10000;
914#endif
915 return rate;
916}
917
918
919static inline unsigned int
920snd_es1968_get_dma_ptr(struct es1968 *chip, struct esschan *es)
921{
922 unsigned int offset;
923
924 offset = apu_get_register(chip, es->apu[0], 5);
925
926 offset -= es->base[0];
927
928 return (offset & 0xFFFE);
929}
930
931static void snd_es1968_apu_set_freq(struct es1968 *chip, int apu, int freq)
932{
933 apu_set_register(chip, apu, 2,
934 (apu_get_register(chip, apu, 2) & 0x00FF) |
935 ((freq & 0xff) << 8) | 0x10);
936 apu_set_register(chip, apu, 3, freq >> 8);
937}
938
939
940static inline void snd_es1968_trigger_apu(struct es1968 *esm, int apu, int mode)
941{
942
943 __apu_set_register(esm, apu, 0,
944 (__apu_get_register(esm, apu, 0) & 0xff0f) |
945 (mode << 4));
946}
947
948static void snd_es1968_pcm_start(struct es1968 *chip, struct esschan *es)
949{
950 spin_lock(&chip->reg_lock);
951 __apu_set_register(chip, es->apu[0], 5, es->base[0]);
952 snd_es1968_trigger_apu(chip, es->apu[0], es->apu_mode[0]);
953 if (es->mode == ESM_MODE_CAPTURE) {
954 __apu_set_register(chip, es->apu[2], 5, es->base[2]);
955 snd_es1968_trigger_apu(chip, es->apu[2], es->apu_mode[2]);
956 }
957 if (es->fmt & ESS_FMT_STEREO) {
958 __apu_set_register(chip, es->apu[1], 5, es->base[1]);
959 snd_es1968_trigger_apu(chip, es->apu[1], es->apu_mode[1]);
960 if (es->mode == ESM_MODE_CAPTURE) {
961 __apu_set_register(chip, es->apu[3], 5, es->base[3]);
962 snd_es1968_trigger_apu(chip, es->apu[3], es->apu_mode[3]);
963 }
964 }
965 spin_unlock(&chip->reg_lock);
966}
967
968static void snd_es1968_pcm_stop(struct es1968 *chip, struct esschan *es)
969{
970 spin_lock(&chip->reg_lock);
971 snd_es1968_trigger_apu(chip, es->apu[0], 0);
972 snd_es1968_trigger_apu(chip, es->apu[1], 0);
973 if (es->mode == ESM_MODE_CAPTURE) {
974 snd_es1968_trigger_apu(chip, es->apu[2], 0);
975 snd_es1968_trigger_apu(chip, es->apu[3], 0);
976 }
977 spin_unlock(&chip->reg_lock);
978}
979
980
981static void snd_es1968_program_wavecache(struct es1968 *chip, struct esschan *es,
982 int channel, u32 addr, int capture)
983{
984 u32 tmpval = (addr - 0x10) & 0xFFF8;
985
986 if (! capture) {
987 if (!(es->fmt & ESS_FMT_16BIT))
988 tmpval |= 4;
989 if (es->fmt & ESS_FMT_STEREO)
990 tmpval |= 2;
991 }
992
993
994 wave_set_register(chip, es->apu[channel] << 3, tmpval);
995
996#ifdef CONFIG_PM_SLEEP
997 es->wc_map[channel] = tmpval;
998#endif
999}
1000
1001
1002static void snd_es1968_playback_setup(struct es1968 *chip, struct esschan *es,
1003 struct snd_pcm_runtime *runtime)
1004{
1005 u32 pa;
1006 int high_apu = 0;
1007 int channel, apu;
1008 int i, size;
1009 unsigned long flags;
1010 u32 freq;
1011
1012 size = es->dma_size >> es->wav_shift;
1013
1014 if (es->fmt & ESS_FMT_STEREO)
1015 high_apu++;
1016
1017 for (channel = 0; channel <= high_apu; channel++) {
1018 apu = es->apu[channel];
1019
1020 snd_es1968_program_wavecache(chip, es, channel, es->memory->buf.addr, 0);
1021
1022
1023 pa = es->memory->buf.addr;
1024 pa -= chip->dma.addr;
1025 pa >>= 1;
1026
1027 pa |= 0x00400000;
1028
1029 if (es->fmt & ESS_FMT_STEREO) {
1030
1031 if (channel)
1032 pa |= 0x00800000;
1033 if (es->fmt & ESS_FMT_16BIT)
1034 pa >>= 1;
1035 }
1036
1037
1038
1039 es->base[channel] = pa & 0xFFFF;
1040
1041 for (i = 0; i < 16; i++)
1042 apu_set_register(chip, apu, i, 0x0000);
1043
1044
1045 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xFF) << 8);
1046 apu_set_register(chip, apu, 5, pa & 0xFFFF);
1047 apu_set_register(chip, apu, 6, (pa + size) & 0xFFFF);
1048
1049 apu_set_register(chip, apu, 7, size);
1050
1051
1052 apu_set_register(chip, apu, 8, 0x0000);
1053
1054 apu_set_register(chip, apu, 9, 0xD000);
1055
1056
1057 apu_set_register(chip, apu, 11, 0x0000);
1058
1059 apu_set_register(chip, apu, 0, 0x400F);
1060
1061 if (es->fmt & ESS_FMT_16BIT)
1062 es->apu_mode[channel] = ESM_APU_16BITLINEAR;
1063 else
1064 es->apu_mode[channel] = ESM_APU_8BITLINEAR;
1065
1066 if (es->fmt & ESS_FMT_STEREO) {
1067
1068
1069
1070
1071
1072 apu_set_register(chip, apu, 10,
1073 0x8F00 | (channel ? 0 : 0x10));
1074 es->apu_mode[channel] += 1;
1075 } else
1076 apu_set_register(chip, apu, 10, 0x8F08);
1077 }
1078
1079 spin_lock_irqsave(&chip->reg_lock, flags);
1080
1081 outw(1, chip->io_port + 0x04);
1082
1083 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ);
1084 spin_unlock_irqrestore(&chip->reg_lock, flags);
1085
1086 freq = runtime->rate;
1087
1088 if (freq > 48000)
1089 freq = 48000;
1090 if (freq < 4000)
1091 freq = 4000;
1092
1093
1094 if (!(es->fmt & ESS_FMT_16BIT) && !(es->fmt & ESS_FMT_STEREO))
1095 freq >>= 1;
1096
1097 freq = snd_es1968_compute_rate(chip, freq);
1098
1099
1100 snd_es1968_apu_set_freq(chip, es->apu[0], freq);
1101 snd_es1968_apu_set_freq(chip, es->apu[1], freq);
1102}
1103
1104
1105static void init_capture_apu(struct es1968 *chip, struct esschan *es, int channel,
1106 unsigned int pa, unsigned int bsize,
1107 int mode, int route)
1108{
1109 int i, apu = es->apu[channel];
1110
1111 es->apu_mode[channel] = mode;
1112
1113
1114 snd_es1968_program_wavecache(chip, es, channel, pa, 1);
1115
1116
1117 pa -= chip->dma.addr;
1118 pa >>= 1;
1119
1120
1121
1122 es->base[channel] = pa & 0xFFFF;
1123 pa |= 0x00400000;
1124
1125
1126 for (i = 0; i < 16; i++)
1127 apu_set_register(chip, apu, i, 0x0000);
1128
1129
1130
1131 apu_set_register(chip, apu, 2, 0x8);
1132
1133
1134 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xFF) << 8);
1135 apu_set_register(chip, apu, 5, pa & 0xFFFF);
1136 apu_set_register(chip, apu, 6, (pa + bsize) & 0xFFFF);
1137 apu_set_register(chip, apu, 7, bsize);
1138
1139 apu_set_register(chip, apu, 8, 0x00F0);
1140
1141 apu_set_register(chip, apu, 9, 0x0000);
1142
1143 apu_set_register(chip, apu, 10, 0x8F08);
1144
1145 apu_set_register(chip, apu, 11, route);
1146
1147 apu_set_register(chip, apu, 0, 0x400F);
1148}
1149
1150static void snd_es1968_capture_setup(struct es1968 *chip, struct esschan *es,
1151 struct snd_pcm_runtime *runtime)
1152{
1153 int size;
1154 u32 freq;
1155 unsigned long flags;
1156
1157 size = es->dma_size >> es->wav_shift;
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171 init_capture_apu(chip, es, 2,
1172 es->mixbuf->buf.addr, ESM_MIXBUF_SIZE/4,
1173 ESM_APU_INPUTMIXER, 0x14);
1174
1175 init_capture_apu(chip, es, 0, es->memory->buf.addr, size,
1176 ESM_APU_SRCONVERTOR, es->apu[2]);
1177 if (es->fmt & ESS_FMT_STEREO) {
1178
1179 init_capture_apu(chip, es, 3,
1180 es->mixbuf->buf.addr + ESM_MIXBUF_SIZE/2,
1181 ESM_MIXBUF_SIZE/4,
1182 ESM_APU_INPUTMIXER, 0x15);
1183
1184 init_capture_apu(chip, es, 1,
1185 es->memory->buf.addr + size*2, size,
1186 ESM_APU_SRCONVERTOR, es->apu[3]);
1187 }
1188
1189 freq = runtime->rate;
1190
1191 if (freq > 47999)
1192 freq = 47999;
1193 if (freq < 4000)
1194 freq = 4000;
1195
1196 freq = snd_es1968_compute_rate(chip, freq);
1197
1198
1199 snd_es1968_apu_set_freq(chip, es->apu[0], freq);
1200 snd_es1968_apu_set_freq(chip, es->apu[1], freq);
1201
1202
1203 freq = 0x10000;
1204 snd_es1968_apu_set_freq(chip, es->apu[2], freq);
1205 snd_es1968_apu_set_freq(chip, es->apu[3], freq);
1206
1207 spin_lock_irqsave(&chip->reg_lock, flags);
1208
1209 outw(1, chip->io_port + 0x04);
1210
1211 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ);
1212 spin_unlock_irqrestore(&chip->reg_lock, flags);
1213}
1214
1215
1216
1217
1218
1219static int snd_es1968_pcm_prepare(struct snd_pcm_substream *substream)
1220{
1221 struct es1968 *chip = snd_pcm_substream_chip(substream);
1222 struct snd_pcm_runtime *runtime = substream->runtime;
1223 struct esschan *es = runtime->private_data;
1224
1225 es->dma_size = snd_pcm_lib_buffer_bytes(substream);
1226 es->frag_size = snd_pcm_lib_period_bytes(substream);
1227
1228 es->wav_shift = 1;
1229 es->fmt = 0;
1230 if (snd_pcm_format_width(runtime->format) == 16)
1231 es->fmt |= ESS_FMT_16BIT;
1232 if (runtime->channels > 1) {
1233 es->fmt |= ESS_FMT_STEREO;
1234 if (es->fmt & ESS_FMT_16BIT)
1235 es->wav_shift++;
1236 }
1237 es->bob_freq = snd_es1968_calc_bob_rate(chip, es, runtime);
1238
1239 switch (es->mode) {
1240 case ESM_MODE_PLAY:
1241 snd_es1968_playback_setup(chip, es, runtime);
1242 break;
1243 case ESM_MODE_CAPTURE:
1244 snd_es1968_capture_setup(chip, es, runtime);
1245 break;
1246 }
1247
1248 return 0;
1249}
1250
1251static int snd_es1968_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
1252{
1253 struct es1968 *chip = snd_pcm_substream_chip(substream);
1254 struct esschan *es = substream->runtime->private_data;
1255
1256 spin_lock(&chip->substream_lock);
1257 switch (cmd) {
1258 case SNDRV_PCM_TRIGGER_START:
1259 case SNDRV_PCM_TRIGGER_RESUME:
1260 if (es->running)
1261 break;
1262 snd_es1968_bob_inc(chip, es->bob_freq);
1263 es->count = 0;
1264 es->hwptr = 0;
1265 snd_es1968_pcm_start(chip, es);
1266 es->running = 1;
1267 break;
1268 case SNDRV_PCM_TRIGGER_STOP:
1269 case SNDRV_PCM_TRIGGER_SUSPEND:
1270 if (! es->running)
1271 break;
1272 snd_es1968_pcm_stop(chip, es);
1273 es->running = 0;
1274 snd_es1968_bob_dec(chip);
1275 break;
1276 }
1277 spin_unlock(&chip->substream_lock);
1278 return 0;
1279}
1280
1281static snd_pcm_uframes_t snd_es1968_pcm_pointer(struct snd_pcm_substream *substream)
1282{
1283 struct es1968 *chip = snd_pcm_substream_chip(substream);
1284 struct esschan *es = substream->runtime->private_data;
1285 unsigned int ptr;
1286
1287 ptr = snd_es1968_get_dma_ptr(chip, es) << es->wav_shift;
1288
1289 return bytes_to_frames(substream->runtime, ptr % es->dma_size);
1290}
1291
1292static struct snd_pcm_hardware snd_es1968_playback = {
1293 .info = (SNDRV_PCM_INFO_MMAP |
1294 SNDRV_PCM_INFO_MMAP_VALID |
1295 SNDRV_PCM_INFO_INTERLEAVED |
1296 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1297
1298 SNDRV_PCM_INFO_RESUME),
1299 .formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE,
1300 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
1301 .rate_min = 4000,
1302 .rate_max = 48000,
1303 .channels_min = 1,
1304 .channels_max = 2,
1305 .buffer_bytes_max = 65536,
1306 .period_bytes_min = 256,
1307 .period_bytes_max = 65536,
1308 .periods_min = 1,
1309 .periods_max = 1024,
1310 .fifo_size = 0,
1311};
1312
1313static struct snd_pcm_hardware snd_es1968_capture = {
1314 .info = (SNDRV_PCM_INFO_NONINTERLEAVED |
1315 SNDRV_PCM_INFO_MMAP |
1316 SNDRV_PCM_INFO_MMAP_VALID |
1317 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1318
1319 SNDRV_PCM_INFO_RESUME),
1320 .formats = SNDRV_PCM_FMTBIT_S16_LE,
1321 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
1322 .rate_min = 4000,
1323 .rate_max = 48000,
1324 .channels_min = 1,
1325 .channels_max = 2,
1326 .buffer_bytes_max = 65536,
1327 .period_bytes_min = 256,
1328 .period_bytes_max = 65536,
1329 .periods_min = 1,
1330 .periods_max = 1024,
1331 .fifo_size = 0,
1332};
1333
1334
1335
1336
1337
1338
1339
1340
1341static int calc_available_memory_size(struct es1968 *chip)
1342{
1343 int max_size = 0;
1344 struct esm_memory *buf;
1345
1346 mutex_lock(&chip->memory_mutex);
1347 list_for_each_entry(buf, &chip->buf_list, list) {
1348 if (buf->empty && buf->buf.bytes > max_size)
1349 max_size = buf->buf.bytes;
1350 }
1351 mutex_unlock(&chip->memory_mutex);
1352 if (max_size >= 128*1024)
1353 max_size = 127*1024;
1354 return max_size;
1355}
1356
1357
1358static struct esm_memory *snd_es1968_new_memory(struct es1968 *chip, int size)
1359{
1360 struct esm_memory *buf;
1361
1362 size = ALIGN(size, ESM_MEM_ALIGN);
1363 mutex_lock(&chip->memory_mutex);
1364 list_for_each_entry(buf, &chip->buf_list, list) {
1365 if (buf->empty && buf->buf.bytes >= size)
1366 goto __found;
1367 }
1368 mutex_unlock(&chip->memory_mutex);
1369 return NULL;
1370
1371__found:
1372 if (buf->buf.bytes > size) {
1373 struct esm_memory *chunk = kmalloc(sizeof(*chunk), GFP_KERNEL);
1374 if (chunk == NULL) {
1375 mutex_unlock(&chip->memory_mutex);
1376 return NULL;
1377 }
1378 chunk->buf = buf->buf;
1379 chunk->buf.bytes -= size;
1380 chunk->buf.area += size;
1381 chunk->buf.addr += size;
1382 chunk->empty = 1;
1383 buf->buf.bytes = size;
1384 list_add(&chunk->list, &buf->list);
1385 }
1386 buf->empty = 0;
1387 mutex_unlock(&chip->memory_mutex);
1388 return buf;
1389}
1390
1391
1392static void snd_es1968_free_memory(struct es1968 *chip, struct esm_memory *buf)
1393{
1394 struct esm_memory *chunk;
1395
1396 mutex_lock(&chip->memory_mutex);
1397 buf->empty = 1;
1398 if (buf->list.prev != &chip->buf_list) {
1399 chunk = list_entry(buf->list.prev, struct esm_memory, list);
1400 if (chunk->empty) {
1401 chunk->buf.bytes += buf->buf.bytes;
1402 list_del(&buf->list);
1403 kfree(buf);
1404 buf = chunk;
1405 }
1406 }
1407 if (buf->list.next != &chip->buf_list) {
1408 chunk = list_entry(buf->list.next, struct esm_memory, list);
1409 if (chunk->empty) {
1410 buf->buf.bytes += chunk->buf.bytes;
1411 list_del(&chunk->list);
1412 kfree(chunk);
1413 }
1414 }
1415 mutex_unlock(&chip->memory_mutex);
1416}
1417
1418static void snd_es1968_free_dmabuf(struct es1968 *chip)
1419{
1420 struct list_head *p;
1421
1422 if (! chip->dma.area)
1423 return;
1424 snd_dma_reserve_buf(&chip->dma, snd_dma_pci_buf_id(chip->pci));
1425 while ((p = chip->buf_list.next) != &chip->buf_list) {
1426 struct esm_memory *chunk = list_entry(p, struct esm_memory, list);
1427 list_del(p);
1428 kfree(chunk);
1429 }
1430}
1431
1432static int __devinit
1433snd_es1968_init_dmabuf(struct es1968 *chip)
1434{
1435 int err;
1436 struct esm_memory *chunk;
1437
1438 chip->dma.dev.type = SNDRV_DMA_TYPE_DEV;
1439 chip->dma.dev.dev = snd_dma_pci_data(chip->pci);
1440 if (! snd_dma_get_reserved_buf(&chip->dma, snd_dma_pci_buf_id(chip->pci))) {
1441 err = snd_dma_alloc_pages_fallback(SNDRV_DMA_TYPE_DEV,
1442 snd_dma_pci_data(chip->pci),
1443 chip->total_bufsize, &chip->dma);
1444 if (err < 0 || ! chip->dma.area) {
1445 snd_printk(KERN_ERR "es1968: can't allocate dma pages for size %d\n",
1446 chip->total_bufsize);
1447 return -ENOMEM;
1448 }
1449 if ((chip->dma.addr + chip->dma.bytes - 1) & ~((1 << 28) - 1)) {
1450 snd_dma_free_pages(&chip->dma);
1451 snd_printk(KERN_ERR "es1968: DMA buffer beyond 256MB.\n");
1452 return -ENOMEM;
1453 }
1454 }
1455
1456 INIT_LIST_HEAD(&chip->buf_list);
1457
1458 chunk = kmalloc(sizeof(*chunk), GFP_KERNEL);
1459 if (chunk == NULL) {
1460 snd_es1968_free_dmabuf(chip);
1461 return -ENOMEM;
1462 }
1463 memset(chip->dma.area, 0, ESM_MEM_ALIGN);
1464 chunk->buf = chip->dma;
1465 chunk->buf.area += ESM_MEM_ALIGN;
1466 chunk->buf.addr += ESM_MEM_ALIGN;
1467 chunk->buf.bytes -= ESM_MEM_ALIGN;
1468 chunk->empty = 1;
1469 list_add(&chunk->list, &chip->buf_list);
1470
1471 return 0;
1472}
1473
1474
1475
1476static int snd_es1968_hw_params(struct snd_pcm_substream *substream,
1477 struct snd_pcm_hw_params *hw_params)
1478{
1479 struct es1968 *chip = snd_pcm_substream_chip(substream);
1480 struct snd_pcm_runtime *runtime = substream->runtime;
1481 struct esschan *chan = runtime->private_data;
1482 int size = params_buffer_bytes(hw_params);
1483
1484 if (chan->memory) {
1485 if (chan->memory->buf.bytes >= size) {
1486 runtime->dma_bytes = size;
1487 return 0;
1488 }
1489 snd_es1968_free_memory(chip, chan->memory);
1490 }
1491 chan->memory = snd_es1968_new_memory(chip, size);
1492 if (chan->memory == NULL) {
1493
1494 return -ENOMEM;
1495 }
1496 snd_pcm_set_runtime_buffer(substream, &chan->memory->buf);
1497 return 1;
1498}
1499
1500
1501static int snd_es1968_hw_free(struct snd_pcm_substream *substream)
1502{
1503 struct es1968 *chip = snd_pcm_substream_chip(substream);
1504 struct snd_pcm_runtime *runtime = substream->runtime;
1505 struct esschan *chan;
1506
1507 if (runtime->private_data == NULL)
1508 return 0;
1509 chan = runtime->private_data;
1510 if (chan->memory) {
1511 snd_es1968_free_memory(chip, chan->memory);
1512 chan->memory = NULL;
1513 }
1514 return 0;
1515}
1516
1517
1518
1519
1520
1521static int snd_es1968_alloc_apu_pair(struct es1968 *chip, int type)
1522{
1523 int apu;
1524
1525 for (apu = 0; apu < NR_APUS; apu += 2) {
1526 if (chip->apu[apu] == ESM_APU_FREE &&
1527 chip->apu[apu + 1] == ESM_APU_FREE) {
1528 chip->apu[apu] = chip->apu[apu + 1] = type;
1529 return apu;
1530 }
1531 }
1532 return -EBUSY;
1533}
1534
1535
1536
1537
1538static void snd_es1968_free_apu_pair(struct es1968 *chip, int apu)
1539{
1540 chip->apu[apu] = chip->apu[apu + 1] = ESM_APU_FREE;
1541}
1542
1543
1544
1545
1546
1547
1548static int snd_es1968_playback_open(struct snd_pcm_substream *substream)
1549{
1550 struct es1968 *chip = snd_pcm_substream_chip(substream);
1551 struct snd_pcm_runtime *runtime = substream->runtime;
1552 struct esschan *es;
1553 int apu1;
1554
1555
1556 apu1 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_PLAY);
1557 if (apu1 < 0)
1558 return apu1;
1559
1560 es = kzalloc(sizeof(*es), GFP_KERNEL);
1561 if (!es) {
1562 snd_es1968_free_apu_pair(chip, apu1);
1563 return -ENOMEM;
1564 }
1565
1566 es->apu[0] = apu1;
1567 es->apu[1] = apu1 + 1;
1568 es->apu_mode[0] = 0;
1569 es->apu_mode[1] = 0;
1570 es->running = 0;
1571 es->substream = substream;
1572 es->mode = ESM_MODE_PLAY;
1573
1574 runtime->private_data = es;
1575 runtime->hw = snd_es1968_playback;
1576 runtime->hw.buffer_bytes_max = runtime->hw.period_bytes_max =
1577 calc_available_memory_size(chip);
1578
1579 spin_lock_irq(&chip->substream_lock);
1580 list_add(&es->list, &chip->substream_list);
1581 spin_unlock_irq(&chip->substream_lock);
1582
1583 return 0;
1584}
1585
1586static int snd_es1968_capture_open(struct snd_pcm_substream *substream)
1587{
1588 struct snd_pcm_runtime *runtime = substream->runtime;
1589 struct es1968 *chip = snd_pcm_substream_chip(substream);
1590 struct esschan *es;
1591 int apu1, apu2;
1592
1593 apu1 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_CAPTURE);
1594 if (apu1 < 0)
1595 return apu1;
1596 apu2 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_RATECONV);
1597 if (apu2 < 0) {
1598 snd_es1968_free_apu_pair(chip, apu1);
1599 return apu2;
1600 }
1601
1602 es = kzalloc(sizeof(*es), GFP_KERNEL);
1603 if (!es) {
1604 snd_es1968_free_apu_pair(chip, apu1);
1605 snd_es1968_free_apu_pair(chip, apu2);
1606 return -ENOMEM;
1607 }
1608
1609 es->apu[0] = apu1;
1610 es->apu[1] = apu1 + 1;
1611 es->apu[2] = apu2;
1612 es->apu[3] = apu2 + 1;
1613 es->apu_mode[0] = 0;
1614 es->apu_mode[1] = 0;
1615 es->apu_mode[2] = 0;
1616 es->apu_mode[3] = 0;
1617 es->running = 0;
1618 es->substream = substream;
1619 es->mode = ESM_MODE_CAPTURE;
1620
1621
1622 if ((es->mixbuf = snd_es1968_new_memory(chip, ESM_MIXBUF_SIZE)) == NULL) {
1623 snd_es1968_free_apu_pair(chip, apu1);
1624 snd_es1968_free_apu_pair(chip, apu2);
1625 kfree(es);
1626 return -ENOMEM;
1627 }
1628 memset(es->mixbuf->buf.area, 0, ESM_MIXBUF_SIZE);
1629
1630 runtime->private_data = es;
1631 runtime->hw = snd_es1968_capture;
1632 runtime->hw.buffer_bytes_max = runtime->hw.period_bytes_max =
1633 calc_available_memory_size(chip) - 1024;
1634 snd_pcm_hw_constraint_pow2(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
1635
1636 spin_lock_irq(&chip->substream_lock);
1637 list_add(&es->list, &chip->substream_list);
1638 spin_unlock_irq(&chip->substream_lock);
1639
1640 return 0;
1641}
1642
1643static int snd_es1968_playback_close(struct snd_pcm_substream *substream)
1644{
1645 struct es1968 *chip = snd_pcm_substream_chip(substream);
1646 struct esschan *es;
1647
1648 if (substream->runtime->private_data == NULL)
1649 return 0;
1650 es = substream->runtime->private_data;
1651 spin_lock_irq(&chip->substream_lock);
1652 list_del(&es->list);
1653 spin_unlock_irq(&chip->substream_lock);
1654 snd_es1968_free_apu_pair(chip, es->apu[0]);
1655 kfree(es);
1656
1657 return 0;
1658}
1659
1660static int snd_es1968_capture_close(struct snd_pcm_substream *substream)
1661{
1662 struct es1968 *chip = snd_pcm_substream_chip(substream);
1663 struct esschan *es;
1664
1665 if (substream->runtime->private_data == NULL)
1666 return 0;
1667 es = substream->runtime->private_data;
1668 spin_lock_irq(&chip->substream_lock);
1669 list_del(&es->list);
1670 spin_unlock_irq(&chip->substream_lock);
1671 snd_es1968_free_memory(chip, es->mixbuf);
1672 snd_es1968_free_apu_pair(chip, es->apu[0]);
1673 snd_es1968_free_apu_pair(chip, es->apu[2]);
1674 kfree(es);
1675
1676 return 0;
1677}
1678
1679static struct snd_pcm_ops snd_es1968_playback_ops = {
1680 .open = snd_es1968_playback_open,
1681 .close = snd_es1968_playback_close,
1682 .ioctl = snd_pcm_lib_ioctl,
1683 .hw_params = snd_es1968_hw_params,
1684 .hw_free = snd_es1968_hw_free,
1685 .prepare = snd_es1968_pcm_prepare,
1686 .trigger = snd_es1968_pcm_trigger,
1687 .pointer = snd_es1968_pcm_pointer,
1688};
1689
1690static struct snd_pcm_ops snd_es1968_capture_ops = {
1691 .open = snd_es1968_capture_open,
1692 .close = snd_es1968_capture_close,
1693 .ioctl = snd_pcm_lib_ioctl,
1694 .hw_params = snd_es1968_hw_params,
1695 .hw_free = snd_es1968_hw_free,
1696 .prepare = snd_es1968_pcm_prepare,
1697 .trigger = snd_es1968_pcm_trigger,
1698 .pointer = snd_es1968_pcm_pointer,
1699};
1700
1701
1702
1703
1704
1705#define CLOCK_MEASURE_BUFSIZE 16768
1706
1707static void __devinit es1968_measure_clock(struct es1968 *chip)
1708{
1709 int i, apu;
1710 unsigned int pa, offset, t;
1711 struct esm_memory *memory;
1712 struct timeval start_time, stop_time;
1713
1714 if (chip->clock == 0)
1715 chip->clock = 48000;
1716
1717
1718 if ((apu = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_PLAY)) < 0) {
1719 snd_printk(KERN_ERR "Hmm, cannot find empty APU pair!?\n");
1720 return;
1721 }
1722 if ((memory = snd_es1968_new_memory(chip, CLOCK_MEASURE_BUFSIZE)) == NULL) {
1723 snd_printk(KERN_ERR "cannot allocate dma buffer - using default clock %d\n", chip->clock);
1724 snd_es1968_free_apu_pair(chip, apu);
1725 return;
1726 }
1727
1728 memset(memory->buf.area, 0, CLOCK_MEASURE_BUFSIZE);
1729
1730 wave_set_register(chip, apu << 3, (memory->buf.addr - 0x10) & 0xfff8);
1731
1732 pa = (unsigned int)((memory->buf.addr - chip->dma.addr) >> 1);
1733 pa |= 0x00400000;
1734
1735
1736 for (i = 0; i < 16; i++)
1737 apu_set_register(chip, apu, i, 0x0000);
1738
1739 apu_set_register(chip, apu, 0, 0x400f);
1740 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xff) << 8);
1741 apu_set_register(chip, apu, 5, pa & 0xffff);
1742 apu_set_register(chip, apu, 6, (pa + CLOCK_MEASURE_BUFSIZE/2) & 0xffff);
1743 apu_set_register(chip, apu, 7, CLOCK_MEASURE_BUFSIZE/2);
1744 apu_set_register(chip, apu, 8, 0x0000);
1745 apu_set_register(chip, apu, 9, 0xD000);
1746 apu_set_register(chip, apu, 10, 0x8F08);
1747 apu_set_register(chip, apu, 11, 0x0000);
1748 spin_lock_irq(&chip->reg_lock);
1749 outw(1, chip->io_port + 0x04);
1750 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ);
1751 spin_unlock_irq(&chip->reg_lock);
1752
1753 snd_es1968_apu_set_freq(chip, apu, ((unsigned int)48000 << 16) / chip->clock);
1754
1755 chip->in_measurement = 1;
1756 chip->measure_apu = apu;
1757 spin_lock_irq(&chip->reg_lock);
1758 snd_es1968_bob_inc(chip, ESM_BOB_FREQ);
1759 __apu_set_register(chip, apu, 5, pa & 0xffff);
1760 snd_es1968_trigger_apu(chip, apu, ESM_APU_16BITLINEAR);
1761 do_gettimeofday(&start_time);
1762 spin_unlock_irq(&chip->reg_lock);
1763 msleep(50);
1764 spin_lock_irq(&chip->reg_lock);
1765 offset = __apu_get_register(chip, apu, 5);
1766 do_gettimeofday(&stop_time);
1767 snd_es1968_trigger_apu(chip, apu, 0);
1768 snd_es1968_bob_dec(chip);
1769 chip->in_measurement = 0;
1770 spin_unlock_irq(&chip->reg_lock);
1771
1772
1773 offset -= (pa & 0xffff);
1774 offset &= 0xfffe;
1775 offset += chip->measure_count * (CLOCK_MEASURE_BUFSIZE/2);
1776
1777 t = stop_time.tv_sec - start_time.tv_sec;
1778 t *= 1000000;
1779 if (stop_time.tv_usec < start_time.tv_usec)
1780 t -= start_time.tv_usec - stop_time.tv_usec;
1781 else
1782 t += stop_time.tv_usec - start_time.tv_usec;
1783 if (t == 0) {
1784 snd_printk(KERN_ERR "?? calculation error..\n");
1785 } else {
1786 offset *= 1000;
1787 offset = (offset / t) * 1000 + ((offset % t) * 1000) / t;
1788 if (offset < 47500 || offset > 48500) {
1789 if (offset >= 40000 && offset <= 50000)
1790 chip->clock = (chip->clock * offset) / 48000;
1791 }
1792 printk(KERN_INFO "es1968: clocking to %d\n", chip->clock);
1793 }
1794 snd_es1968_free_memory(chip, memory);
1795 snd_es1968_free_apu_pair(chip, apu);
1796}
1797
1798
1799
1800
1801
1802static void snd_es1968_pcm_free(struct snd_pcm *pcm)
1803{
1804 struct es1968 *esm = pcm->private_data;
1805 snd_es1968_free_dmabuf(esm);
1806 esm->pcm = NULL;
1807}
1808
1809static int __devinit
1810snd_es1968_pcm(struct es1968 *chip, int device)
1811{
1812 struct snd_pcm *pcm;
1813 int err;
1814
1815
1816 if ((err = snd_es1968_init_dmabuf(chip)) < 0)
1817 return err;
1818
1819
1820 wave_set_register(chip, 0x01FC, chip->dma.addr >> 12);
1821 wave_set_register(chip, 0x01FD, chip->dma.addr >> 12);
1822 wave_set_register(chip, 0x01FE, chip->dma.addr >> 12);
1823 wave_set_register(chip, 0x01FF, chip->dma.addr >> 12);
1824
1825 if ((err = snd_pcm_new(chip->card, "ESS Maestro", device,
1826 chip->playback_streams,
1827 chip->capture_streams, &pcm)) < 0)
1828 return err;
1829
1830 pcm->private_data = chip;
1831 pcm->private_free = snd_es1968_pcm_free;
1832
1833 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_es1968_playback_ops);
1834 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_es1968_capture_ops);
1835
1836 pcm->info_flags = 0;
1837
1838 strcpy(pcm->name, "ESS Maestro");
1839
1840 chip->pcm = pcm;
1841
1842 return 0;
1843}
1844
1845
1846
1847static void snd_es1968_suppress_jitter(struct es1968 *chip, struct esschan *es)
1848{
1849 unsigned int cp1;
1850 unsigned int cp2;
1851 unsigned int diff;
1852
1853 cp1 = __apu_get_register(chip, 0, 5);
1854 cp2 = __apu_get_register(chip, 1, 5);
1855 diff = (cp1 > cp2 ? cp1 - cp2 : cp2 - cp1);
1856
1857 if (diff > 1)
1858 __maestro_write(chip, IDR0_DATA_PORT, cp1);
1859}
1860
1861
1862
1863
1864static void snd_es1968_update_pcm(struct es1968 *chip, struct esschan *es)
1865{
1866 unsigned int hwptr;
1867 unsigned int diff;
1868 struct snd_pcm_substream *subs = es->substream;
1869
1870 if (subs == NULL || !es->running)
1871 return;
1872
1873 hwptr = snd_es1968_get_dma_ptr(chip, es) << es->wav_shift;
1874 hwptr %= es->dma_size;
1875
1876 diff = (es->dma_size + hwptr - es->hwptr) % es->dma_size;
1877
1878 es->hwptr = hwptr;
1879 es->count += diff;
1880
1881 if (es->count > es->frag_size) {
1882 spin_unlock(&chip->substream_lock);
1883 snd_pcm_period_elapsed(subs);
1884 spin_lock(&chip->substream_lock);
1885 es->count %= es->frag_size;
1886 }
1887}
1888
1889
1890
1891
1892
1893static void es1968_update_hw_volume(struct work_struct *work)
1894{
1895 struct es1968 *chip = container_of(work, struct es1968, hwvol_work);
1896 int x, val;
1897
1898
1899
1900
1901 x = inb(chip->io_port + 0x1c) & 0xee;
1902
1903 outb(0x88, chip->io_port + 0x1c);
1904 outb(0x88, chip->io_port + 0x1d);
1905 outb(0x88, chip->io_port + 0x1e);
1906 outb(0x88, chip->io_port + 0x1f);
1907
1908 if (chip->in_suspend)
1909 return;
1910
1911#ifndef CONFIG_SND_ES1968_INPUT
1912 if (! chip->master_switch || ! chip->master_volume)
1913 return;
1914
1915 val = snd_ac97_read(chip->ac97, AC97_MASTER);
1916 switch (x) {
1917 case 0x88:
1918
1919 val ^= 0x8000;
1920 break;
1921 case 0xaa:
1922
1923 if ((val & 0x7f) > 0)
1924 val--;
1925 if ((val & 0x7f00) > 0)
1926 val -= 0x0100;
1927 break;
1928 case 0x66:
1929
1930 if ((val & 0x7f) < 0x1f)
1931 val++;
1932 if ((val & 0x7f00) < 0x1f00)
1933 val += 0x0100;
1934 break;
1935 }
1936 if (snd_ac97_update(chip->ac97, AC97_MASTER, val))
1937 snd_ctl_notify(chip->card, SNDRV_CTL_EVENT_MASK_VALUE,
1938 &chip->master_volume->id);
1939#else
1940 if (!chip->input_dev)
1941 return;
1942
1943 val = 0;
1944 switch (x) {
1945 case 0x88:
1946
1947
1948
1949 val = KEY_MUTE;
1950 break;
1951 case 0xaa:
1952
1953 val = KEY_VOLUMEUP;
1954 break;
1955 case 0x66:
1956
1957 val = KEY_VOLUMEDOWN;
1958 break;
1959 }
1960
1961 if (val) {
1962 input_report_key(chip->input_dev, val, 1);
1963 input_sync(chip->input_dev);
1964 input_report_key(chip->input_dev, val, 0);
1965 input_sync(chip->input_dev);
1966 }
1967#endif
1968}
1969
1970
1971
1972
1973static irqreturn_t snd_es1968_interrupt(int irq, void *dev_id)
1974{
1975 struct es1968 *chip = dev_id;
1976 u32 event;
1977
1978 if (!(event = inb(chip->io_port + 0x1A)))
1979 return IRQ_NONE;
1980
1981 outw(inw(chip->io_port + 4) & 1, chip->io_port + 4);
1982
1983 if (event & ESM_HWVOL_IRQ)
1984 schedule_work(&chip->hwvol_work);
1985
1986
1987 outb(0xFF, chip->io_port + 0x1A);
1988
1989 if ((event & ESM_MPU401_IRQ) && chip->rmidi) {
1990 snd_mpu401_uart_interrupt(irq, chip->rmidi->private_data);
1991 }
1992
1993 if (event & ESM_SOUND_IRQ) {
1994 struct esschan *es;
1995 spin_lock(&chip->substream_lock);
1996 list_for_each_entry(es, &chip->substream_list, list) {
1997 if (es->running) {
1998 snd_es1968_update_pcm(chip, es);
1999 if (es->fmt & ESS_FMT_STEREO)
2000 snd_es1968_suppress_jitter(chip, es);
2001 }
2002 }
2003 spin_unlock(&chip->substream_lock);
2004 if (chip->in_measurement) {
2005 unsigned int curp = __apu_get_register(chip, chip->measure_apu, 5);
2006 if (curp < chip->measure_lastpos)
2007 chip->measure_count++;
2008 chip->measure_lastpos = curp;
2009 }
2010 }
2011
2012 return IRQ_HANDLED;
2013}
2014
2015
2016
2017
2018
2019static int __devinit
2020snd_es1968_mixer(struct es1968 *chip)
2021{
2022 struct snd_ac97_bus *pbus;
2023 struct snd_ac97_template ac97;
2024#ifndef CONFIG_SND_ES1968_INPUT
2025 struct snd_ctl_elem_id elem_id;
2026#endif
2027 int err;
2028 static struct snd_ac97_bus_ops ops = {
2029 .write = snd_es1968_ac97_write,
2030 .read = snd_es1968_ac97_read,
2031 };
2032
2033 if ((err = snd_ac97_bus(chip->card, 0, &ops, NULL, &pbus)) < 0)
2034 return err;
2035 pbus->no_vra = 1;
2036
2037 memset(&ac97, 0, sizeof(ac97));
2038 ac97.private_data = chip;
2039 if ((err = snd_ac97_mixer(pbus, &ac97, &chip->ac97)) < 0)
2040 return err;
2041
2042#ifndef CONFIG_SND_ES1968_INPUT
2043
2044 memset(&elem_id, 0, sizeof(elem_id));
2045 elem_id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
2046 strcpy(elem_id.name, "Master Playback Switch");
2047 chip->master_switch = snd_ctl_find_id(chip->card, &elem_id);
2048 memset(&elem_id, 0, sizeof(elem_id));
2049 elem_id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
2050 strcpy(elem_id.name, "Master Playback Volume");
2051 chip->master_volume = snd_ctl_find_id(chip->card, &elem_id);
2052#endif
2053
2054 return 0;
2055}
2056
2057
2058
2059
2060
2061static void snd_es1968_ac97_reset(struct es1968 *chip)
2062{
2063 unsigned long ioaddr = chip->io_port;
2064
2065 unsigned short save_ringbus_a;
2066 unsigned short save_68;
2067 unsigned short w;
2068 unsigned int vend;
2069
2070
2071 save_ringbus_a = inw(ioaddr + 0x36);
2072
2073
2074
2075 outw(inw(ioaddr + 0x3a) & 0xfffc, ioaddr + 0x3a);
2076 outw(inw(ioaddr + 0x3c) & 0xfffc, ioaddr + 0x3c);
2077
2078
2079 outw(0x0000, ioaddr + 0x36);
2080 save_68 = inw(ioaddr + 0x68);
2081 pci_read_config_word(chip->pci, 0x58, &w);
2082 pci_read_config_dword(chip->pci, PCI_SUBSYSTEM_VENDOR_ID, &vend);
2083 if (w & 1)
2084 save_68 |= 0x10;
2085 outw(0xfffe, ioaddr + 0x64);
2086 outw(0x0001, ioaddr + 0x68);
2087 outw(0x0000, ioaddr + 0x60);
2088 udelay(20);
2089 outw(0x0001, ioaddr + 0x60);
2090 msleep(20);
2091
2092 outw(save_68 | 0x1, ioaddr + 0x68);
2093 outw((inw(ioaddr + 0x38) & 0xfffc) | 0x1, ioaddr + 0x38);
2094 outw((inw(ioaddr + 0x3a) & 0xfffc) | 0x1, ioaddr + 0x3a);
2095 outw((inw(ioaddr + 0x3c) & 0xfffc) | 0x1, ioaddr + 0x3c);
2096
2097
2098
2099 outw(0x0000, ioaddr + 0x36);
2100 outw(0xfff7, ioaddr + 0x64);
2101 save_68 = inw(ioaddr + 0x68);
2102 outw(0x0009, ioaddr + 0x68);
2103 outw(0x0001, ioaddr + 0x60);
2104 udelay(20);
2105 outw(0x0009, ioaddr + 0x60);
2106 msleep(500);
2107
2108 outw(inw(ioaddr + 0x3a) & 0xfffc, ioaddr + 0x3a);
2109 outw(inw(ioaddr + 0x3c) & 0xfffc, ioaddr + 0x3c);
2110
2111#if 0
2112 snd_printk(KERN_INFO "trying software reset\n");
2113
2114 outb(0x80 | 0x7c, ioaddr + 0x30);
2115 for (w = 0;; w++) {
2116 if ((inw(ioaddr + 0x30) & 1) == 0) {
2117 if (inb(ioaddr + 0x32) != 0)
2118 break;
2119
2120 outb(0x80 | 0x7d, ioaddr + 0x30);
2121 if (((inw(ioaddr + 0x30) & 1) == 0)
2122 && (inb(ioaddr + 0x32) != 0))
2123 break;
2124 outb(0x80 | 0x7f, ioaddr + 0x30);
2125 if (((inw(ioaddr + 0x30) & 1) == 0)
2126 && (inb(ioaddr + 0x32) != 0))
2127 break;
2128 }
2129
2130 if (w > 10000) {
2131 outb(inb(ioaddr + 0x37) | 0x08, ioaddr + 0x37);
2132 msleep(500);
2133 outb(inb(ioaddr + 0x37) & ~0x08,
2134 ioaddr + 0x37);
2135 udelay(1);
2136 outw(0x80, ioaddr + 0x30);
2137 for (w = 0; w < 10000; w++) {
2138 if ((inw(ioaddr + 0x30) & 1) == 0)
2139 break;
2140 }
2141 }
2142 }
2143#endif
2144 if (vend == NEC_VERSA_SUBID1 || vend == NEC_VERSA_SUBID2) {
2145
2146 outw(0xf9ff, ioaddr + 0x64);
2147 outw(inw(ioaddr + 0x68) | 0x600, ioaddr + 0x68);
2148 outw(0x0209, ioaddr + 0x60);
2149 }
2150
2151
2152 outw(save_ringbus_a, ioaddr + 0x36);
2153
2154
2155
2156
2157 outb(inb(ioaddr+0xc0)|(1<<5), ioaddr+0xc0);
2158 outb(0xff, ioaddr+0xc3);
2159 outb(0xff, ioaddr+0xc4);
2160 outb(0xff, ioaddr+0xc6);
2161 outb(0xff, ioaddr+0xc8);
2162 outb(0x3f, ioaddr+0xcf);
2163 outb(0x3f, ioaddr+0xd0);
2164}
2165
2166static void snd_es1968_reset(struct es1968 *chip)
2167{
2168
2169 outw(ESM_RESET_MAESTRO | ESM_RESET_DIRECTSOUND,
2170 chip->io_port + ESM_PORT_HOST_IRQ);
2171 udelay(10);
2172 outw(0x0000, chip->io_port + ESM_PORT_HOST_IRQ);
2173 udelay(10);
2174}
2175
2176
2177
2178
2179static void snd_es1968_chip_init(struct es1968 *chip)
2180{
2181 struct pci_dev *pci = chip->pci;
2182 int i;
2183 unsigned long iobase = chip->io_port;
2184 u16 w;
2185 u32 n;
2186
2187
2188
2189
2190
2191
2192
2193
2194
2195
2196
2197
2198
2199 pci_read_config_word(pci, ESM_CONFIG_A, &w);
2200
2201 w &= ~DMA_CLEAR;
2202 w &= ~(PIC_SNOOP1 | PIC_SNOOP2);
2203 w &= ~SAFEGUARD;
2204 w |= POST_WRITE;
2205 w |= PCI_TIMING;
2206
2207 w &= ~SWAP_LR;
2208
2209
2210 w &= ~SUBTR_DECODE;
2211
2212 pci_write_config_word(pci, ESM_CONFIG_A, w);
2213
2214
2215
2216 pci_read_config_word(pci, ESM_CONFIG_B, &w);
2217
2218 w &= ~(1 << 15);
2219
2220 w &= ~(1 << 14);
2221
2222 w &= ~SPDIF_CONFB;
2223 w |= HWV_CONFB;
2224 w |= DEBOUNCE;
2225 w &= ~GPIO_CONFB;
2226 w |= CHI_CONFB;
2227 w &= ~IDMA_CONFB;
2228 w &= ~MIDI_FIX;
2229 w &= ~(1 << 1);
2230 w &= ~IRQ_TO_ISA;
2231
2232 pci_write_config_word(pci, ESM_CONFIG_B, w);
2233
2234
2235
2236 pci_read_config_word(pci, ESM_DDMA, &w);
2237 w &= ~(1 << 0);
2238 pci_write_config_word(pci, ESM_DDMA, w);
2239
2240
2241
2242
2243
2244 pci_read_config_word(pci, ESM_LEGACY_AUDIO_CONTROL, &w);
2245
2246 w |= ESS_DISABLE_AUDIO;
2247 w &= ~ESS_ENABLE_SERIAL_IRQ;
2248 w &= ~(0x1f);
2249
2250 pci_write_config_word(pci, ESM_LEGACY_AUDIO_CONTROL, w);
2251
2252
2253 pci_read_config_word(pci, 0x58, &w);
2254 w|=1<<2;
2255 w|=1<<3;
2256 w&=~(1<<11);
2257 pci_write_config_word(pci, 0x58, w);
2258
2259
2260
2261 snd_es1968_reset(chip);
2262
2263
2264
2265
2266
2267
2268 outw(0xC090, iobase + ESM_RING_BUS_DEST);
2269 udelay(20);
2270 outw(0x3000, iobase + ESM_RING_BUS_CONTR_A);
2271 udelay(20);
2272
2273
2274
2275
2276
2277 snd_es1968_ac97_reset(chip);
2278
2279
2280
2281 n = inl(iobase + ESM_RING_BUS_CONTR_B);
2282 n &= ~RINGB_EN_SPDIF;
2283
2284 outl(n, iobase + ESM_RING_BUS_CONTR_B);
2285
2286
2287
2288 outb(0x88, iobase+0x1c);
2289 outb(0x88, iobase+0x1d);
2290 outb(0x88, iobase+0x1e);
2291 outb(0x88, iobase+0x1f);
2292
2293
2294
2295
2296 outb(0, iobase + ASSP_CONTROL_B);
2297 outb(3, iobase + ASSP_CONTROL_A);
2298 outb(0, iobase + ASSP_CONTROL_C);
2299
2300
2301
2302
2303 for (i = 0; i < 16; i++) {
2304
2305 outw(0x01E0 + i, iobase + WC_INDEX);
2306 outw(0x0000, iobase + WC_DATA);
2307
2308
2309
2310 outw(0x01D0 + i, iobase + WC_INDEX);
2311 outw(0x0000, iobase + WC_DATA);
2312 }
2313 wave_set_register(chip, IDR7_WAVE_ROMRAM,
2314 (wave_get_register(chip, IDR7_WAVE_ROMRAM) & 0xFF00));
2315 wave_set_register(chip, IDR7_WAVE_ROMRAM,
2316 wave_get_register(chip, IDR7_WAVE_ROMRAM) | 0x100);
2317 wave_set_register(chip, IDR7_WAVE_ROMRAM,
2318 wave_get_register(chip, IDR7_WAVE_ROMRAM) & ~0x200);
2319 wave_set_register(chip, IDR7_WAVE_ROMRAM,
2320 wave_get_register(chip, IDR7_WAVE_ROMRAM) | ~0x400);
2321
2322
2323 maestro_write(chip, IDR2_CRAM_DATA, 0x0000);
2324
2325
2326 maestro_write(chip, 0x08, 0xB004);
2327 maestro_write(chip, 0x09, 0x001B);
2328 maestro_write(chip, 0x0A, 0x8000);
2329 maestro_write(chip, 0x0B, 0x3F37);
2330 maestro_write(chip, 0x0C, 0x0098);
2331
2332
2333 maestro_write(chip, 0x0C,
2334 (maestro_read(chip, 0x0C) & ~0xF000) | 0x8000);
2335
2336 maestro_write(chip, 0x0C,
2337 (maestro_read(chip, 0x0C) & ~0x0F00) | 0x0500);
2338
2339 maestro_write(chip, 0x0D, 0x7632);
2340
2341
2342
2343
2344 w = inw(iobase + WC_CONTROL);
2345
2346 w &= ~0xFA00;
2347 w |= 0xA000;
2348 w &= ~0x0200;
2349
2350 w |= 0x0100;
2351 w |= 0x0080;
2352 w &= ~0x0060;
2353 w |= 0x0020;
2354
2355 w &= ~0x000C;
2356
2357 w &= ~0x0001;
2358
2359 outw(w, iobase + WC_CONTROL);
2360
2361
2362 for (i = 0; i < NR_APUS; i++) {
2363 for (w = 0; w < NR_APU_REGS; w++)
2364 apu_set_register(chip, i, w, 0);
2365
2366 }
2367}
2368
2369
2370static void snd_es1968_start_irq(struct es1968 *chip)
2371{
2372 unsigned short w;
2373 w = ESM_HIRQ_DSIE | ESM_HIRQ_HW_VOLUME;
2374 if (chip->rmidi)
2375 w |= ESM_HIRQ_MPU401;
2376 outb(w, chip->io_port + 0x1A);
2377 outw(w, chip->io_port + ESM_PORT_HOST_IRQ);
2378}
2379
2380#ifdef CONFIG_PM_SLEEP
2381
2382
2383
2384static int es1968_suspend(struct device *dev)
2385{
2386 struct pci_dev *pci = to_pci_dev(dev);
2387 struct snd_card *card = dev_get_drvdata(dev);
2388 struct es1968 *chip = card->private_data;
2389
2390 if (! chip->do_pm)
2391 return 0;
2392
2393 chip->in_suspend = 1;
2394 cancel_work_sync(&chip->hwvol_work);
2395 snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
2396 snd_pcm_suspend_all(chip->pcm);
2397 snd_ac97_suspend(chip->ac97);
2398 snd_es1968_bob_stop(chip);
2399
2400 pci_disable_device(pci);
2401 pci_save_state(pci);
2402 pci_set_power_state(pci, PCI_D3hot);
2403 return 0;
2404}
2405
2406static int es1968_resume(struct device *dev)
2407{
2408 struct pci_dev *pci = to_pci_dev(dev);
2409 struct snd_card *card = dev_get_drvdata(dev);
2410 struct es1968 *chip = card->private_data;
2411 struct esschan *es;
2412
2413 if (! chip->do_pm)
2414 return 0;
2415
2416
2417 pci_set_power_state(pci, PCI_D0);
2418 pci_restore_state(pci);
2419 if (pci_enable_device(pci) < 0) {
2420 printk(KERN_ERR "es1968: pci_enable_device failed, "
2421 "disabling device\n");
2422 snd_card_disconnect(card);
2423 return -EIO;
2424 }
2425 pci_set_master(pci);
2426
2427 snd_es1968_chip_init(chip);
2428
2429
2430 if (chip->dma.addr) {
2431
2432 wave_set_register(chip, 0x01FC, chip->dma.addr >> 12);
2433 }
2434
2435 snd_es1968_start_irq(chip);
2436
2437
2438 snd_ac97_resume(chip->ac97);
2439
2440 list_for_each_entry(es, &chip->substream_list, list) {
2441 switch (es->mode) {
2442 case ESM_MODE_PLAY:
2443 snd_es1968_playback_setup(chip, es, es->substream->runtime);
2444 break;
2445 case ESM_MODE_CAPTURE:
2446 snd_es1968_capture_setup(chip, es, es->substream->runtime);
2447 break;
2448 }
2449 }
2450
2451
2452 if (chip->bobclient)
2453 snd_es1968_bob_start(chip);
2454
2455 snd_power_change_state(card, SNDRV_CTL_POWER_D0);
2456 chip->in_suspend = 0;
2457 return 0;
2458}
2459
2460static SIMPLE_DEV_PM_OPS(es1968_pm, es1968_suspend, es1968_resume);
2461#define ES1968_PM_OPS &es1968_pm
2462#else
2463#define ES1968_PM_OPS NULL
2464#endif
2465
2466#ifdef SUPPORT_JOYSTICK
2467#define JOYSTICK_ADDR 0x200
2468static int __devinit snd_es1968_create_gameport(struct es1968 *chip, int dev)
2469{
2470 struct gameport *gp;
2471 struct resource *r;
2472 u16 val;
2473
2474 if (!joystick[dev])
2475 return -ENODEV;
2476
2477 r = request_region(JOYSTICK_ADDR, 8, "ES1968 gameport");
2478 if (!r)
2479 return -EBUSY;
2480
2481 chip->gameport = gp = gameport_allocate_port();
2482 if (!gp) {
2483 printk(KERN_ERR "es1968: cannot allocate memory for gameport\n");
2484 release_and_free_resource(r);
2485 return -ENOMEM;
2486 }
2487
2488 pci_read_config_word(chip->pci, ESM_LEGACY_AUDIO_CONTROL, &val);
2489 pci_write_config_word(chip->pci, ESM_LEGACY_AUDIO_CONTROL, val | 0x04);
2490
2491 gameport_set_name(gp, "ES1968 Gameport");
2492 gameport_set_phys(gp, "pci%s/gameport0", pci_name(chip->pci));
2493 gameport_set_dev_parent(gp, &chip->pci->dev);
2494 gp->io = JOYSTICK_ADDR;
2495 gameport_set_port_data(gp, r);
2496
2497 gameport_register_port(gp);
2498
2499 return 0;
2500}
2501
2502static void snd_es1968_free_gameport(struct es1968 *chip)
2503{
2504 if (chip->gameport) {
2505 struct resource *r = gameport_get_port_data(chip->gameport);
2506
2507 gameport_unregister_port(chip->gameport);
2508 chip->gameport = NULL;
2509
2510 release_and_free_resource(r);
2511 }
2512}
2513#else
2514static inline int snd_es1968_create_gameport(struct es1968 *chip, int dev) { return -ENOSYS; }
2515static inline void snd_es1968_free_gameport(struct es1968 *chip) { }
2516#endif
2517
2518#ifdef CONFIG_SND_ES1968_INPUT
2519static int __devinit snd_es1968_input_register(struct es1968 *chip)
2520{
2521 struct input_dev *input_dev;
2522 int err;
2523
2524 input_dev = input_allocate_device();
2525 if (!input_dev)
2526 return -ENOMEM;
2527
2528 snprintf(chip->phys, sizeof(chip->phys), "pci-%s/input0",
2529 pci_name(chip->pci));
2530
2531 input_dev->name = chip->card->driver;
2532 input_dev->phys = chip->phys;
2533 input_dev->id.bustype = BUS_PCI;
2534 input_dev->id.vendor = chip->pci->vendor;
2535 input_dev->id.product = chip->pci->device;
2536 input_dev->dev.parent = &chip->pci->dev;
2537
2538 __set_bit(EV_KEY, input_dev->evbit);
2539 __set_bit(KEY_MUTE, input_dev->keybit);
2540 __set_bit(KEY_VOLUMEDOWN, input_dev->keybit);
2541 __set_bit(KEY_VOLUMEUP, input_dev->keybit);
2542
2543 err = input_register_device(input_dev);
2544 if (err) {
2545 input_free_device(input_dev);
2546 return err;
2547 }
2548
2549 chip->input_dev = input_dev;
2550 return 0;
2551}
2552#endif
2553
2554#ifdef CONFIG_SND_ES1968_RADIO
2555#define GPIO_DATA 0x60
2556#define IO_MASK 4
2557
2558#define IO_DIR 8
2559
2560
2561#define STR_DATA 0x0040
2562#define STR_CLK 0x0080
2563#define STR_WREN 0x0100
2564#define STR_MOST 0x0200
2565
2566static void snd_es1968_tea575x_set_pins(struct snd_tea575x *tea, u8 pins)
2567{
2568 struct es1968 *chip = tea->private_data;
2569 unsigned long io = chip->io_port + GPIO_DATA;
2570 u16 val = 0;
2571
2572 val |= (pins & TEA575X_DATA) ? STR_DATA : 0;
2573 val |= (pins & TEA575X_CLK) ? STR_CLK : 0;
2574 val |= (pins & TEA575X_WREN) ? STR_WREN : 0;
2575
2576 outw(val, io);
2577}
2578
2579static u8 snd_es1968_tea575x_get_pins(struct snd_tea575x *tea)
2580{
2581 struct es1968 *chip = tea->private_data;
2582 unsigned long io = chip->io_port + GPIO_DATA;
2583 u16 val = inw(io);
2584 u8 ret;
2585
2586 ret = 0;
2587 if (val & STR_DATA)
2588 ret |= TEA575X_DATA;
2589 if (val & STR_MOST)
2590 ret |= TEA575X_MOST;
2591 return ret;
2592}
2593
2594static void snd_es1968_tea575x_set_direction(struct snd_tea575x *tea, bool output)
2595{
2596 struct es1968 *chip = tea->private_data;
2597 unsigned long io = chip->io_port + GPIO_DATA;
2598 u16 odir = inw(io + IO_DIR);
2599
2600 if (output) {
2601 outw(~(STR_DATA | STR_CLK | STR_WREN), io + IO_MASK);
2602 outw(odir | STR_DATA | STR_CLK | STR_WREN, io + IO_DIR);
2603 } else {
2604 outw(~(STR_CLK | STR_WREN | STR_DATA | STR_MOST), io + IO_MASK);
2605 outw((odir & ~(STR_DATA | STR_MOST)) | STR_CLK | STR_WREN, io + IO_DIR);
2606 }
2607}
2608
2609static struct snd_tea575x_ops snd_es1968_tea_ops = {
2610 .set_pins = snd_es1968_tea575x_set_pins,
2611 .get_pins = snd_es1968_tea575x_get_pins,
2612 .set_direction = snd_es1968_tea575x_set_direction,
2613};
2614#endif
2615
2616static int snd_es1968_free(struct es1968 *chip)
2617{
2618 cancel_work_sync(&chip->hwvol_work);
2619#ifdef CONFIG_SND_ES1968_INPUT
2620 if (chip->input_dev)
2621 input_unregister_device(chip->input_dev);
2622#endif
2623
2624 if (chip->io_port) {
2625 if (chip->irq >= 0)
2626 synchronize_irq(chip->irq);
2627 outw(1, chip->io_port + 0x04);
2628 outw(0, chip->io_port + ESM_PORT_HOST_IRQ);
2629 }
2630
2631#ifdef CONFIG_SND_ES1968_RADIO
2632 snd_tea575x_exit(&chip->tea);
2633 v4l2_device_unregister(&chip->v4l2_dev);
2634#endif
2635
2636 if (chip->irq >= 0)
2637 free_irq(chip->irq, chip);
2638 snd_es1968_free_gameport(chip);
2639 pci_release_regions(chip->pci);
2640 pci_disable_device(chip->pci);
2641 kfree(chip);
2642 return 0;
2643}
2644
2645static int snd_es1968_dev_free(struct snd_device *device)
2646{
2647 struct es1968 *chip = device->device_data;
2648 return snd_es1968_free(chip);
2649}
2650
2651struct ess_device_list {
2652 unsigned short type;
2653 unsigned short vendor;
2654};
2655
2656static struct ess_device_list pm_whitelist[] __devinitdata = {
2657 { TYPE_MAESTRO2E, 0x0e11 },
2658 { TYPE_MAESTRO2E, 0x1028 },
2659 { TYPE_MAESTRO2E, 0x103c },
2660 { TYPE_MAESTRO2E, 0x1179 },
2661 { TYPE_MAESTRO2E, 0x14c0 },
2662 { TYPE_MAESTRO2E, 0x1558 },
2663 { TYPE_MAESTRO2E, 0x125d },
2664 { TYPE_MAESTRO2, 0x125d },
2665};
2666
2667static struct ess_device_list mpu_blacklist[] __devinitdata = {
2668 { TYPE_MAESTRO2, 0x125d },
2669};
2670
2671static int __devinit snd_es1968_create(struct snd_card *card,
2672 struct pci_dev *pci,
2673 int total_bufsize,
2674 int play_streams,
2675 int capt_streams,
2676 int chip_type,
2677 int do_pm,
2678 int radio_nr,
2679 struct es1968 **chip_ret)
2680{
2681 static struct snd_device_ops ops = {
2682 .dev_free = snd_es1968_dev_free,
2683 };
2684 struct es1968 *chip;
2685 int i, err;
2686
2687 *chip_ret = NULL;
2688
2689
2690 if ((err = pci_enable_device(pci)) < 0)
2691 return err;
2692
2693 if (pci_set_dma_mask(pci, DMA_BIT_MASK(28)) < 0 ||
2694 pci_set_consistent_dma_mask(pci, DMA_BIT_MASK(28)) < 0) {
2695 snd_printk(KERN_ERR "architecture does not support 28bit PCI busmaster DMA\n");
2696 pci_disable_device(pci);
2697 return -ENXIO;
2698 }
2699
2700 chip = kzalloc(sizeof(*chip), GFP_KERNEL);
2701 if (! chip) {
2702 pci_disable_device(pci);
2703 return -ENOMEM;
2704 }
2705
2706
2707 chip->type = chip_type;
2708 spin_lock_init(&chip->reg_lock);
2709 spin_lock_init(&chip->substream_lock);
2710 INIT_LIST_HEAD(&chip->buf_list);
2711 INIT_LIST_HEAD(&chip->substream_list);
2712 mutex_init(&chip->memory_mutex);
2713 INIT_WORK(&chip->hwvol_work, es1968_update_hw_volume);
2714 chip->card = card;
2715 chip->pci = pci;
2716 chip->irq = -1;
2717 chip->total_bufsize = total_bufsize;
2718 chip->playback_streams = play_streams;
2719 chip->capture_streams = capt_streams;
2720
2721 if ((err = pci_request_regions(pci, "ESS Maestro")) < 0) {
2722 kfree(chip);
2723 pci_disable_device(pci);
2724 return err;
2725 }
2726 chip->io_port = pci_resource_start(pci, 0);
2727 if (request_irq(pci->irq, snd_es1968_interrupt, IRQF_SHARED,
2728 KBUILD_MODNAME, chip)) {
2729 snd_printk(KERN_ERR "unable to grab IRQ %d\n", pci->irq);
2730 snd_es1968_free(chip);
2731 return -EBUSY;
2732 }
2733 chip->irq = pci->irq;
2734
2735
2736 for (i = 0; i < 32; i++)
2737 chip->maestro_map[i] = 0;
2738
2739
2740 for (i = 0; i < NR_APUS; i++)
2741 chip->apu[i] = ESM_APU_FREE;
2742
2743
2744 pci_set_master(pci);
2745
2746 if (do_pm > 1) {
2747
2748 unsigned short vend;
2749 pci_read_config_word(chip->pci, PCI_SUBSYSTEM_VENDOR_ID, &vend);
2750 for (i = 0; i < (int)ARRAY_SIZE(pm_whitelist); i++) {
2751 if (chip->type == pm_whitelist[i].type &&
2752 vend == pm_whitelist[i].vendor) {
2753 do_pm = 1;
2754 break;
2755 }
2756 }
2757 if (do_pm > 1) {
2758
2759 printk(KERN_INFO "es1968: not attempting power management.\n");
2760 do_pm = 0;
2761 }
2762 }
2763 chip->do_pm = do_pm;
2764
2765 snd_es1968_chip_init(chip);
2766
2767 if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops)) < 0) {
2768 snd_es1968_free(chip);
2769 return err;
2770 }
2771
2772 snd_card_set_dev(card, &pci->dev);
2773
2774#ifdef CONFIG_SND_ES1968_RADIO
2775 err = v4l2_device_register(&pci->dev, &chip->v4l2_dev);
2776 if (err < 0) {
2777 snd_es1968_free(chip);
2778 return err;
2779 }
2780 chip->tea.v4l2_dev = &chip->v4l2_dev;
2781 chip->tea.private_data = chip;
2782 chip->tea.radio_nr = radio_nr;
2783 chip->tea.ops = &snd_es1968_tea_ops;
2784 strlcpy(chip->tea.card, "SF64-PCE2", sizeof(chip->tea.card));
2785 sprintf(chip->tea.bus_info, "PCI:%s", pci_name(pci));
2786 if (!snd_tea575x_init(&chip->tea, THIS_MODULE))
2787 printk(KERN_INFO "es1968: detected TEA575x radio\n");
2788#endif
2789
2790 *chip_ret = chip;
2791
2792 return 0;
2793}
2794
2795
2796
2797
2798static int __devinit snd_es1968_probe(struct pci_dev *pci,
2799 const struct pci_device_id *pci_id)
2800{
2801 static int dev;
2802 struct snd_card *card;
2803 struct es1968 *chip;
2804 unsigned int i;
2805 int err;
2806
2807 if (dev >= SNDRV_CARDS)
2808 return -ENODEV;
2809 if (!enable[dev]) {
2810 dev++;
2811 return -ENOENT;
2812 }
2813
2814 err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card);
2815 if (err < 0)
2816 return err;
2817
2818 if (total_bufsize[dev] < 128)
2819 total_bufsize[dev] = 128;
2820 if (total_bufsize[dev] > 4096)
2821 total_bufsize[dev] = 4096;
2822 if ((err = snd_es1968_create(card, pci,
2823 total_bufsize[dev] * 1024,
2824 pcm_substreams_p[dev],
2825 pcm_substreams_c[dev],
2826 pci_id->driver_data,
2827 use_pm[dev],
2828 radio_nr[dev],
2829 &chip)) < 0) {
2830 snd_card_free(card);
2831 return err;
2832 }
2833 card->private_data = chip;
2834
2835 switch (chip->type) {
2836 case TYPE_MAESTRO2E:
2837 strcpy(card->driver, "ES1978");
2838 strcpy(card->shortname, "ESS ES1978 (Maestro 2E)");
2839 break;
2840 case TYPE_MAESTRO2:
2841 strcpy(card->driver, "ES1968");
2842 strcpy(card->shortname, "ESS ES1968 (Maestro 2)");
2843 break;
2844 case TYPE_MAESTRO:
2845 strcpy(card->driver, "ESM1");
2846 strcpy(card->shortname, "ESS Maestro 1");
2847 break;
2848 }
2849
2850 if ((err = snd_es1968_pcm(chip, 0)) < 0) {
2851 snd_card_free(card);
2852 return err;
2853 }
2854
2855 if ((err = snd_es1968_mixer(chip)) < 0) {
2856 snd_card_free(card);
2857 return err;
2858 }
2859
2860 if (enable_mpu[dev] == 2) {
2861
2862 unsigned short vend;
2863 pci_read_config_word(chip->pci, PCI_SUBSYSTEM_VENDOR_ID, &vend);
2864 for (i = 0; i < ARRAY_SIZE(mpu_blacklist); i++) {
2865 if (chip->type == mpu_blacklist[i].type &&
2866 vend == mpu_blacklist[i].vendor) {
2867 enable_mpu[dev] = 0;
2868 break;
2869 }
2870 }
2871 }
2872 if (enable_mpu[dev]) {
2873 if ((err = snd_mpu401_uart_new(card, 0, MPU401_HW_MPU401,
2874 chip->io_port + ESM_MPU401_PORT,
2875 MPU401_INFO_INTEGRATED |
2876 MPU401_INFO_IRQ_HOOK,
2877 -1, &chip->rmidi)) < 0) {
2878 printk(KERN_WARNING "es1968: skipping MPU-401 MIDI support..\n");
2879 }
2880 }
2881
2882 snd_es1968_create_gameport(chip, dev);
2883
2884#ifdef CONFIG_SND_ES1968_INPUT
2885 err = snd_es1968_input_register(chip);
2886 if (err)
2887 snd_printk(KERN_WARNING "Input device registration "
2888 "failed with error %i", err);
2889#endif
2890
2891 snd_es1968_start_irq(chip);
2892
2893 chip->clock = clock[dev];
2894 if (! chip->clock)
2895 es1968_measure_clock(chip);
2896
2897 sprintf(card->longname, "%s at 0x%lx, irq %i",
2898 card->shortname, chip->io_port, chip->irq);
2899
2900 if ((err = snd_card_register(card)) < 0) {
2901 snd_card_free(card);
2902 return err;
2903 }
2904 pci_set_drvdata(pci, card);
2905 dev++;
2906 return 0;
2907}
2908
2909static void __devexit snd_es1968_remove(struct pci_dev *pci)
2910{
2911 snd_card_free(pci_get_drvdata(pci));
2912 pci_set_drvdata(pci, NULL);
2913}
2914
2915static struct pci_driver es1968_driver = {
2916 .name = KBUILD_MODNAME,
2917 .id_table = snd_es1968_ids,
2918 .probe = snd_es1968_probe,
2919 .remove = __devexit_p(snd_es1968_remove),
2920 .driver = {
2921 .pm = ES1968_PM_OPS,
2922 },
2923};
2924
2925module_pci_driver(es1968_driver);
2926