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 <linux/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 <media/drv-intf/tea575x.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 IS_REACHABLE(CONFIG_GAMEPORT)
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 unsigned int tea575x_tuner;
568#endif
569};
570
571static irqreturn_t snd_es1968_interrupt(int irq, void *dev_id);
572
573static const struct pci_device_id snd_es1968_ids[] = {
574
575 { 0x1285, 0x0100, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO },
576
577 { 0x125d, 0x1968, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO2 },
578
579 { 0x125d, 0x1978, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, TYPE_MAESTRO2E },
580 { 0, }
581};
582
583MODULE_DEVICE_TABLE(pci, snd_es1968_ids);
584
585
586
587
588
589
590static void __maestro_write(struct es1968 *chip, u16 reg, u16 data)
591{
592 outw(reg, chip->io_port + ESM_INDEX);
593 outw(data, chip->io_port + ESM_DATA);
594 chip->maestro_map[reg] = data;
595}
596
597static inline void maestro_write(struct es1968 *chip, u16 reg, u16 data)
598{
599 unsigned long flags;
600 spin_lock_irqsave(&chip->reg_lock, flags);
601 __maestro_write(chip, reg, data);
602 spin_unlock_irqrestore(&chip->reg_lock, flags);
603}
604
605
606static u16 __maestro_read(struct es1968 *chip, u16 reg)
607{
608 if (READABLE_MAP & (1 << reg)) {
609 outw(reg, chip->io_port + ESM_INDEX);
610 chip->maestro_map[reg] = inw(chip->io_port + ESM_DATA);
611 }
612 return chip->maestro_map[reg];
613}
614
615static inline u16 maestro_read(struct es1968 *chip, u16 reg)
616{
617 unsigned long flags;
618 u16 result;
619 spin_lock_irqsave(&chip->reg_lock, flags);
620 result = __maestro_read(chip, reg);
621 spin_unlock_irqrestore(&chip->reg_lock, flags);
622 return result;
623}
624
625
626static int snd_es1968_ac97_wait(struct es1968 *chip)
627{
628 int timeout = 100000;
629
630 while (timeout-- > 0) {
631 if (!(inb(chip->io_port + ESM_AC97_INDEX) & 1))
632 return 0;
633 cond_resched();
634 }
635 dev_dbg(chip->card->dev, "ac97 timeout\n");
636 return 1;
637}
638
639static int snd_es1968_ac97_wait_poll(struct es1968 *chip)
640{
641 int timeout = 100000;
642
643 while (timeout-- > 0) {
644 if (!(inb(chip->io_port + ESM_AC97_INDEX) & 1))
645 return 0;
646 }
647 dev_dbg(chip->card->dev, "ac97 timeout\n");
648 return 1;
649}
650
651static void snd_es1968_ac97_write(struct snd_ac97 *ac97, unsigned short reg, unsigned short val)
652{
653 struct es1968 *chip = ac97->private_data;
654
655 snd_es1968_ac97_wait(chip);
656
657
658 outw(val, chip->io_port + ESM_AC97_DATA);
659
660 outb(reg, chip->io_port + ESM_AC97_INDEX);
661
662}
663
664static unsigned short snd_es1968_ac97_read(struct snd_ac97 *ac97, unsigned short reg)
665{
666 u16 data = 0;
667 struct es1968 *chip = ac97->private_data;
668
669 snd_es1968_ac97_wait(chip);
670
671 outb(reg | 0x80, chip->io_port + ESM_AC97_INDEX);
672
673
674 if (!snd_es1968_ac97_wait_poll(chip)) {
675 data = inw(chip->io_port + ESM_AC97_DATA);
676
677 }
678
679 return data;
680}
681
682
683static void apu_index_set(struct es1968 *chip, u16 index)
684{
685 int i;
686 __maestro_write(chip, IDR1_CRAM_POINTER, index);
687 for (i = 0; i < 1000; i++)
688 if (__maestro_read(chip, IDR1_CRAM_POINTER) == index)
689 return;
690 dev_dbg(chip->card->dev, "APU register select failed. (Timeout)\n");
691}
692
693
694static void apu_data_set(struct es1968 *chip, u16 data)
695{
696 int i;
697 for (i = 0; i < 1000; i++) {
698 if (__maestro_read(chip, IDR0_DATA_PORT) == data)
699 return;
700 __maestro_write(chip, IDR0_DATA_PORT, data);
701 }
702 dev_dbg(chip->card->dev, "APU register set probably failed (Timeout)!\n");
703}
704
705
706static void __apu_set_register(struct es1968 *chip, u16 channel, u8 reg, u16 data)
707{
708 if (snd_BUG_ON(channel >= NR_APUS))
709 return;
710#ifdef CONFIG_PM_SLEEP
711 chip->apu_map[channel][reg] = data;
712#endif
713 reg |= (channel << 4);
714 apu_index_set(chip, reg);
715 apu_data_set(chip, data);
716}
717
718static void apu_set_register(struct es1968 *chip, u16 channel, u8 reg, u16 data)
719{
720 unsigned long flags;
721 spin_lock_irqsave(&chip->reg_lock, flags);
722 __apu_set_register(chip, channel, reg, data);
723 spin_unlock_irqrestore(&chip->reg_lock, flags);
724}
725
726static u16 __apu_get_register(struct es1968 *chip, u16 channel, u8 reg)
727{
728 if (snd_BUG_ON(channel >= NR_APUS))
729 return 0;
730 reg |= (channel << 4);
731 apu_index_set(chip, reg);
732 return __maestro_read(chip, IDR0_DATA_PORT);
733}
734
735static u16 apu_get_register(struct es1968 *chip, u16 channel, u8 reg)
736{
737 unsigned long flags;
738 u16 v;
739 spin_lock_irqsave(&chip->reg_lock, flags);
740 v = __apu_get_register(chip, channel, reg);
741 spin_unlock_irqrestore(&chip->reg_lock, flags);
742 return v;
743}
744
745#if 0
746
747static void assp_set_register(struct es1968 *chip, u32 reg, u32 value)
748{
749 unsigned long flags;
750
751 spin_lock_irqsave(&chip->reg_lock, flags);
752 outl(reg, chip->io_port + ASSP_INDEX);
753 outl(value, chip->io_port + ASSP_DATA);
754 spin_unlock_irqrestore(&chip->reg_lock, flags);
755}
756
757static u32 assp_get_register(struct es1968 *chip, u32 reg)
758{
759 unsigned long flags;
760 u32 value;
761
762 spin_lock_irqsave(&chip->reg_lock, flags);
763 outl(reg, chip->io_port + ASSP_INDEX);
764 value = inl(chip->io_port + ASSP_DATA);
765 spin_unlock_irqrestore(&chip->reg_lock, flags);
766
767 return value;
768}
769
770#endif
771
772static void wave_set_register(struct es1968 *chip, u16 reg, u16 value)
773{
774 unsigned long flags;
775
776 spin_lock_irqsave(&chip->reg_lock, flags);
777 outw(reg, chip->io_port + WC_INDEX);
778 outw(value, chip->io_port + WC_DATA);
779 spin_unlock_irqrestore(&chip->reg_lock, flags);
780}
781
782static u16 wave_get_register(struct es1968 *chip, u16 reg)
783{
784 unsigned long flags;
785 u16 value;
786
787 spin_lock_irqsave(&chip->reg_lock, flags);
788 outw(reg, chip->io_port + WC_INDEX);
789 value = inw(chip->io_port + WC_DATA);
790 spin_unlock_irqrestore(&chip->reg_lock, flags);
791
792 return value;
793}
794
795
796
797
798
799static void snd_es1968_bob_stop(struct es1968 *chip)
800{
801 u16 reg;
802
803 reg = __maestro_read(chip, 0x11);
804 reg &= ~ESM_BOB_ENABLE;
805 __maestro_write(chip, 0x11, reg);
806 reg = __maestro_read(chip, 0x17);
807 reg &= ~ESM_BOB_START;
808 __maestro_write(chip, 0x17, reg);
809}
810
811static void snd_es1968_bob_start(struct es1968 *chip)
812{
813 int prescale;
814 int divide;
815
816
817
818 for (prescale = 5; prescale < 12; prescale++)
819 if (chip->bob_freq > (ESS_SYSCLK >> (prescale + 9)))
820 break;
821
822
823 divide = 1;
824 while ((prescale > 5) && (divide < 32)) {
825 prescale--;
826 divide <<= 1;
827 }
828 divide >>= 1;
829
830
831 for (; divide < 31; divide++)
832 if (chip->bob_freq >
833 ((ESS_SYSCLK >> (prescale + 9)) / (divide + 1))) break;
834
835
836 if (divide == 0) {
837 divide++;
838 if (prescale > 5)
839 prescale--;
840 } else if (divide > 1)
841 divide--;
842
843 __maestro_write(chip, 6, 0x9000 | (prescale << 5) | divide);
844
845
846 __maestro_write(chip, 0x11, __maestro_read(chip, 0x11) | 1);
847 __maestro_write(chip, 0x17, __maestro_read(chip, 0x17) | 1);
848}
849
850
851static void snd_es1968_bob_inc(struct es1968 *chip, int freq)
852{
853 chip->bobclient++;
854 if (chip->bobclient == 1) {
855 chip->bob_freq = freq;
856 snd_es1968_bob_start(chip);
857 } else if (chip->bob_freq < freq) {
858 snd_es1968_bob_stop(chip);
859 chip->bob_freq = freq;
860 snd_es1968_bob_start(chip);
861 }
862}
863
864
865static void snd_es1968_bob_dec(struct es1968 *chip)
866{
867 chip->bobclient--;
868 if (chip->bobclient <= 0)
869 snd_es1968_bob_stop(chip);
870 else if (chip->bob_freq > ESM_BOB_FREQ) {
871
872 int max_freq = ESM_BOB_FREQ;
873 struct esschan *es;
874 list_for_each_entry(es, &chip->substream_list, list) {
875 if (max_freq < es->bob_freq)
876 max_freq = es->bob_freq;
877 }
878 if (max_freq != chip->bob_freq) {
879 snd_es1968_bob_stop(chip);
880 chip->bob_freq = max_freq;
881 snd_es1968_bob_start(chip);
882 }
883 }
884}
885
886static int
887snd_es1968_calc_bob_rate(struct es1968 *chip, struct esschan *es,
888 struct snd_pcm_runtime *runtime)
889{
890
891 int freq = runtime->rate * 4;
892 if (es->fmt & ESS_FMT_STEREO)
893 freq <<= 1;
894 if (es->fmt & ESS_FMT_16BIT)
895 freq <<= 1;
896 freq /= es->frag_size;
897 if (freq < ESM_BOB_FREQ)
898 freq = ESM_BOB_FREQ;
899 else if (freq > ESM_BOB_FREQ_MAX)
900 freq = ESM_BOB_FREQ_MAX;
901 return freq;
902}
903
904
905
906
907
908
909static u32 snd_es1968_compute_rate(struct es1968 *chip, u32 freq)
910{
911 u32 rate = (freq << 16) / chip->clock;
912#if 0
913 if (rate > 0x10000)
914 rate = 0x10000;
915#endif
916 return rate;
917}
918
919
920static inline unsigned int
921snd_es1968_get_dma_ptr(struct es1968 *chip, struct esschan *es)
922{
923 unsigned int offset;
924
925 offset = apu_get_register(chip, es->apu[0], 5);
926
927 offset -= es->base[0];
928
929 return (offset & 0xFFFE);
930}
931
932static void snd_es1968_apu_set_freq(struct es1968 *chip, int apu, int freq)
933{
934 apu_set_register(chip, apu, 2,
935 (apu_get_register(chip, apu, 2) & 0x00FF) |
936 ((freq & 0xff) << 8) | 0x10);
937 apu_set_register(chip, apu, 3, freq >> 8);
938}
939
940
941static inline void snd_es1968_trigger_apu(struct es1968 *esm, int apu, int mode)
942{
943
944 __apu_set_register(esm, apu, 0,
945 (__apu_get_register(esm, apu, 0) & 0xff0f) |
946 (mode << 4));
947}
948
949static void snd_es1968_pcm_start(struct es1968 *chip, struct esschan *es)
950{
951 spin_lock(&chip->reg_lock);
952 __apu_set_register(chip, es->apu[0], 5, es->base[0]);
953 snd_es1968_trigger_apu(chip, es->apu[0], es->apu_mode[0]);
954 if (es->mode == ESM_MODE_CAPTURE) {
955 __apu_set_register(chip, es->apu[2], 5, es->base[2]);
956 snd_es1968_trigger_apu(chip, es->apu[2], es->apu_mode[2]);
957 }
958 if (es->fmt & ESS_FMT_STEREO) {
959 __apu_set_register(chip, es->apu[1], 5, es->base[1]);
960 snd_es1968_trigger_apu(chip, es->apu[1], es->apu_mode[1]);
961 if (es->mode == ESM_MODE_CAPTURE) {
962 __apu_set_register(chip, es->apu[3], 5, es->base[3]);
963 snd_es1968_trigger_apu(chip, es->apu[3], es->apu_mode[3]);
964 }
965 }
966 spin_unlock(&chip->reg_lock);
967}
968
969static void snd_es1968_pcm_stop(struct es1968 *chip, struct esschan *es)
970{
971 spin_lock(&chip->reg_lock);
972 snd_es1968_trigger_apu(chip, es->apu[0], 0);
973 snd_es1968_trigger_apu(chip, es->apu[1], 0);
974 if (es->mode == ESM_MODE_CAPTURE) {
975 snd_es1968_trigger_apu(chip, es->apu[2], 0);
976 snd_es1968_trigger_apu(chip, es->apu[3], 0);
977 }
978 spin_unlock(&chip->reg_lock);
979}
980
981
982static void snd_es1968_program_wavecache(struct es1968 *chip, struct esschan *es,
983 int channel, u32 addr, int capture)
984{
985 u32 tmpval = (addr - 0x10) & 0xFFF8;
986
987 if (! capture) {
988 if (!(es->fmt & ESS_FMT_16BIT))
989 tmpval |= 4;
990 if (es->fmt & ESS_FMT_STEREO)
991 tmpval |= 2;
992 }
993
994
995 wave_set_register(chip, es->apu[channel] << 3, tmpval);
996
997#ifdef CONFIG_PM_SLEEP
998 es->wc_map[channel] = tmpval;
999#endif
1000}
1001
1002
1003static void snd_es1968_playback_setup(struct es1968 *chip, struct esschan *es,
1004 struct snd_pcm_runtime *runtime)
1005{
1006 u32 pa;
1007 int high_apu = 0;
1008 int channel, apu;
1009 int i, size;
1010 unsigned long flags;
1011 u32 freq;
1012
1013 size = es->dma_size >> es->wav_shift;
1014
1015 if (es->fmt & ESS_FMT_STEREO)
1016 high_apu++;
1017
1018 for (channel = 0; channel <= high_apu; channel++) {
1019 apu = es->apu[channel];
1020
1021 snd_es1968_program_wavecache(chip, es, channel, es->memory->buf.addr, 0);
1022
1023
1024 pa = es->memory->buf.addr;
1025 pa -= chip->dma.addr;
1026 pa >>= 1;
1027
1028 pa |= 0x00400000;
1029
1030 if (es->fmt & ESS_FMT_STEREO) {
1031
1032 if (channel)
1033 pa |= 0x00800000;
1034 if (es->fmt & ESS_FMT_16BIT)
1035 pa >>= 1;
1036 }
1037
1038
1039
1040 es->base[channel] = pa & 0xFFFF;
1041
1042 for (i = 0; i < 16; i++)
1043 apu_set_register(chip, apu, i, 0x0000);
1044
1045
1046 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xFF) << 8);
1047 apu_set_register(chip, apu, 5, pa & 0xFFFF);
1048 apu_set_register(chip, apu, 6, (pa + size) & 0xFFFF);
1049
1050 apu_set_register(chip, apu, 7, size);
1051
1052
1053 apu_set_register(chip, apu, 8, 0x0000);
1054
1055 apu_set_register(chip, apu, 9, 0xD000);
1056
1057
1058 apu_set_register(chip, apu, 11, 0x0000);
1059
1060 apu_set_register(chip, apu, 0, 0x400F);
1061
1062 if (es->fmt & ESS_FMT_16BIT)
1063 es->apu_mode[channel] = ESM_APU_16BITLINEAR;
1064 else
1065 es->apu_mode[channel] = ESM_APU_8BITLINEAR;
1066
1067 if (es->fmt & ESS_FMT_STEREO) {
1068
1069
1070
1071
1072
1073 apu_set_register(chip, apu, 10,
1074 0x8F00 | (channel ? 0 : 0x10));
1075 es->apu_mode[channel] += 1;
1076 } else
1077 apu_set_register(chip, apu, 10, 0x8F08);
1078 }
1079
1080 spin_lock_irqsave(&chip->reg_lock, flags);
1081
1082 outw(1, chip->io_port + 0x04);
1083
1084 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ);
1085 spin_unlock_irqrestore(&chip->reg_lock, flags);
1086
1087 freq = runtime->rate;
1088
1089 if (freq > 48000)
1090 freq = 48000;
1091 if (freq < 4000)
1092 freq = 4000;
1093
1094
1095 if (!(es->fmt & ESS_FMT_16BIT) && !(es->fmt & ESS_FMT_STEREO))
1096 freq >>= 1;
1097
1098 freq = snd_es1968_compute_rate(chip, freq);
1099
1100
1101 snd_es1968_apu_set_freq(chip, es->apu[0], freq);
1102 snd_es1968_apu_set_freq(chip, es->apu[1], freq);
1103}
1104
1105
1106static void init_capture_apu(struct es1968 *chip, struct esschan *es, int channel,
1107 unsigned int pa, unsigned int bsize,
1108 int mode, int route)
1109{
1110 int i, apu = es->apu[channel];
1111
1112 es->apu_mode[channel] = mode;
1113
1114
1115 snd_es1968_program_wavecache(chip, es, channel, pa, 1);
1116
1117
1118 pa -= chip->dma.addr;
1119 pa >>= 1;
1120
1121
1122
1123 es->base[channel] = pa & 0xFFFF;
1124 pa |= 0x00400000;
1125
1126
1127 for (i = 0; i < 16; i++)
1128 apu_set_register(chip, apu, i, 0x0000);
1129
1130
1131
1132 apu_set_register(chip, apu, 2, 0x8);
1133
1134
1135 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xFF) << 8);
1136 apu_set_register(chip, apu, 5, pa & 0xFFFF);
1137 apu_set_register(chip, apu, 6, (pa + bsize) & 0xFFFF);
1138 apu_set_register(chip, apu, 7, bsize);
1139
1140 apu_set_register(chip, apu, 8, 0x00F0);
1141
1142 apu_set_register(chip, apu, 9, 0x0000);
1143
1144 apu_set_register(chip, apu, 10, 0x8F08);
1145
1146 apu_set_register(chip, apu, 11, route);
1147
1148 apu_set_register(chip, apu, 0, 0x400F);
1149}
1150
1151static void snd_es1968_capture_setup(struct es1968 *chip, struct esschan *es,
1152 struct snd_pcm_runtime *runtime)
1153{
1154 int size;
1155 u32 freq;
1156 unsigned long flags;
1157
1158 size = es->dma_size >> es->wav_shift;
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172 init_capture_apu(chip, es, 2,
1173 es->mixbuf->buf.addr, ESM_MIXBUF_SIZE/4,
1174 ESM_APU_INPUTMIXER, 0x14);
1175
1176 init_capture_apu(chip, es, 0, es->memory->buf.addr, size,
1177 ESM_APU_SRCONVERTOR, es->apu[2]);
1178 if (es->fmt & ESS_FMT_STEREO) {
1179
1180 init_capture_apu(chip, es, 3,
1181 es->mixbuf->buf.addr + ESM_MIXBUF_SIZE/2,
1182 ESM_MIXBUF_SIZE/4,
1183 ESM_APU_INPUTMIXER, 0x15);
1184
1185 init_capture_apu(chip, es, 1,
1186 es->memory->buf.addr + size*2, size,
1187 ESM_APU_SRCONVERTOR, es->apu[3]);
1188 }
1189
1190 freq = runtime->rate;
1191
1192 if (freq > 47999)
1193 freq = 47999;
1194 if (freq < 4000)
1195 freq = 4000;
1196
1197 freq = snd_es1968_compute_rate(chip, freq);
1198
1199
1200 snd_es1968_apu_set_freq(chip, es->apu[0], freq);
1201 snd_es1968_apu_set_freq(chip, es->apu[1], freq);
1202
1203
1204 freq = 0x10000;
1205 snd_es1968_apu_set_freq(chip, es->apu[2], freq);
1206 snd_es1968_apu_set_freq(chip, es->apu[3], freq);
1207
1208 spin_lock_irqsave(&chip->reg_lock, flags);
1209
1210 outw(1, chip->io_port + 0x04);
1211
1212 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ);
1213 spin_unlock_irqrestore(&chip->reg_lock, flags);
1214}
1215
1216
1217
1218
1219
1220static int snd_es1968_pcm_prepare(struct snd_pcm_substream *substream)
1221{
1222 struct es1968 *chip = snd_pcm_substream_chip(substream);
1223 struct snd_pcm_runtime *runtime = substream->runtime;
1224 struct esschan *es = runtime->private_data;
1225
1226 es->dma_size = snd_pcm_lib_buffer_bytes(substream);
1227 es->frag_size = snd_pcm_lib_period_bytes(substream);
1228
1229 es->wav_shift = 1;
1230 es->fmt = 0;
1231 if (snd_pcm_format_width(runtime->format) == 16)
1232 es->fmt |= ESS_FMT_16BIT;
1233 if (runtime->channels > 1) {
1234 es->fmt |= ESS_FMT_STEREO;
1235 if (es->fmt & ESS_FMT_16BIT)
1236 es->wav_shift++;
1237 }
1238 es->bob_freq = snd_es1968_calc_bob_rate(chip, es, runtime);
1239
1240 switch (es->mode) {
1241 case ESM_MODE_PLAY:
1242 snd_es1968_playback_setup(chip, es, runtime);
1243 break;
1244 case ESM_MODE_CAPTURE:
1245 snd_es1968_capture_setup(chip, es, runtime);
1246 break;
1247 }
1248
1249 return 0;
1250}
1251
1252static int snd_es1968_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
1253{
1254 struct es1968 *chip = snd_pcm_substream_chip(substream);
1255 struct esschan *es = substream->runtime->private_data;
1256
1257 spin_lock(&chip->substream_lock);
1258 switch (cmd) {
1259 case SNDRV_PCM_TRIGGER_START:
1260 case SNDRV_PCM_TRIGGER_RESUME:
1261 if (es->running)
1262 break;
1263 snd_es1968_bob_inc(chip, es->bob_freq);
1264 es->count = 0;
1265 es->hwptr = 0;
1266 snd_es1968_pcm_start(chip, es);
1267 es->running = 1;
1268 break;
1269 case SNDRV_PCM_TRIGGER_STOP:
1270 case SNDRV_PCM_TRIGGER_SUSPEND:
1271 if (! es->running)
1272 break;
1273 snd_es1968_pcm_stop(chip, es);
1274 es->running = 0;
1275 snd_es1968_bob_dec(chip);
1276 break;
1277 }
1278 spin_unlock(&chip->substream_lock);
1279 return 0;
1280}
1281
1282static snd_pcm_uframes_t snd_es1968_pcm_pointer(struct snd_pcm_substream *substream)
1283{
1284 struct es1968 *chip = snd_pcm_substream_chip(substream);
1285 struct esschan *es = substream->runtime->private_data;
1286 unsigned int ptr;
1287
1288 ptr = snd_es1968_get_dma_ptr(chip, es) << es->wav_shift;
1289
1290 return bytes_to_frames(substream->runtime, ptr % es->dma_size);
1291}
1292
1293static struct snd_pcm_hardware snd_es1968_playback = {
1294 .info = (SNDRV_PCM_INFO_MMAP |
1295 SNDRV_PCM_INFO_MMAP_VALID |
1296 SNDRV_PCM_INFO_INTERLEAVED |
1297 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1298
1299 SNDRV_PCM_INFO_RESUME),
1300 .formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE,
1301 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
1302 .rate_min = 4000,
1303 .rate_max = 48000,
1304 .channels_min = 1,
1305 .channels_max = 2,
1306 .buffer_bytes_max = 65536,
1307 .period_bytes_min = 256,
1308 .period_bytes_max = 65536,
1309 .periods_min = 1,
1310 .periods_max = 1024,
1311 .fifo_size = 0,
1312};
1313
1314static struct snd_pcm_hardware snd_es1968_capture = {
1315 .info = (SNDRV_PCM_INFO_NONINTERLEAVED |
1316 SNDRV_PCM_INFO_MMAP |
1317 SNDRV_PCM_INFO_MMAP_VALID |
1318 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1319
1320 SNDRV_PCM_INFO_RESUME),
1321 .formats = SNDRV_PCM_FMTBIT_S16_LE,
1322 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000,
1323 .rate_min = 4000,
1324 .rate_max = 48000,
1325 .channels_min = 1,
1326 .channels_max = 2,
1327 .buffer_bytes_max = 65536,
1328 .period_bytes_min = 256,
1329 .period_bytes_max = 65536,
1330 .periods_min = 1,
1331 .periods_max = 1024,
1332 .fifo_size = 0,
1333};
1334
1335
1336
1337
1338
1339
1340
1341
1342static int calc_available_memory_size(struct es1968 *chip)
1343{
1344 int max_size = 0;
1345 struct esm_memory *buf;
1346
1347 mutex_lock(&chip->memory_mutex);
1348 list_for_each_entry(buf, &chip->buf_list, list) {
1349 if (buf->empty && buf->buf.bytes > max_size)
1350 max_size = buf->buf.bytes;
1351 }
1352 mutex_unlock(&chip->memory_mutex);
1353 if (max_size >= 128*1024)
1354 max_size = 127*1024;
1355 return max_size;
1356}
1357
1358
1359static struct esm_memory *snd_es1968_new_memory(struct es1968 *chip, int size)
1360{
1361 struct esm_memory *buf;
1362
1363 size = ALIGN(size, ESM_MEM_ALIGN);
1364 mutex_lock(&chip->memory_mutex);
1365 list_for_each_entry(buf, &chip->buf_list, list) {
1366 if (buf->empty && buf->buf.bytes >= size)
1367 goto __found;
1368 }
1369 mutex_unlock(&chip->memory_mutex);
1370 return NULL;
1371
1372__found:
1373 if (buf->buf.bytes > size) {
1374 struct esm_memory *chunk = kmalloc(sizeof(*chunk), GFP_KERNEL);
1375 if (chunk == NULL) {
1376 mutex_unlock(&chip->memory_mutex);
1377 return NULL;
1378 }
1379 chunk->buf = buf->buf;
1380 chunk->buf.bytes -= size;
1381 chunk->buf.area += size;
1382 chunk->buf.addr += size;
1383 chunk->empty = 1;
1384 buf->buf.bytes = size;
1385 list_add(&chunk->list, &buf->list);
1386 }
1387 buf->empty = 0;
1388 mutex_unlock(&chip->memory_mutex);
1389 return buf;
1390}
1391
1392
1393static void snd_es1968_free_memory(struct es1968 *chip, struct esm_memory *buf)
1394{
1395 struct esm_memory *chunk;
1396
1397 mutex_lock(&chip->memory_mutex);
1398 buf->empty = 1;
1399 if (buf->list.prev != &chip->buf_list) {
1400 chunk = list_entry(buf->list.prev, struct esm_memory, list);
1401 if (chunk->empty) {
1402 chunk->buf.bytes += buf->buf.bytes;
1403 list_del(&buf->list);
1404 kfree(buf);
1405 buf = chunk;
1406 }
1407 }
1408 if (buf->list.next != &chip->buf_list) {
1409 chunk = list_entry(buf->list.next, struct esm_memory, list);
1410 if (chunk->empty) {
1411 buf->buf.bytes += chunk->buf.bytes;
1412 list_del(&chunk->list);
1413 kfree(chunk);
1414 }
1415 }
1416 mutex_unlock(&chip->memory_mutex);
1417}
1418
1419static void snd_es1968_free_dmabuf(struct es1968 *chip)
1420{
1421 struct list_head *p;
1422
1423 if (! chip->dma.area)
1424 return;
1425 snd_dma_free_pages(&chip->dma);
1426 while ((p = chip->buf_list.next) != &chip->buf_list) {
1427 struct esm_memory *chunk = list_entry(p, struct esm_memory, list);
1428 list_del(p);
1429 kfree(chunk);
1430 }
1431}
1432
1433static int
1434snd_es1968_init_dmabuf(struct es1968 *chip)
1435{
1436 int err;
1437 struct esm_memory *chunk;
1438
1439 chip->dma.dev.type = SNDRV_DMA_TYPE_DEV;
1440 chip->dma.dev.dev = snd_dma_pci_data(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 dev_err(chip->card->dev,
1446 "can't allocate dma pages for size %d\n",
1447 chip->total_bufsize);
1448 return -ENOMEM;
1449 }
1450 if ((chip->dma.addr + chip->dma.bytes - 1) & ~((1 << 28) - 1)) {
1451 snd_dma_free_pages(&chip->dma);
1452 dev_err(chip->card->dev, "DMA buffer beyond 256MB.\n");
1453 return -ENOMEM;
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 dev_dbg(chip->card->dev,
1494 "cannot allocate dma buffer: size = %d\n", size);
1495 return -ENOMEM;
1496 }
1497 snd_pcm_set_runtime_buffer(substream, &chan->memory->buf);
1498 return 1;
1499}
1500
1501
1502static int snd_es1968_hw_free(struct snd_pcm_substream *substream)
1503{
1504 struct es1968 *chip = snd_pcm_substream_chip(substream);
1505 struct snd_pcm_runtime *runtime = substream->runtime;
1506 struct esschan *chan;
1507
1508 if (runtime->private_data == NULL)
1509 return 0;
1510 chan = runtime->private_data;
1511 if (chan->memory) {
1512 snd_es1968_free_memory(chip, chan->memory);
1513 chan->memory = NULL;
1514 }
1515 return 0;
1516}
1517
1518
1519
1520
1521
1522static int snd_es1968_alloc_apu_pair(struct es1968 *chip, int type)
1523{
1524 int apu;
1525
1526 for (apu = 0; apu < NR_APUS; apu += 2) {
1527 if (chip->apu[apu] == ESM_APU_FREE &&
1528 chip->apu[apu + 1] == ESM_APU_FREE) {
1529 chip->apu[apu] = chip->apu[apu + 1] = type;
1530 return apu;
1531 }
1532 }
1533 return -EBUSY;
1534}
1535
1536
1537
1538
1539static void snd_es1968_free_apu_pair(struct es1968 *chip, int apu)
1540{
1541 chip->apu[apu] = chip->apu[apu + 1] = ESM_APU_FREE;
1542}
1543
1544
1545
1546
1547
1548
1549static int snd_es1968_playback_open(struct snd_pcm_substream *substream)
1550{
1551 struct es1968 *chip = snd_pcm_substream_chip(substream);
1552 struct snd_pcm_runtime *runtime = substream->runtime;
1553 struct esschan *es;
1554 int apu1;
1555
1556
1557 apu1 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_PLAY);
1558 if (apu1 < 0)
1559 return apu1;
1560
1561 es = kzalloc(sizeof(*es), GFP_KERNEL);
1562 if (!es) {
1563 snd_es1968_free_apu_pair(chip, apu1);
1564 return -ENOMEM;
1565 }
1566
1567 es->apu[0] = apu1;
1568 es->apu[1] = apu1 + 1;
1569 es->apu_mode[0] = 0;
1570 es->apu_mode[1] = 0;
1571 es->running = 0;
1572 es->substream = substream;
1573 es->mode = ESM_MODE_PLAY;
1574
1575 runtime->private_data = es;
1576 runtime->hw = snd_es1968_playback;
1577 runtime->hw.buffer_bytes_max = runtime->hw.period_bytes_max =
1578 calc_available_memory_size(chip);
1579
1580 spin_lock_irq(&chip->substream_lock);
1581 list_add(&es->list, &chip->substream_list);
1582 spin_unlock_irq(&chip->substream_lock);
1583
1584 return 0;
1585}
1586
1587static int snd_es1968_capture_open(struct snd_pcm_substream *substream)
1588{
1589 struct snd_pcm_runtime *runtime = substream->runtime;
1590 struct es1968 *chip = snd_pcm_substream_chip(substream);
1591 struct esschan *es;
1592 int apu1, apu2;
1593
1594 apu1 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_CAPTURE);
1595 if (apu1 < 0)
1596 return apu1;
1597 apu2 = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_RATECONV);
1598 if (apu2 < 0) {
1599 snd_es1968_free_apu_pair(chip, apu1);
1600 return apu2;
1601 }
1602
1603 es = kzalloc(sizeof(*es), GFP_KERNEL);
1604 if (!es) {
1605 snd_es1968_free_apu_pair(chip, apu1);
1606 snd_es1968_free_apu_pair(chip, apu2);
1607 return -ENOMEM;
1608 }
1609
1610 es->apu[0] = apu1;
1611 es->apu[1] = apu1 + 1;
1612 es->apu[2] = apu2;
1613 es->apu[3] = apu2 + 1;
1614 es->apu_mode[0] = 0;
1615 es->apu_mode[1] = 0;
1616 es->apu_mode[2] = 0;
1617 es->apu_mode[3] = 0;
1618 es->running = 0;
1619 es->substream = substream;
1620 es->mode = ESM_MODE_CAPTURE;
1621
1622
1623 if ((es->mixbuf = snd_es1968_new_memory(chip, ESM_MIXBUF_SIZE)) == NULL) {
1624 snd_es1968_free_apu_pair(chip, apu1);
1625 snd_es1968_free_apu_pair(chip, apu2);
1626 kfree(es);
1627 return -ENOMEM;
1628 }
1629 memset(es->mixbuf->buf.area, 0, ESM_MIXBUF_SIZE);
1630
1631 runtime->private_data = es;
1632 runtime->hw = snd_es1968_capture;
1633 runtime->hw.buffer_bytes_max = runtime->hw.period_bytes_max =
1634 calc_available_memory_size(chip) - 1024;
1635 snd_pcm_hw_constraint_pow2(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
1636
1637 spin_lock_irq(&chip->substream_lock);
1638 list_add(&es->list, &chip->substream_list);
1639 spin_unlock_irq(&chip->substream_lock);
1640
1641 return 0;
1642}
1643
1644static int snd_es1968_playback_close(struct snd_pcm_substream *substream)
1645{
1646 struct es1968 *chip = snd_pcm_substream_chip(substream);
1647 struct esschan *es;
1648
1649 if (substream->runtime->private_data == NULL)
1650 return 0;
1651 es = substream->runtime->private_data;
1652 spin_lock_irq(&chip->substream_lock);
1653 list_del(&es->list);
1654 spin_unlock_irq(&chip->substream_lock);
1655 snd_es1968_free_apu_pair(chip, es->apu[0]);
1656 kfree(es);
1657
1658 return 0;
1659}
1660
1661static int snd_es1968_capture_close(struct snd_pcm_substream *substream)
1662{
1663 struct es1968 *chip = snd_pcm_substream_chip(substream);
1664 struct esschan *es;
1665
1666 if (substream->runtime->private_data == NULL)
1667 return 0;
1668 es = substream->runtime->private_data;
1669 spin_lock_irq(&chip->substream_lock);
1670 list_del(&es->list);
1671 spin_unlock_irq(&chip->substream_lock);
1672 snd_es1968_free_memory(chip, es->mixbuf);
1673 snd_es1968_free_apu_pair(chip, es->apu[0]);
1674 snd_es1968_free_apu_pair(chip, es->apu[2]);
1675 kfree(es);
1676
1677 return 0;
1678}
1679
1680static const struct snd_pcm_ops snd_es1968_playback_ops = {
1681 .open = snd_es1968_playback_open,
1682 .close = snd_es1968_playback_close,
1683 .ioctl = snd_pcm_lib_ioctl,
1684 .hw_params = snd_es1968_hw_params,
1685 .hw_free = snd_es1968_hw_free,
1686 .prepare = snd_es1968_pcm_prepare,
1687 .trigger = snd_es1968_pcm_trigger,
1688 .pointer = snd_es1968_pcm_pointer,
1689};
1690
1691static const struct snd_pcm_ops snd_es1968_capture_ops = {
1692 .open = snd_es1968_capture_open,
1693 .close = snd_es1968_capture_close,
1694 .ioctl = snd_pcm_lib_ioctl,
1695 .hw_params = snd_es1968_hw_params,
1696 .hw_free = snd_es1968_hw_free,
1697 .prepare = snd_es1968_pcm_prepare,
1698 .trigger = snd_es1968_pcm_trigger,
1699 .pointer = snd_es1968_pcm_pointer,
1700};
1701
1702
1703
1704
1705
1706#define CLOCK_MEASURE_BUFSIZE 16768
1707
1708static void es1968_measure_clock(struct es1968 *chip)
1709{
1710 int i, apu;
1711 unsigned int pa, offset, t;
1712 struct esm_memory *memory;
1713 ktime_t start_time, stop_time;
1714 ktime_t diff;
1715
1716 if (chip->clock == 0)
1717 chip->clock = 48000;
1718
1719
1720 if ((apu = snd_es1968_alloc_apu_pair(chip, ESM_APU_PCM_PLAY)) < 0) {
1721 dev_err(chip->card->dev, "Hmm, cannot find empty APU pair!?\n");
1722 return;
1723 }
1724 if ((memory = snd_es1968_new_memory(chip, CLOCK_MEASURE_BUFSIZE)) == NULL) {
1725 dev_warn(chip->card->dev,
1726 "cannot allocate dma buffer - using default clock %d\n",
1727 chip->clock);
1728 snd_es1968_free_apu_pair(chip, apu);
1729 return;
1730 }
1731
1732 memset(memory->buf.area, 0, CLOCK_MEASURE_BUFSIZE);
1733
1734 wave_set_register(chip, apu << 3, (memory->buf.addr - 0x10) & 0xfff8);
1735
1736 pa = (unsigned int)((memory->buf.addr - chip->dma.addr) >> 1);
1737 pa |= 0x00400000;
1738
1739
1740 for (i = 0; i < 16; i++)
1741 apu_set_register(chip, apu, i, 0x0000);
1742
1743 apu_set_register(chip, apu, 0, 0x400f);
1744 apu_set_register(chip, apu, 4, ((pa >> 16) & 0xff) << 8);
1745 apu_set_register(chip, apu, 5, pa & 0xffff);
1746 apu_set_register(chip, apu, 6, (pa + CLOCK_MEASURE_BUFSIZE/2) & 0xffff);
1747 apu_set_register(chip, apu, 7, CLOCK_MEASURE_BUFSIZE/2);
1748 apu_set_register(chip, apu, 8, 0x0000);
1749 apu_set_register(chip, apu, 9, 0xD000);
1750 apu_set_register(chip, apu, 10, 0x8F08);
1751 apu_set_register(chip, apu, 11, 0x0000);
1752 spin_lock_irq(&chip->reg_lock);
1753 outw(1, chip->io_port + 0x04);
1754 outw(inw(chip->io_port + ESM_PORT_HOST_IRQ) | ESM_HIRQ_DSIE, chip->io_port + ESM_PORT_HOST_IRQ);
1755 spin_unlock_irq(&chip->reg_lock);
1756
1757 snd_es1968_apu_set_freq(chip, apu, ((unsigned int)48000 << 16) / chip->clock);
1758
1759 chip->in_measurement = 1;
1760 chip->measure_apu = apu;
1761 spin_lock_irq(&chip->reg_lock);
1762 snd_es1968_bob_inc(chip, ESM_BOB_FREQ);
1763 __apu_set_register(chip, apu, 5, pa & 0xffff);
1764 snd_es1968_trigger_apu(chip, apu, ESM_APU_16BITLINEAR);
1765 start_time = ktime_get();
1766 spin_unlock_irq(&chip->reg_lock);
1767 msleep(50);
1768 spin_lock_irq(&chip->reg_lock);
1769 offset = __apu_get_register(chip, apu, 5);
1770 stop_time = ktime_get();
1771 snd_es1968_trigger_apu(chip, apu, 0);
1772 snd_es1968_bob_dec(chip);
1773 chip->in_measurement = 0;
1774 spin_unlock_irq(&chip->reg_lock);
1775
1776
1777 offset -= (pa & 0xffff);
1778 offset &= 0xfffe;
1779 offset += chip->measure_count * (CLOCK_MEASURE_BUFSIZE/2);
1780
1781 diff = ktime_sub(stop_time, start_time);
1782 t = ktime_to_us(diff);
1783 if (t == 0) {
1784 dev_err(chip->card->dev, "?? 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 dev_info(chip->card->dev, "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
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
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 dev_info(chip->card->dev, "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 snd_card *card = dev_get_drvdata(dev);
2387 struct es1968 *chip = card->private_data;
2388
2389 if (! chip->do_pm)
2390 return 0;
2391
2392 chip->in_suspend = 1;
2393 cancel_work_sync(&chip->hwvol_work);
2394 snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
2395 snd_pcm_suspend_all(chip->pcm);
2396 snd_ac97_suspend(chip->ac97);
2397 snd_es1968_bob_stop(chip);
2398 return 0;
2399}
2400
2401static int es1968_resume(struct device *dev)
2402{
2403 struct snd_card *card = dev_get_drvdata(dev);
2404 struct es1968 *chip = card->private_data;
2405 struct esschan *es;
2406
2407 if (! chip->do_pm)
2408 return 0;
2409
2410 snd_es1968_chip_init(chip);
2411
2412
2413 if (chip->dma.addr) {
2414
2415 wave_set_register(chip, 0x01FC, chip->dma.addr >> 12);
2416 }
2417
2418 snd_es1968_start_irq(chip);
2419
2420
2421 snd_ac97_resume(chip->ac97);
2422
2423 list_for_each_entry(es, &chip->substream_list, list) {
2424 switch (es->mode) {
2425 case ESM_MODE_PLAY:
2426 snd_es1968_playback_setup(chip, es, es->substream->runtime);
2427 break;
2428 case ESM_MODE_CAPTURE:
2429 snd_es1968_capture_setup(chip, es, es->substream->runtime);
2430 break;
2431 }
2432 }
2433
2434
2435 if (chip->bobclient)
2436 snd_es1968_bob_start(chip);
2437
2438 snd_power_change_state(card, SNDRV_CTL_POWER_D0);
2439 chip->in_suspend = 0;
2440 return 0;
2441}
2442
2443static SIMPLE_DEV_PM_OPS(es1968_pm, es1968_suspend, es1968_resume);
2444#define ES1968_PM_OPS &es1968_pm
2445#else
2446#define ES1968_PM_OPS NULL
2447#endif
2448
2449#ifdef SUPPORT_JOYSTICK
2450#define JOYSTICK_ADDR 0x200
2451static int snd_es1968_create_gameport(struct es1968 *chip, int dev)
2452{
2453 struct gameport *gp;
2454 struct resource *r;
2455 u16 val;
2456
2457 if (!joystick[dev])
2458 return -ENODEV;
2459
2460 r = request_region(JOYSTICK_ADDR, 8, "ES1968 gameport");
2461 if (!r)
2462 return -EBUSY;
2463
2464 chip->gameport = gp = gameport_allocate_port();
2465 if (!gp) {
2466 dev_err(chip->card->dev,
2467 "cannot allocate memory for gameport\n");
2468 release_and_free_resource(r);
2469 return -ENOMEM;
2470 }
2471
2472 pci_read_config_word(chip->pci, ESM_LEGACY_AUDIO_CONTROL, &val);
2473 pci_write_config_word(chip->pci, ESM_LEGACY_AUDIO_CONTROL, val | 0x04);
2474
2475 gameport_set_name(gp, "ES1968 Gameport");
2476 gameport_set_phys(gp, "pci%s/gameport0", pci_name(chip->pci));
2477 gameport_set_dev_parent(gp, &chip->pci->dev);
2478 gp->io = JOYSTICK_ADDR;
2479 gameport_set_port_data(gp, r);
2480
2481 gameport_register_port(gp);
2482
2483 return 0;
2484}
2485
2486static void snd_es1968_free_gameport(struct es1968 *chip)
2487{
2488 if (chip->gameport) {
2489 struct resource *r = gameport_get_port_data(chip->gameport);
2490
2491 gameport_unregister_port(chip->gameport);
2492 chip->gameport = NULL;
2493
2494 release_and_free_resource(r);
2495 }
2496}
2497#else
2498static inline int snd_es1968_create_gameport(struct es1968 *chip, int dev) { return -ENOSYS; }
2499static inline void snd_es1968_free_gameport(struct es1968 *chip) { }
2500#endif
2501
2502#ifdef CONFIG_SND_ES1968_INPUT
2503static int snd_es1968_input_register(struct es1968 *chip)
2504{
2505 struct input_dev *input_dev;
2506 int err;
2507
2508 input_dev = input_allocate_device();
2509 if (!input_dev)
2510 return -ENOMEM;
2511
2512 snprintf(chip->phys, sizeof(chip->phys), "pci-%s/input0",
2513 pci_name(chip->pci));
2514
2515 input_dev->name = chip->card->driver;
2516 input_dev->phys = chip->phys;
2517 input_dev->id.bustype = BUS_PCI;
2518 input_dev->id.vendor = chip->pci->vendor;
2519 input_dev->id.product = chip->pci->device;
2520 input_dev->dev.parent = &chip->pci->dev;
2521
2522 __set_bit(EV_KEY, input_dev->evbit);
2523 __set_bit(KEY_MUTE, input_dev->keybit);
2524 __set_bit(KEY_VOLUMEDOWN, input_dev->keybit);
2525 __set_bit(KEY_VOLUMEUP, input_dev->keybit);
2526
2527 err = input_register_device(input_dev);
2528 if (err) {
2529 input_free_device(input_dev);
2530 return err;
2531 }
2532
2533 chip->input_dev = input_dev;
2534 return 0;
2535}
2536#endif
2537
2538#ifdef CONFIG_SND_ES1968_RADIO
2539#define GPIO_DATA 0x60
2540#define IO_MASK 4
2541
2542#define IO_DIR 8
2543
2544
2545
2546struct snd_es1968_tea575x_gpio {
2547 u8 data, clk, wren, most;
2548 char *name;
2549};
2550
2551static struct snd_es1968_tea575x_gpio snd_es1968_tea575x_gpios[] = {
2552 { .data = 6, .clk = 7, .wren = 8, .most = 9, .name = "SF64-PCE2" },
2553 { .data = 7, .clk = 8, .wren = 6, .most = 10, .name = "M56VAP" },
2554};
2555
2556#define get_tea575x_gpio(chip) \
2557 (&snd_es1968_tea575x_gpios[(chip)->tea575x_tuner])
2558
2559
2560static void snd_es1968_tea575x_set_pins(struct snd_tea575x *tea, u8 pins)
2561{
2562 struct es1968 *chip = tea->private_data;
2563 struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
2564 u16 val = 0;
2565
2566 val |= (pins & TEA575X_DATA) ? (1 << gpio.data) : 0;
2567 val |= (pins & TEA575X_CLK) ? (1 << gpio.clk) : 0;
2568 val |= (pins & TEA575X_WREN) ? (1 << gpio.wren) : 0;
2569
2570 outw(val, chip->io_port + GPIO_DATA);
2571}
2572
2573static u8 snd_es1968_tea575x_get_pins(struct snd_tea575x *tea)
2574{
2575 struct es1968 *chip = tea->private_data;
2576 struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
2577 u16 val = inw(chip->io_port + GPIO_DATA);
2578 u8 ret = 0;
2579
2580 if (val & (1 << gpio.data))
2581 ret |= TEA575X_DATA;
2582 if (val & (1 << gpio.most))
2583 ret |= TEA575X_MOST;
2584
2585 return ret;
2586}
2587
2588static void snd_es1968_tea575x_set_direction(struct snd_tea575x *tea, bool output)
2589{
2590 struct es1968 *chip = tea->private_data;
2591 unsigned long io = chip->io_port + GPIO_DATA;
2592 u16 odir = inw(io + IO_DIR);
2593 struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
2594
2595 if (output) {
2596 outw(~((1 << gpio.data) | (1 << gpio.clk) | (1 << gpio.wren)),
2597 io + IO_MASK);
2598 outw(odir | (1 << gpio.data) | (1 << gpio.clk) | (1 << gpio.wren),
2599 io + IO_DIR);
2600 } else {
2601 outw(~((1 << gpio.clk) | (1 << gpio.wren) | (1 << gpio.data) | (1 << gpio.most)),
2602 io + IO_MASK);
2603 outw((odir & ~((1 << gpio.data) | (1 << gpio.most)))
2604 | (1 << gpio.clk) | (1 << gpio.wren), io + IO_DIR);
2605 }
2606}
2607
2608static const struct snd_tea575x_ops snd_es1968_tea_ops = {
2609 .set_pins = snd_es1968_tea575x_set_pins,
2610 .get_pins = snd_es1968_tea575x_get_pins,
2611 .set_direction = snd_es1968_tea575x_set_direction,
2612};
2613#endif
2614
2615static int snd_es1968_free(struct es1968 *chip)
2616{
2617 cancel_work_sync(&chip->hwvol_work);
2618#ifdef CONFIG_SND_ES1968_INPUT
2619 if (chip->input_dev)
2620 input_unregister_device(chip->input_dev);
2621#endif
2622
2623 if (chip->io_port) {
2624 if (chip->irq >= 0)
2625 synchronize_irq(chip->irq);
2626 outw(1, chip->io_port + 0x04);
2627 outw(0, chip->io_port + ESM_PORT_HOST_IRQ);
2628 }
2629
2630#ifdef CONFIG_SND_ES1968_RADIO
2631 snd_tea575x_exit(&chip->tea);
2632 v4l2_device_unregister(&chip->v4l2_dev);
2633#endif
2634
2635 if (chip->irq >= 0)
2636 free_irq(chip->irq, chip);
2637 snd_es1968_free_gameport(chip);
2638 pci_release_regions(chip->pci);
2639 pci_disable_device(chip->pci);
2640 kfree(chip);
2641 return 0;
2642}
2643
2644static int snd_es1968_dev_free(struct snd_device *device)
2645{
2646 struct es1968 *chip = device->device_data;
2647 return snd_es1968_free(chip);
2648}
2649
2650struct ess_device_list {
2651 unsigned short type;
2652 unsigned short vendor;
2653};
2654
2655static struct ess_device_list pm_whitelist[] = {
2656 { TYPE_MAESTRO2E, 0x0e11 },
2657 { TYPE_MAESTRO2E, 0x1028 },
2658 { TYPE_MAESTRO2E, 0x103c },
2659 { TYPE_MAESTRO2E, 0x1179 },
2660 { TYPE_MAESTRO2E, 0x14c0 },
2661 { TYPE_MAESTRO2E, 0x1558 },
2662 { TYPE_MAESTRO2E, 0x125d },
2663 { TYPE_MAESTRO2, 0x125d },
2664};
2665
2666static struct ess_device_list mpu_blacklist[] = {
2667 { TYPE_MAESTRO2, 0x125d },
2668};
2669
2670static int snd_es1968_create(struct snd_card *card,
2671 struct pci_dev *pci,
2672 int total_bufsize,
2673 int play_streams,
2674 int capt_streams,
2675 int chip_type,
2676 int do_pm,
2677 int radio_nr,
2678 struct es1968 **chip_ret)
2679{
2680 static struct snd_device_ops ops = {
2681 .dev_free = snd_es1968_dev_free,
2682 };
2683 struct es1968 *chip;
2684 int i, err;
2685
2686 *chip_ret = NULL;
2687
2688
2689 if ((err = pci_enable_device(pci)) < 0)
2690 return err;
2691
2692 if (dma_set_mask(&pci->dev, DMA_BIT_MASK(28)) < 0 ||
2693 dma_set_coherent_mask(&pci->dev, DMA_BIT_MASK(28)) < 0) {
2694 dev_err(card->dev,
2695 "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 dev_err(card->dev, "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 dev_info(card->dev, "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#ifdef CONFIG_SND_ES1968_RADIO
2773
2774 if (chip->pci->subsystem_vendor != 0x125d)
2775 goto no_radio;
2776 err = v4l2_device_register(&pci->dev, &chip->v4l2_dev);
2777 if (err < 0) {
2778 snd_es1968_free(chip);
2779 return err;
2780 }
2781 chip->tea.v4l2_dev = &chip->v4l2_dev;
2782 chip->tea.private_data = chip;
2783 chip->tea.radio_nr = radio_nr;
2784 chip->tea.ops = &snd_es1968_tea_ops;
2785 sprintf(chip->tea.bus_info, "PCI:%s", pci_name(pci));
2786 for (i = 0; i < ARRAY_SIZE(snd_es1968_tea575x_gpios); i++) {
2787 chip->tea575x_tuner = i;
2788 if (!snd_tea575x_init(&chip->tea, THIS_MODULE)) {
2789 dev_info(card->dev, "detected TEA575x radio type %s\n",
2790 get_tea575x_gpio(chip)->name);
2791 strlcpy(chip->tea.card, get_tea575x_gpio(chip)->name,
2792 sizeof(chip->tea.card));
2793 break;
2794 }
2795 }
2796no_radio:
2797#endif
2798
2799 *chip_ret = chip;
2800
2801 return 0;
2802}
2803
2804
2805
2806
2807static int snd_es1968_probe(struct pci_dev *pci,
2808 const struct pci_device_id *pci_id)
2809{
2810 static int dev;
2811 struct snd_card *card;
2812 struct es1968 *chip;
2813 unsigned int i;
2814 int err;
2815
2816 if (dev >= SNDRV_CARDS)
2817 return -ENODEV;
2818 if (!enable[dev]) {
2819 dev++;
2820 return -ENOENT;
2821 }
2822
2823 err = snd_card_new(&pci->dev, index[dev], id[dev], THIS_MODULE,
2824 0, &card);
2825 if (err < 0)
2826 return err;
2827
2828 if (total_bufsize[dev] < 128)
2829 total_bufsize[dev] = 128;
2830 if (total_bufsize[dev] > 4096)
2831 total_bufsize[dev] = 4096;
2832 if ((err = snd_es1968_create(card, pci,
2833 total_bufsize[dev] * 1024,
2834 pcm_substreams_p[dev],
2835 pcm_substreams_c[dev],
2836 pci_id->driver_data,
2837 use_pm[dev],
2838 radio_nr[dev],
2839 &chip)) < 0) {
2840 snd_card_free(card);
2841 return err;
2842 }
2843 card->private_data = chip;
2844
2845 switch (chip->type) {
2846 case TYPE_MAESTRO2E:
2847 strcpy(card->driver, "ES1978");
2848 strcpy(card->shortname, "ESS ES1978 (Maestro 2E)");
2849 break;
2850 case TYPE_MAESTRO2:
2851 strcpy(card->driver, "ES1968");
2852 strcpy(card->shortname, "ESS ES1968 (Maestro 2)");
2853 break;
2854 case TYPE_MAESTRO:
2855 strcpy(card->driver, "ESM1");
2856 strcpy(card->shortname, "ESS Maestro 1");
2857 break;
2858 }
2859
2860 if ((err = snd_es1968_pcm(chip, 0)) < 0) {
2861 snd_card_free(card);
2862 return err;
2863 }
2864
2865 if ((err = snd_es1968_mixer(chip)) < 0) {
2866 snd_card_free(card);
2867 return err;
2868 }
2869
2870 if (enable_mpu[dev] == 2) {
2871
2872 unsigned short vend;
2873 pci_read_config_word(chip->pci, PCI_SUBSYSTEM_VENDOR_ID, &vend);
2874 for (i = 0; i < ARRAY_SIZE(mpu_blacklist); i++) {
2875 if (chip->type == mpu_blacklist[i].type &&
2876 vend == mpu_blacklist[i].vendor) {
2877 enable_mpu[dev] = 0;
2878 break;
2879 }
2880 }
2881 }
2882 if (enable_mpu[dev]) {
2883 if ((err = snd_mpu401_uart_new(card, 0, MPU401_HW_MPU401,
2884 chip->io_port + ESM_MPU401_PORT,
2885 MPU401_INFO_INTEGRATED |
2886 MPU401_INFO_IRQ_HOOK,
2887 -1, &chip->rmidi)) < 0) {
2888 dev_warn(card->dev, "skipping MPU-401 MIDI support..\n");
2889 }
2890 }
2891
2892 snd_es1968_create_gameport(chip, dev);
2893
2894#ifdef CONFIG_SND_ES1968_INPUT
2895 err = snd_es1968_input_register(chip);
2896 if (err)
2897 dev_warn(card->dev,
2898 "Input device registration failed with error %i", err);
2899#endif
2900
2901 snd_es1968_start_irq(chip);
2902
2903 chip->clock = clock[dev];
2904 if (! chip->clock)
2905 es1968_measure_clock(chip);
2906
2907 sprintf(card->longname, "%s at 0x%lx, irq %i",
2908 card->shortname, chip->io_port, chip->irq);
2909
2910 if ((err = snd_card_register(card)) < 0) {
2911 snd_card_free(card);
2912 return err;
2913 }
2914 pci_set_drvdata(pci, card);
2915 dev++;
2916 return 0;
2917}
2918
2919static void snd_es1968_remove(struct pci_dev *pci)
2920{
2921 snd_card_free(pci_get_drvdata(pci));
2922}
2923
2924static struct pci_driver es1968_driver = {
2925 .name = KBUILD_MODNAME,
2926 .id_table = snd_es1968_ids,
2927 .probe = snd_es1968_probe,
2928 .remove = snd_es1968_remove,
2929 .driver = {
2930 .pm = ES1968_PM_OPS,
2931 },
2932};
2933
2934module_pci_driver(es1968_driver);
2935