[PATCH] fix semaphore handling in __unregister_chrdev_region
[linux/fpc-iii.git] / sound / oss / trident.c
blob47537f0a5b058195279271ce8aae4148e56222d0
1 /*
2 * OSS driver for Linux 2.[46].x for
4 * Trident 4D-Wave
5 * SiS 7018
6 * ALi 5451
7 * Tvia/IGST CyberPro 5050
9 * Driver: Alan Cox <alan@redhat.com>
11 * Built from:
12 * Low level code: <audio@tridentmicro.com> from ALSA
13 * Framework: Thomas Sailer <sailer@ife.ee.ethz.ch>
14 * Extended by: Zach Brown <zab@redhat.com>
16 * Hacked up by:
17 * Aaron Holtzman <aholtzma@ess.engr.uvic.ca>
18 * Ollie Lho <ollie@sis.com.tw> SiS 7018 Audio Core Support
19 * Ching-Ling Lee <cling-li@ali.com.tw> ALi 5451 Audio Core Support
20 * Matt Wu <mattwu@acersoftech.com.cn> ALi 5451 Audio Core Support
21 * Peter Wächtler <pwaechtler@loewe-komp.de> CyberPro5050 support
22 * Muli Ben-Yehuda <mulix@mulix.org>
25 * This program is free software; you can redistribute it and/or modify
26 * it under the terms of the GNU General Public License as published by
27 * the Free Software Foundation; either version 2 of the License, or
28 * (at your option) any later version.
30 * This program is distributed in the hope that it will be useful,
31 * but WITHOUT ANY WARRANTY; without even the implied warranty of
32 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
33 * GNU General Public License for more details.
35 * You should have received a copy of the GNU General Public License
36 * along with this program; if not, write to the Free Software
37 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
39 * History
40 * v0.14.10j
41 * January 3 2004 Eugene Teo <eugeneteo@eugeneteo.net>
42 * minor cleanup to use pr_debug instead of TRDBG since it is already
43 * defined in linux/kernel.h.
44 * v0.14.10i
45 * December 29 2003 Muli Ben-Yehuda <mulix@mulix.org>
46 * major cleanup for 2.6, fix a few error patch buglets
47 * with returning without properly cleaning up first,
48 * get rid of lock_kernel().
49 * v0.14.10h
50 * Sept 10 2002 Pascal Schmidt <der.eremit@email.de>
51 * added support for ALi 5451 joystick port
52 * v0.14.10g
53 * Sept 05 2002 Alan Cox <alan@redhat.com>
54 * adapt to new pci joystick attachment interface
55 * v0.14.10f
56 * July 24 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
57 * patch from Eric Lemar (via Ian Soboroff): in suspend and resume,
58 * fix wrong cast from pci_dev* to struct trident_card*.
59 * v0.14.10e
60 * July 19 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
61 * rewrite the DMA buffer allocation/deallcoation functions, to make it
62 * modular and fix a bug where we would call free_pages on memory
63 * obtained with pci_alloc_consistent. Also remove unnecessary #ifdef
64 * CONFIG_PROC_FS and various other cleanups.
65 * v0.14.10d
66 * July 19 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
67 * made several printk(KERN_NOTICE...) into TRDBG(...), to avoid spamming
68 * my syslog with hundreds of messages.
69 * v0.14.10c
70 * July 16 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
71 * Cleaned up Lei Hu's 0.4.10 driver to conform to Documentation/CodingStyle
72 * and the coding style used in the rest of the file.
73 * v0.14.10b
74 * June 23 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
75 * add a missing unlock_set_fmt, remove a superflous lock/unlock pair
76 * with nothing in between.
77 * v0.14.10a
78 * June 21 2002 Muli Ben-Yehuda <mulix@actcom.co.il>
79 * use a debug macro instead of #ifdef CONFIG_DEBUG, trim to 80 columns
80 * per line, use 'do {} while (0)' in statement macros.
81 * v0.14.10
82 * June 6 2002 Lei Hu <Lei_hu@ali.com.tw>
83 * rewrite the part to read/write registers of audio codec for Ali5451
84 * v0.14.9e
85 * January 2 2002 Vojtech Pavlik <vojtech@ucw.cz> added gameport
86 * support to avoid resource conflict with pcigame.c
87 * v0.14.9d
88 * October 8 2001 Arnaldo Carvalho de Melo <acme@conectiva.com.br>
89 * use set_current_state, properly release resources on failure in
90 * trident_probe, get rid of check_region
91 * v0.14.9c
92 * August 10 2001 Peter Wächtler <pwaechtler@loewe-komp.de>
93 * added support for Tvia (formerly Integraphics/IGST) CyberPro5050
94 * this chip is often found in settop boxes (combined video+audio)
95 * v0.14.9b
96 * Switch to static inline not extern inline (gcc 3)
97 * v0.14.9a
98 * Aug 6 2001 Alan Cox
99 * 0.14.9 crashed on rmmod due to a timer/bh left running. Simplified
100 * the existing logic (the BH doesn't help as ac97 is lock_irqsave)
101 * and used del_timer_sync to clean up
102 * Fixed a problem where the ALi change broke my generic card
103 * v0.14.9
104 * Jul 10 2001 Matt Wu
105 * Add H/W Volume Control
106 * v0.14.8a
107 * July 7 2001 Alan Cox
108 * Moved Matt Wu's ac97 register cache into the card structure
109 * v0.14.8
110 * Apr 30 2001 Matt Wu
111 * Set EBUF1 and EBUF2 to still mode
112 * Add dc97/ac97 reset function
113 * Fix power management: ali_restore_regs
114 * unreleased
115 * Mar 09 2001 Matt Wu
116 * Add cache for ac97 access
117 * v0.14.7
118 * Feb 06 2001 Matt Wu
119 * Fix ac97 initialization
120 * Fix bug: an extra tail will be played when playing
121 * Jan 05 2001 Matt Wu
122 * Implement multi-channels and S/PDIF in support for ALi 1535+
123 * v0.14.6
124 * Nov 1 2000 Ching-Ling Lee
125 * Fix the bug of memory leak when switching 5.1-channels to 2 channels.
126 * Add lock protection into dynamic changing format of data.
127 * Oct 18 2000 Ching-Ling Lee
128 * 5.1-channels support for ALi
129 * June 28 2000 Ching-Ling Lee
130 * S/PDIF out/in(playback/record) support for ALi 1535+, using /proc to be selected by user
131 * Simple Power Management support for ALi
132 * v0.14.5 May 23 2000 Ollie Lho
133 * Misc bug fix from the Net
134 * v0.14.4 May 20 2000 Aaron Holtzman
135 * Fix kfree'd memory access in release
136 * Fix race in open while looking for a free virtual channel slot
137 * remove open_wait wq (which appears to be unused)
138 * v0.14.3 May 10 2000 Ollie Lho
139 * fixed a small bug in trident_update_ptr, xmms 1.0.1 no longer uses 100% CPU
140 * v0.14.2 Mar 29 2000 Ching-Ling Lee
141 * Add clear to silence advance in trident_update_ptr
142 * fix invalid data of the end of the sound
143 * v0.14.1 Mar 24 2000 Ching-Ling Lee
144 * ALi 5451 support added, playback and recording O.K.
145 * ALi 5451 originally developed and structured based on sonicvibes, and
146 * suggested to merge into this file by Alan Cox.
147 * v0.14 Mar 15 2000 Ollie Lho
148 * 5.1 channel output support with channel binding. What's the Matrix ?
149 * v0.13.1 Mar 10 2000 Ollie Lho
150 * few minor bugs on dual codec support, needs more testing
151 * v0.13 Mar 03 2000 Ollie Lho
152 * new pci_* for 2.4 kernel, back ported to 2.2
153 * v0.12 Feb 23 2000 Ollie Lho
154 * Preliminary Recording support
155 * v0.11.2 Feb 19 2000 Ollie Lho
156 * removed incomplete full-dulplex support
157 * v0.11.1 Jan 28 2000 Ollie Lho
158 * small bug in setting sample rate for 4d-nx (reported by Aaron)
159 * v0.11 Jan 27 2000 Ollie Lho
160 * DMA bug, scheduler latency, second try
161 * v0.10 Jan 24 2000 Ollie Lho
162 * DMA bug fixed, found kernel scheduling problem
163 * v0.09 Jan 20 2000 Ollie Lho
164 * Clean up of channel register access routine (prepare for channel binding)
165 * v0.08 Jan 14 2000 Ollie Lho
166 * Isolation of AC97 codec code
167 * v0.07 Jan 13 2000 Ollie Lho
168 * Get rid of ugly old low level access routines (e.g. CHRegs.lp****)
169 * v0.06 Jan 11 2000 Ollie Lho
170 * Preliminary support for dual (more ?) AC97 codecs
171 * v0.05 Jan 08 2000 Luca Montecchiani <m.luca@iname.com>
172 * adapt to 2.3.x new __setup/__init call
173 * v0.04 Dec 31 1999 Ollie Lho
174 * Multiple Open, using Middle Loop Interrupt to smooth playback
175 * v0.03 Dec 24 1999 Ollie Lho
176 * mem leak in prog_dmabuf and dealloc_dmabuf removed
177 * v0.02 Dec 15 1999 Ollie Lho
178 * SiS 7018 support added, playback O.K.
179 * v0.01 Alan Cox et. al.
180 * Initial Release in kernel 2.3.30, does not work
182 * ToDo
183 * Clean up of low level channel register access code. (done)
184 * Fix the bug on dma buffer management in update_ptr, read/write, drain_dac (done)
185 * Dual AC97 codecs support (done)
186 * Recording support (done)
187 * Mmap support
188 * "Channel Binding" ioctl extension (done)
189 * new pci device driver interface for 2.4 kernel (done)
191 * Lock order (high->low)
192 * lock - hardware lock
193 * open_sem - guard opens
194 * sem - guard dmabuf, write re-entry etc
197 #include <linux/config.h>
198 #include <linux/module.h>
199 #include <linux/string.h>
200 #include <linux/ctype.h>
201 #include <linux/ioport.h>
202 #include <linux/sched.h>
203 #include <linux/delay.h>
204 #include <linux/sound.h>
205 #include <linux/slab.h>
206 #include <linux/soundcard.h>
207 #include <linux/pci.h>
208 #include <linux/init.h>
209 #include <linux/poll.h>
210 #include <linux/spinlock.h>
211 #include <linux/smp_lock.h>
212 #include <linux/ac97_codec.h>
213 #include <linux/bitops.h>
214 #include <linux/proc_fs.h>
215 #include <linux/interrupt.h>
216 #include <linux/pm.h>
217 #include <linux/gameport.h>
218 #include <linux/kernel.h>
219 #include <asm/uaccess.h>
220 #include <asm/io.h>
221 #include <asm/dma.h>
223 #if defined(CONFIG_ALPHA_NAUTILUS) || defined(CONFIG_ALPHA_GENERIC)
224 #include <asm/hwrpb.h>
225 #endif
227 #include "trident.h"
229 #define DRIVER_VERSION "0.14.10j-2.6"
231 /* magic numbers to protect our data structures */
232 #define TRIDENT_CARD_MAGIC 0x5072696E /* "Prin" */
233 #define TRIDENT_STATE_MAGIC 0x63657373 /* "cess" */
235 #define TRIDENT_DMA_MASK 0x3fffffff /* DMA buffer mask for pci_alloc_consist */
236 #define ALI_DMA_MASK 0x7fffffff /* ALI Tridents have 31-bit DMA. Wow. */
238 #define NR_HW_CH 32
240 /* maximum number of AC97 codecs connected, AC97 2.0 defined 4, but 7018 and 4D-NX only
241 have 2 SDATA_IN lines (currently) */
242 #define NR_AC97 2
244 /* minor number of /dev/swmodem (temporary, experimental) */
245 #define SND_DEV_SWMODEM 7
247 static const unsigned ali_multi_channels_5_1[] = {
248 /*ALI_SURR_LEFT_CHANNEL, ALI_SURR_RIGHT_CHANNEL, */
249 ALI_CENTER_CHANNEL,
250 ALI_LEF_CHANNEL,
251 ALI_SURR_LEFT_CHANNEL,
252 ALI_SURR_RIGHT_CHANNEL
255 static const unsigned sample_size[] = { 1, 2, 2, 4 };
256 static const unsigned sample_shift[] = { 0, 1, 1, 2 };
258 static const char invalid_magic[] = KERN_CRIT "trident: invalid magic value in %s\n";
260 enum {
261 TRIDENT_4D_DX = 0,
262 TRIDENT_4D_NX,
263 SIS_7018,
264 ALI_5451,
265 CYBER5050
268 static char *card_names[] = {
269 "Trident 4DWave DX",
270 "Trident 4DWave NX",
271 "SiS 7018 PCI Audio",
272 "ALi Audio Accelerator",
273 "Tvia/IGST CyberPro 5050"
276 static struct pci_device_id trident_pci_tbl[] = {
277 {PCI_VENDOR_ID_TRIDENT, PCI_DEVICE_ID_TRIDENT_4DWAVE_DX,
278 PCI_ANY_ID, PCI_ANY_ID, 0, 0, TRIDENT_4D_DX},
279 {PCI_VENDOR_ID_TRIDENT, PCI_DEVICE_ID_TRIDENT_4DWAVE_NX,
280 PCI_ANY_ID, PCI_ANY_ID, 0, 0, TRIDENT_4D_NX},
281 {PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_7018,
282 PCI_ANY_ID, PCI_ANY_ID, 0, 0, SIS_7018},
283 {PCI_VENDOR_ID_ALI, PCI_DEVICE_ID_ALI_5451,
284 PCI_ANY_ID, PCI_ANY_ID, 0, 0, ALI_5451},
285 {PCI_VENDOR_ID_INTERG, PCI_DEVICE_ID_INTERG_5050,
286 PCI_ANY_ID, PCI_ANY_ID, 0, 0, CYBER5050},
287 {0,}
290 MODULE_DEVICE_TABLE(pci, trident_pci_tbl);
292 /* "software" or virtual channel, an instance of opened /dev/dsp */
293 struct trident_state {
294 unsigned int magic;
295 struct trident_card *card; /* Card info */
297 /* file mode */
298 mode_t open_mode;
300 /* virtual channel number */
301 int virt;
303 struct dmabuf {
304 /* wave sample stuff */
305 unsigned int rate;
306 unsigned char fmt, enable;
308 /* hardware channel */
309 struct trident_channel *channel;
311 /* OSS buffer management stuff */
312 void *rawbuf;
313 dma_addr_t dma_handle;
314 unsigned buforder;
315 unsigned numfrag;
316 unsigned fragshift;
318 /* our buffer acts like a circular ring */
319 unsigned hwptr; /* where dma last started, updated by update_ptr */
320 unsigned swptr; /* where driver last clear/filled, updated by read/write */
321 int count; /* bytes to be comsumed or been generated by dma machine */
322 unsigned total_bytes; /* total bytes dmaed by hardware */
324 unsigned error; /* number of over/underruns */
325 /* put process on wait queue when no more space in buffer */
326 wait_queue_head_t wait;
328 /* redundant, but makes calculations easier */
329 unsigned fragsize;
330 unsigned dmasize;
331 unsigned fragsamples;
333 /* OSS stuff */
334 unsigned mapped:1;
335 unsigned ready:1;
336 unsigned endcleared:1;
337 unsigned update_flag;
338 unsigned ossfragshift;
339 int ossmaxfrags;
340 unsigned subdivision;
342 } dmabuf;
344 /* 5.1 channels */
345 struct trident_state *other_states[4];
346 int multi_channels_adjust_count;
347 unsigned chans_num;
348 unsigned long fmt_flag;
349 /* Guard against mmap/write/read races */
350 struct semaphore sem;
354 /* hardware channels */
355 struct trident_channel {
356 int num; /* channel number */
357 u32 lba; /* Loop Begine Address, where dma buffer starts */
358 u32 eso; /* End Sample Offset, wehre dma buffer ends */
359 /* (in the unit of samples) */
360 u32 delta; /* delta value, sample rate / 48k for playback, */
361 /* 48k/sample rate for recording */
362 u16 attribute; /* control where PCM data go and come */
363 u16 fm_vol;
364 u32 control; /* signed/unsigned, 8/16 bits, mono/stereo */
367 struct trident_pcm_bank_address {
368 u32 start;
369 u32 stop;
370 u32 aint;
371 u32 aint_en;
374 static struct trident_pcm_bank_address bank_a_addrs = {
375 T4D_START_A,
376 T4D_STOP_A,
377 T4D_AINT_A,
378 T4D_AINTEN_A
381 static struct trident_pcm_bank_address bank_b_addrs = {
382 T4D_START_B,
383 T4D_STOP_B,
384 T4D_AINT_B,
385 T4D_AINTEN_B
388 struct trident_pcm_bank {
389 /* register addresses to control bank operations */
390 struct trident_pcm_bank_address *addresses;
391 /* each bank has 32 channels */
392 u32 bitmap; /* channel allocation bitmap */
393 struct trident_channel channels[32];
396 struct trident_card {
397 unsigned int magic;
399 /* We keep trident cards in a linked list */
400 struct trident_card *next;
402 /* single open lock mechanism, only used for recording */
403 struct semaphore open_sem;
405 /* The trident has a certain amount of cross channel interaction
406 so we use a single per card lock */
407 spinlock_t lock;
409 /* PCI device stuff */
410 struct pci_dev *pci_dev;
411 u16 pci_id;
412 u8 revision;
414 /* soundcore stuff */
415 int dev_audio;
417 /* structures for abstraction of hardware facilities, codecs, */
418 /* banks and channels */
419 struct ac97_codec *ac97_codec[NR_AC97];
420 struct trident_pcm_bank banks[NR_BANKS];
421 struct trident_state *states[NR_HW_CH];
423 /* hardware resources */
424 unsigned long iobase;
425 u32 irq;
427 /* Function support */
428 struct trident_channel *(*alloc_pcm_channel) (struct trident_card *);
429 struct trident_channel *(*alloc_rec_pcm_channel) (struct trident_card *);
430 void (*free_pcm_channel) (struct trident_card *, unsigned int chan);
431 void (*address_interrupt) (struct trident_card *);
433 /* Added by Matt Wu 01-05-2001 for spdif in */
434 int multi_channel_use_count;
435 int rec_channel_use_count;
436 u16 mixer_regs[64][NR_AC97]; /* Made card local by Alan */
437 int mixer_regs_ready;
439 /* Added for hardware volume control */
440 int hwvolctl;
441 struct timer_list timer;
443 /* Game port support */
444 struct gameport *gameport;
447 enum dmabuf_mode {
448 DM_PLAYBACK = 0,
449 DM_RECORD
452 /* table to map from CHANNELMASK to channel attribute for SiS 7018 */
453 static u16 mask2attr[] = {
454 PCM_LR, PCM_LR, SURR_LR, CENTER_LFE,
455 HSET, MIC, MODEM_LINE1, MODEM_LINE2,
456 I2S_LR, SPDIF_LR
459 /* table to map from channel attribute to CHANNELMASK for SiS 7018 */
460 static int attr2mask[] = {
461 DSP_BIND_MODEM1, DSP_BIND_MODEM2, DSP_BIND_FRONT, DSP_BIND_HANDSET,
462 DSP_BIND_I2S, DSP_BIND_CENTER_LFE, DSP_BIND_SURR, DSP_BIND_SPDIF
465 /* Added by Matt Wu 01-05-2001 for spdif in */
466 static int ali_close_multi_channels(void);
467 static void ali_delay(struct trident_card *card, int interval);
468 static void ali_detect_spdif_rate(struct trident_card *card);
470 static void ali_ac97_write(struct ac97_codec *codec, u8 reg, u16 val);
471 static u16 ali_ac97_read(struct ac97_codec *codec, u8 reg);
473 static struct trident_card *devs;
475 static void trident_ac97_set(struct ac97_codec *codec, u8 reg, u16 val);
476 static u16 trident_ac97_get(struct ac97_codec *codec, u8 reg);
478 static int trident_open_mixdev(struct inode *inode, struct file *file);
479 static int trident_ioctl_mixdev(struct inode *inode, struct file *file,
480 unsigned int cmd, unsigned long arg);
482 static void ali_ac97_set(struct trident_card *card, int secondary, u8 reg, u16 val);
483 static u16 ali_ac97_get(struct trident_card *card, int secondary, u8 reg);
484 static void ali_set_spdif_out_rate(struct trident_card *card, unsigned int rate);
485 static void ali_enable_special_channel(struct trident_state *stat);
486 static struct trident_channel *ali_alloc_rec_pcm_channel(struct trident_card *card);
487 static struct trident_channel *ali_alloc_pcm_channel(struct trident_card *card);
488 static void ali_restore_regs(struct trident_card *card);
489 static void ali_save_regs(struct trident_card *card);
490 static int trident_suspend(struct pci_dev *dev, pm_message_t unused);
491 static int trident_resume(struct pci_dev *dev);
492 static void ali_free_pcm_channel(struct trident_card *card, unsigned int channel);
493 static int ali_setup_multi_channels(struct trident_card *card, int chan_nums);
494 static unsigned int ali_get_spdif_in_rate(struct trident_card *card);
495 static void ali_setup_spdif_in(struct trident_card *card);
496 static void ali_disable_spdif_in(struct trident_card *card);
497 static void ali_disable_special_channel(struct trident_card *card, int ch);
498 static void ali_setup_spdif_out(struct trident_card *card, int flag);
499 static int ali_write_5_1(struct trident_state *state,
500 const char __user *buffer,
501 int cnt_for_multi_channel, unsigned int *copy_count,
502 unsigned int *state_cnt);
503 static int ali_allocate_other_states_resources(struct trident_state *state,
504 int chan_nums);
505 static void ali_free_other_states_resources(struct trident_state *state);
507 /* save registers for ALi Power Management */
508 static struct ali_saved_registers {
509 unsigned long global_regs[ALI_GLOBAL_REGS];
510 unsigned long channel_regs[ALI_CHANNELS][ALI_CHANNEL_REGS];
511 unsigned mixer_regs[ALI_MIXER_REGS];
512 } ali_registers;
514 #define seek_offset(dma_ptr, buffer, cnt, offset, copy_count) do { \
515 (dma_ptr) += (offset); \
516 (buffer) += (offset); \
517 (cnt) -= (offset); \
518 (copy_count) += (offset); \
519 } while (0)
521 static inline int lock_set_fmt(struct trident_state* state)
523 if (test_and_set_bit(0, &state->fmt_flag))
524 return -EFAULT;
526 return 0;
529 static inline void unlock_set_fmt(struct trident_state* state)
531 clear_bit(0, &state->fmt_flag);
534 static int
535 trident_enable_loop_interrupts(struct trident_card *card)
537 u32 global_control;
539 global_control = inl(TRID_REG(card, T4D_LFO_GC_CIR));
541 switch (card->pci_id) {
542 case PCI_DEVICE_ID_SI_7018:
543 global_control |= (ENDLP_IE | MIDLP_IE | BANK_B_EN);
544 break;
545 case PCI_DEVICE_ID_ALI_5451:
546 case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
547 case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
548 case PCI_DEVICE_ID_INTERG_5050:
549 global_control |= (ENDLP_IE | MIDLP_IE);
550 break;
551 default:
552 return 0;
555 outl(global_control, TRID_REG(card, T4D_LFO_GC_CIR));
557 pr_debug("trident: Enable Loop Interrupts, globctl = 0x%08X\n",
558 inl(TRID_REG(card, T4D_LFO_GC_CIR)));
560 return 1;
563 static int
564 trident_disable_loop_interrupts(struct trident_card *card)
566 u32 global_control;
568 global_control = inl(TRID_REG(card, T4D_LFO_GC_CIR));
569 global_control &= ~(ENDLP_IE | MIDLP_IE);
570 outl(global_control, TRID_REG(card, T4D_LFO_GC_CIR));
572 pr_debug("trident: Disabled Loop Interrupts, globctl = 0x%08X\n",
573 global_control);
575 return 1;
578 static void
579 trident_enable_voice_irq(struct trident_card *card, unsigned int channel)
581 unsigned int mask = 1 << (channel & 0x1f);
582 struct trident_pcm_bank *bank = &card->banks[channel >> 5];
583 u32 reg, addr = bank->addresses->aint_en;
585 reg = inl(TRID_REG(card, addr));
586 reg |= mask;
587 outl(reg, TRID_REG(card, addr));
589 #ifdef DEBUG
590 reg = inl(TRID_REG(card, addr));
591 pr_debug("trident: enabled IRQ on channel %d, %s = 0x%08x(addr:%X)\n",
592 channel, addr == T4D_AINTEN_B ? "AINTEN_B" : "AINTEN_A",
593 reg, addr);
594 #endif /* DEBUG */
597 static void
598 trident_disable_voice_irq(struct trident_card *card, unsigned int channel)
600 unsigned int mask = 1 << (channel & 0x1f);
601 struct trident_pcm_bank *bank = &card->banks[channel >> 5];
602 u32 reg, addr = bank->addresses->aint_en;
604 reg = inl(TRID_REG(card, addr));
605 reg &= ~mask;
606 outl(reg, TRID_REG(card, addr));
608 /* Ack the channel in case the interrupt was set before we disable it. */
609 outl(mask, TRID_REG(card, bank->addresses->aint));
611 #ifdef DEBUG
612 reg = inl(TRID_REG(card, addr));
613 pr_debug("trident: disabled IRQ on channel %d, %s = 0x%08x(addr:%X)\n",
614 channel, addr == T4D_AINTEN_B ? "AINTEN_B" : "AINTEN_A",
615 reg, addr);
616 #endif /* DEBUG */
619 static void
620 trident_start_voice(struct trident_card *card, unsigned int channel)
622 unsigned int mask = 1 << (channel & 0x1f);
623 struct trident_pcm_bank *bank = &card->banks[channel >> 5];
624 u32 addr = bank->addresses->start;
626 #ifdef DEBUG
627 u32 reg;
628 #endif /* DEBUG */
630 outl(mask, TRID_REG(card, addr));
632 #ifdef DEBUG
633 reg = inl(TRID_REG(card, addr));
634 pr_debug("trident: start voice on channel %d, %s = 0x%08x(addr:%X)\n",
635 channel, addr == T4D_START_B ? "START_B" : "START_A",
636 reg, addr);
637 #endif /* DEBUG */
640 static void
641 trident_stop_voice(struct trident_card *card, unsigned int channel)
643 unsigned int mask = 1 << (channel & 0x1f);
644 struct trident_pcm_bank *bank = &card->banks[channel >> 5];
645 u32 addr = bank->addresses->stop;
647 #ifdef DEBUG
648 u32 reg;
649 #endif /* DEBUG */
651 outl(mask, TRID_REG(card, addr));
653 #ifdef DEBUG
654 reg = inl(TRID_REG(card, addr));
655 pr_debug("trident: stop voice on channel %d, %s = 0x%08x(addr:%X)\n",
656 channel, addr == T4D_STOP_B ? "STOP_B" : "STOP_A",
657 reg, addr);
658 #endif /* DEBUG */
661 static u32
662 trident_get_interrupt_mask(struct trident_card *card, unsigned int channel)
664 struct trident_pcm_bank *bank = &card->banks[channel];
665 u32 addr = bank->addresses->aint;
666 return inl(TRID_REG(card, addr));
669 static int
670 trident_check_channel_interrupt(struct trident_card *card, unsigned int channel)
672 unsigned int mask = 1 << (channel & 0x1f);
673 u32 reg = trident_get_interrupt_mask(card, channel >> 5);
675 #ifdef DEBUG
676 if (reg & mask)
677 pr_debug("trident: channel %d has interrupt, %s = 0x%08x\n",
678 channel, reg == T4D_AINT_B ? "AINT_B" : "AINT_A",
679 reg);
680 #endif /* DEBUG */
681 return (reg & mask) ? 1 : 0;
684 static void
685 trident_ack_channel_interrupt(struct trident_card *card, unsigned int channel)
687 unsigned int mask = 1 << (channel & 0x1f);
688 struct trident_pcm_bank *bank = &card->banks[channel >> 5];
689 u32 reg, addr = bank->addresses->aint;
691 reg = inl(TRID_REG(card, addr));
692 reg &= mask;
693 outl(reg, TRID_REG(card, addr));
695 #ifdef DEBUG
696 reg = inl(TRID_REG(card, T4D_AINT_B));
697 pr_debug("trident: Ack channel %d interrupt, AINT_B = 0x%08x\n",
698 channel, reg);
699 #endif /* DEBUG */
702 static struct trident_channel *
703 trident_alloc_pcm_channel(struct trident_card *card)
705 struct trident_pcm_bank *bank;
706 int idx;
708 bank = &card->banks[BANK_B];
710 for (idx = 31; idx >= 0; idx--) {
711 if (!(bank->bitmap & (1 << idx))) {
712 struct trident_channel *channel = &bank->channels[idx];
713 bank->bitmap |= 1 << idx;
714 channel->num = idx + 32;
715 return channel;
719 /* no more free channels available */
720 printk(KERN_ERR "trident: no more channels available on Bank B.\n");
721 return NULL;
724 static void
725 trident_free_pcm_channel(struct trident_card *card, unsigned int channel)
727 int bank;
728 unsigned char b;
730 if (channel < 31 || channel > 63)
731 return;
733 if (card->pci_id == PCI_DEVICE_ID_TRIDENT_4DWAVE_DX ||
734 card->pci_id == PCI_DEVICE_ID_TRIDENT_4DWAVE_NX) {
735 b = inb(TRID_REG(card, T4D_REC_CH));
736 if ((b & ~0x80) == channel)
737 outb(0x0, TRID_REG(card, T4D_REC_CH));
740 bank = channel >> 5;
741 channel = channel & 0x1f;
743 card->banks[bank].bitmap &= ~(1 << (channel));
746 static struct trident_channel *
747 cyber_alloc_pcm_channel(struct trident_card *card)
749 struct trident_pcm_bank *bank;
750 int idx;
752 /* The cyberpro 5050 has only 32 voices and one bank */
753 /* .. at least they are not documented (if you want to call that
754 * crap documentation), perhaps broken ? */
756 bank = &card->banks[BANK_A];
758 for (idx = 31; idx >= 0; idx--) {
759 if (!(bank->bitmap & (1 << idx))) {
760 struct trident_channel *channel = &bank->channels[idx];
761 bank->bitmap |= 1 << idx;
762 channel->num = idx;
763 return channel;
767 /* no more free channels available */
768 printk(KERN_ERR "cyberpro5050: no more channels available on Bank A.\n");
769 return NULL;
772 static void
773 cyber_free_pcm_channel(struct trident_card *card, unsigned int channel)
775 if (channel > 31)
776 return;
777 card->banks[BANK_A].bitmap &= ~(1 << (channel));
780 static inline void
781 cyber_outidx(int port, int idx, int data)
783 outb(idx, port);
784 outb(data, port + 1);
787 static inline int
788 cyber_inidx(int port, int idx)
790 outb(idx, port);
791 return inb(port + 1);
794 static int
795 cyber_init_ritual(struct trident_card *card)
797 /* some black magic, taken from SDK samples */
798 /* remove this and nothing will work */
799 int portDat;
800 int ret = 0;
801 unsigned long flags;
804 * Keep interrupts off for the configure - we don't want to
805 * clash with another cyberpro config event
808 spin_lock_irqsave(&card->lock, flags);
809 portDat = cyber_inidx(CYBER_PORT_AUDIO, CYBER_IDX_AUDIO_ENABLE);
810 /* enable, if it was disabled */
811 if ((portDat & CYBER_BMSK_AUENZ) != CYBER_BMSK_AUENZ_ENABLE) {
812 printk(KERN_INFO "cyberpro5050: enabling audio controller\n");
813 cyber_outidx(CYBER_PORT_AUDIO, CYBER_IDX_AUDIO_ENABLE,
814 portDat | CYBER_BMSK_AUENZ_ENABLE);
815 /* check again if hardware is enabled now */
816 portDat = cyber_inidx(CYBER_PORT_AUDIO, CYBER_IDX_AUDIO_ENABLE);
818 if ((portDat & CYBER_BMSK_AUENZ) != CYBER_BMSK_AUENZ_ENABLE) {
819 printk(KERN_ERR "cyberpro5050: initAudioAccess: no success\n");
820 ret = -1;
821 } else {
822 cyber_outidx(CYBER_PORT_AUDIO, CYBER_IDX_IRQ_ENABLE,
823 CYBER_BMSK_AUDIO_INT_ENABLE);
824 cyber_outidx(CYBER_PORT_AUDIO, 0xbf, 0x01);
825 cyber_outidx(CYBER_PORT_AUDIO, 0xba, 0x20);
826 cyber_outidx(CYBER_PORT_AUDIO, 0xbb, 0x08);
827 cyber_outidx(CYBER_PORT_AUDIO, 0xbf, 0x02);
828 cyber_outidx(CYBER_PORT_AUDIO, 0xb3, 0x06);
829 cyber_outidx(CYBER_PORT_AUDIO, 0xbf, 0x00);
831 spin_unlock_irqrestore(&card->lock, flags);
832 return ret;
835 /* called with spin lock held */
837 static int
838 trident_load_channel_registers(struct trident_card *card, u32 * data,
839 unsigned int channel)
841 int i;
843 if (channel > 63)
844 return 0;
846 /* select hardware channel to write */
847 outb(channel, TRID_REG(card, T4D_LFO_GC_CIR));
849 /* Output the channel registers, but don't write register
850 three to an ALI chip. */
851 for (i = 0; i < CHANNEL_REGS; i++) {
852 if (i == 3 && card->pci_id == PCI_DEVICE_ID_ALI_5451)
853 continue;
854 outl(data[i], TRID_REG(card, CHANNEL_START + 4 * i));
856 if (card->pci_id == PCI_DEVICE_ID_ALI_5451 ||
857 card->pci_id == PCI_DEVICE_ID_INTERG_5050) {
858 outl(ALI_EMOD_Still, TRID_REG(card, ALI_EBUF1));
859 outl(ALI_EMOD_Still, TRID_REG(card, ALI_EBUF2));
861 return 1;
864 /* called with spin lock held */
865 static int
866 trident_write_voice_regs(struct trident_state *state)
868 unsigned int data[CHANNEL_REGS + 1];
869 struct trident_channel *channel;
871 channel = state->dmabuf.channel;
873 data[1] = channel->lba;
874 data[4] = channel->control;
876 switch (state->card->pci_id) {
877 case PCI_DEVICE_ID_ALI_5451:
878 data[0] = 0; /* Current Sample Offset */
879 data[2] = (channel->eso << 16) | (channel->delta & 0xffff);
880 data[3] = 0;
881 break;
882 case PCI_DEVICE_ID_SI_7018:
883 case PCI_DEVICE_ID_INTERG_5050:
884 data[0] = 0; /* Current Sample Offset */
885 data[2] = (channel->eso << 16) | (channel->delta & 0xffff);
886 data[3] = (channel->attribute << 16) | (channel->fm_vol & 0xffff);
887 break;
888 case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
889 data[0] = 0; /* Current Sample Offset */
890 data[2] = (channel->eso << 16) | (channel->delta & 0xffff);
891 data[3] = channel->fm_vol & 0xffff;
892 break;
893 case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
894 data[0] = (channel->delta << 24);
895 data[2] = ((channel->delta << 16) & 0xff000000) |
896 (channel->eso & 0x00ffffff);
897 data[3] = channel->fm_vol & 0xffff;
898 break;
899 default:
900 return 0;
903 return trident_load_channel_registers(state->card, data, channel->num);
906 static int
907 compute_rate_play(u32 rate)
909 int delta;
910 /* We special case 44100 and 8000 since rounding with the equation
911 does not give us an accurate enough value. For 11025 and 22050
912 the equation gives us the best answer. All other frequencies will
913 also use the equation. JDW */
914 if (rate == 44100)
915 delta = 0xeb3;
916 else if (rate == 8000)
917 delta = 0x2ab;
918 else if (rate == 48000)
919 delta = 0x1000;
920 else
921 delta = (((rate << 12) + rate) / 48000) & 0x0000ffff;
922 return delta;
925 static int
926 compute_rate_rec(u32 rate)
928 int delta;
930 if (rate == 44100)
931 delta = 0x116a;
932 else if (rate == 8000)
933 delta = 0x6000;
934 else if (rate == 48000)
935 delta = 0x1000;
936 else
937 delta = ((48000 << 12) / rate) & 0x0000ffff;
939 return delta;
942 /* set playback sample rate */
943 static unsigned int
944 trident_set_dac_rate(struct trident_state *state, unsigned int rate)
946 struct dmabuf *dmabuf = &state->dmabuf;
948 if (rate > 48000)
949 rate = 48000;
950 if (rate < 4000)
951 rate = 4000;
953 dmabuf->rate = rate;
954 dmabuf->channel->delta = compute_rate_play(rate);
956 trident_write_voice_regs(state);
958 pr_debug("trident: called trident_set_dac_rate : rate = %d\n", rate);
960 return rate;
963 /* set recording sample rate */
964 static unsigned int
965 trident_set_adc_rate(struct trident_state *state, unsigned int rate)
967 struct dmabuf *dmabuf = &state->dmabuf;
969 if (rate > 48000)
970 rate = 48000;
971 if (rate < 4000)
972 rate = 4000;
974 dmabuf->rate = rate;
975 dmabuf->channel->delta = compute_rate_rec(rate);
977 trident_write_voice_regs(state);
979 pr_debug("trident: called trident_set_adc_rate : rate = %d\n", rate);
981 return rate;
984 /* prepare channel attributes for playback */
985 static void
986 trident_play_setup(struct trident_state *state)
988 struct dmabuf *dmabuf = &state->dmabuf;
989 struct trident_channel *channel = dmabuf->channel;
991 channel->lba = dmabuf->dma_handle;
992 channel->delta = compute_rate_play(dmabuf->rate);
994 channel->eso = dmabuf->dmasize >> sample_shift[dmabuf->fmt];
995 channel->eso -= 1;
997 if (state->card->pci_id != PCI_DEVICE_ID_SI_7018) {
998 channel->attribute = 0;
999 if (state->card->pci_id == PCI_DEVICE_ID_ALI_5451) {
1000 if ((channel->num == ALI_SPDIF_IN_CHANNEL) ||
1001 (channel->num == ALI_PCM_IN_CHANNEL))
1002 ali_disable_special_channel(state->card, channel->num);
1003 else if ((inl(TRID_REG(state->card, ALI_GLOBAL_CONTROL))
1004 & ALI_SPDIF_OUT_CH_ENABLE)
1005 && (channel->num == ALI_SPDIF_OUT_CHANNEL)) {
1006 ali_set_spdif_out_rate(state->card,
1007 state->dmabuf.rate);
1008 state->dmabuf.channel->delta = 0x1000;
1013 channel->fm_vol = 0x0;
1015 channel->control = CHANNEL_LOOP;
1016 if (dmabuf->fmt & TRIDENT_FMT_16BIT) {
1017 /* 16-bits */
1018 channel->control |= CHANNEL_16BITS;
1019 /* signed */
1020 channel->control |= CHANNEL_SIGNED;
1022 if (dmabuf->fmt & TRIDENT_FMT_STEREO)
1023 /* stereo */
1024 channel->control |= CHANNEL_STEREO;
1026 pr_debug("trident: trident_play_setup, LBA = 0x%08x, Delta = 0x%08x, "
1027 "ESO = 0x%08x, Control = 0x%08x\n", channel->lba,
1028 channel->delta, channel->eso, channel->control);
1030 trident_write_voice_regs(state);
1033 /* prepare channel attributes for recording */
1034 static void
1035 trident_rec_setup(struct trident_state *state)
1037 u16 w;
1038 u8 bval;
1040 struct trident_card *card = state->card;
1041 struct dmabuf *dmabuf = &state->dmabuf;
1042 struct trident_channel *channel = dmabuf->channel;
1043 unsigned int rate;
1045 /* Enable AC-97 ADC (capture) */
1046 switch (card->pci_id) {
1047 case PCI_DEVICE_ID_ALI_5451:
1048 ali_enable_special_channel(state);
1049 break;
1050 case PCI_DEVICE_ID_SI_7018:
1051 /* for 7018, the ac97 is always in playback/record (duplex) mode */
1052 break;
1053 case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
1054 w = inb(TRID_REG(card, DX_ACR2_AC97_COM_STAT));
1055 outb(w | 0x48, TRID_REG(card, DX_ACR2_AC97_COM_STAT));
1056 /* enable and set record channel */
1057 outb(0x80 | channel->num, TRID_REG(card, T4D_REC_CH));
1058 break;
1059 case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
1060 w = inw(TRID_REG(card, T4D_MISCINT));
1061 outw(w | 0x1000, TRID_REG(card, T4D_MISCINT));
1062 /* enable and set record channel */
1063 outb(0x80 | channel->num, TRID_REG(card, T4D_REC_CH));
1064 break;
1065 case PCI_DEVICE_ID_INTERG_5050:
1066 /* don't know yet, using special channel 22 in GC1(0xd4)? */
1067 break;
1068 default:
1069 return;
1072 channel->lba = dmabuf->dma_handle;
1073 channel->delta = compute_rate_rec(dmabuf->rate);
1074 if ((card->pci_id == PCI_DEVICE_ID_ALI_5451) &&
1075 (channel->num == ALI_SPDIF_IN_CHANNEL)) {
1076 rate = ali_get_spdif_in_rate(card);
1077 if (rate == 0) {
1078 printk(KERN_WARNING "trident: ALi 5451 "
1079 "S/PDIF input setup error!\n");
1080 rate = 48000;
1082 bval = inb(TRID_REG(card, ALI_SPDIF_CTRL));
1083 if (bval & 0x10) {
1084 outb(bval, TRID_REG(card, ALI_SPDIF_CTRL));
1085 printk(KERN_WARNING "trident: cleared ALi "
1086 "5451 S/PDIF parity error flag.\n");
1089 if (rate != 48000)
1090 channel->delta = ((rate << 12) / dmabuf->rate) & 0x0000ffff;
1093 channel->eso = dmabuf->dmasize >> sample_shift[dmabuf->fmt];
1094 channel->eso -= 1;
1096 if (state->card->pci_id != PCI_DEVICE_ID_SI_7018) {
1097 channel->attribute = 0;
1100 channel->fm_vol = 0x0;
1102 channel->control = CHANNEL_LOOP;
1103 if (dmabuf->fmt & TRIDENT_FMT_16BIT) {
1104 /* 16-bits */
1105 channel->control |= CHANNEL_16BITS;
1106 /* signed */
1107 channel->control |= CHANNEL_SIGNED;
1109 if (dmabuf->fmt & TRIDENT_FMT_STEREO)
1110 /* stereo */
1111 channel->control |= CHANNEL_STEREO;
1113 pr_debug("trident: trident_rec_setup, LBA = 0x%08x, Delat = 0x%08x, "
1114 "ESO = 0x%08x, Control = 0x%08x\n", channel->lba,
1115 channel->delta, channel->eso, channel->control);
1117 trident_write_voice_regs(state);
1120 /* get current playback/recording dma buffer pointer (byte offset from LBA),
1121 called with spinlock held! */
1122 static inline unsigned
1123 trident_get_dma_addr(struct trident_state *state)
1125 struct dmabuf *dmabuf = &state->dmabuf;
1126 u32 cso;
1128 if (!dmabuf->enable)
1129 return 0;
1131 outb(dmabuf->channel->num, TRID_REG(state->card, T4D_LFO_GC_CIR));
1133 switch (state->card->pci_id) {
1134 case PCI_DEVICE_ID_ALI_5451:
1135 case PCI_DEVICE_ID_SI_7018:
1136 case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
1137 case PCI_DEVICE_ID_INTERG_5050:
1138 /* 16 bits ESO, CSO for 7018 and DX */
1139 cso = inw(TRID_REG(state->card, CH_DX_CSO_ALPHA_FMS + 2));
1140 break;
1141 case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
1142 /* 24 bits ESO, CSO for NX */
1143 cso = inl(TRID_REG(state->card, CH_NX_DELTA_CSO)) & 0x00ffffff;
1144 break;
1145 default:
1146 return 0;
1149 pr_debug("trident: trident_get_dma_addr: chip reported channel: %d, "
1150 "cso = 0x%04x\n", dmabuf->channel->num, cso);
1152 /* ESO and CSO are in units of Samples, convert to byte offset */
1153 cso <<= sample_shift[dmabuf->fmt];
1155 return (cso % dmabuf->dmasize);
1158 /* Stop recording (lock held) */
1159 static inline void
1160 __stop_adc(struct trident_state *state)
1162 struct dmabuf *dmabuf = &state->dmabuf;
1163 unsigned int chan_num = dmabuf->channel->num;
1164 struct trident_card *card = state->card;
1166 dmabuf->enable &= ~ADC_RUNNING;
1167 trident_stop_voice(card, chan_num);
1168 trident_disable_voice_irq(card, chan_num);
1171 static void
1172 stop_adc(struct trident_state *state)
1174 struct trident_card *card = state->card;
1175 unsigned long flags;
1177 spin_lock_irqsave(&card->lock, flags);
1178 __stop_adc(state);
1179 spin_unlock_irqrestore(&card->lock, flags);
1182 static void
1183 start_adc(struct trident_state *state)
1185 struct dmabuf *dmabuf = &state->dmabuf;
1186 unsigned int chan_num = dmabuf->channel->num;
1187 struct trident_card *card = state->card;
1188 unsigned long flags;
1190 spin_lock_irqsave(&card->lock, flags);
1191 if ((dmabuf->mapped ||
1192 dmabuf->count < (signed) dmabuf->dmasize) &&
1193 dmabuf->ready) {
1194 dmabuf->enable |= ADC_RUNNING;
1195 trident_enable_voice_irq(card, chan_num);
1196 trident_start_voice(card, chan_num);
1198 spin_unlock_irqrestore(&card->lock, flags);
1201 /* stop playback (lock held) */
1202 static inline void
1203 __stop_dac(struct trident_state *state)
1205 struct dmabuf *dmabuf = &state->dmabuf;
1206 unsigned int chan_num = dmabuf->channel->num;
1207 struct trident_card *card = state->card;
1209 dmabuf->enable &= ~DAC_RUNNING;
1210 trident_stop_voice(card, chan_num);
1211 if (state->chans_num == 6) {
1212 trident_stop_voice(card, state->other_states[0]->
1213 dmabuf.channel->num);
1214 trident_stop_voice(card, state->other_states[1]->
1215 dmabuf.channel->num);
1216 trident_stop_voice(card, state->other_states[2]->
1217 dmabuf.channel->num);
1218 trident_stop_voice(card, state->other_states[3]->
1219 dmabuf.channel->num);
1221 trident_disable_voice_irq(card, chan_num);
1224 static void
1225 stop_dac(struct trident_state *state)
1227 struct trident_card *card = state->card;
1228 unsigned long flags;
1230 spin_lock_irqsave(&card->lock, flags);
1231 __stop_dac(state);
1232 spin_unlock_irqrestore(&card->lock, flags);
1235 static void
1236 start_dac(struct trident_state *state)
1238 struct dmabuf *dmabuf = &state->dmabuf;
1239 unsigned int chan_num = dmabuf->channel->num;
1240 struct trident_card *card = state->card;
1241 unsigned long flags;
1243 spin_lock_irqsave(&card->lock, flags);
1244 if ((dmabuf->mapped || dmabuf->count > 0) && dmabuf->ready) {
1245 dmabuf->enable |= DAC_RUNNING;
1246 trident_enable_voice_irq(card, chan_num);
1247 trident_start_voice(card, chan_num);
1248 if (state->chans_num == 6) {
1249 trident_start_voice(card, state->other_states[0]->
1250 dmabuf.channel->num);
1251 trident_start_voice(card, state->other_states[1]->
1252 dmabuf.channel->num);
1253 trident_start_voice(card, state->other_states[2]->
1254 dmabuf.channel->num);
1255 trident_start_voice(card, state->other_states[3]->
1256 dmabuf.channel->num);
1259 spin_unlock_irqrestore(&card->lock, flags);
1262 #define DMABUF_DEFAULTORDER (15-PAGE_SHIFT)
1263 #define DMABUF_MINORDER 1
1265 /* alloc a DMA buffer of with a buffer of this order */
1266 static int
1267 alloc_dmabuf(struct dmabuf *dmabuf, struct pci_dev *pci_dev, int order)
1269 void *rawbuf = NULL;
1270 struct page *page, *pend;
1272 if (!(rawbuf = pci_alloc_consistent(pci_dev, PAGE_SIZE << order,
1273 &dmabuf->dma_handle)))
1274 return -ENOMEM;
1276 pr_debug("trident: allocated %ld (order = %d) bytes at %p\n",
1277 PAGE_SIZE << order, order, rawbuf);
1279 dmabuf->ready = dmabuf->mapped = 0;
1280 dmabuf->rawbuf = rawbuf;
1281 dmabuf->buforder = order;
1283 /* now mark the pages as reserved; otherwise */
1284 /* remap_pfn_range doesn't do what we want */
1285 pend = virt_to_page(rawbuf + (PAGE_SIZE << order) - 1);
1286 for (page = virt_to_page(rawbuf); page <= pend; page++)
1287 SetPageReserved(page);
1289 return 0;
1292 /* allocate the main DMA buffer, playback and recording buffer should be */
1293 /* allocated separately */
1294 static int
1295 alloc_main_dmabuf(struct trident_state *state)
1297 struct dmabuf *dmabuf = &state->dmabuf;
1298 int order;
1299 int ret = -ENOMEM;
1301 /* alloc as big a chunk as we can, FIXME: is this necessary ?? */
1302 for (order = DMABUF_DEFAULTORDER; order >= DMABUF_MINORDER; order--) {
1303 if (!(ret = alloc_dmabuf(dmabuf, state->card->pci_dev, order)))
1304 return 0;
1305 /* else try again */
1307 return ret;
1310 /* deallocate a DMA buffer */
1311 static void
1312 dealloc_dmabuf(struct dmabuf *dmabuf, struct pci_dev *pci_dev)
1314 struct page *page, *pend;
1316 if (dmabuf->rawbuf) {
1317 /* undo marking the pages as reserved */
1318 pend = virt_to_page(dmabuf->rawbuf + (PAGE_SIZE << dmabuf->buforder) - 1);
1319 for (page = virt_to_page(dmabuf->rawbuf); page <= pend; page++)
1320 ClearPageReserved(page);
1321 pci_free_consistent(pci_dev, PAGE_SIZE << dmabuf->buforder,
1322 dmabuf->rawbuf, dmabuf->dma_handle);
1323 dmabuf->rawbuf = NULL;
1325 dmabuf->mapped = dmabuf->ready = 0;
1328 static int
1329 prog_dmabuf(struct trident_state *state, enum dmabuf_mode rec)
1331 struct dmabuf *dmabuf = &state->dmabuf;
1332 unsigned bytepersec;
1333 struct trident_state *s = state;
1334 unsigned bufsize, dma_nums;
1335 unsigned long flags;
1336 int ret, i, order;
1338 if ((ret = lock_set_fmt(state)) < 0)
1339 return ret;
1341 if (state->chans_num == 6)
1342 dma_nums = 5;
1343 else
1344 dma_nums = 1;
1346 for (i = 0; i < dma_nums; i++) {
1347 if (i > 0) {
1348 s = state->other_states[i - 1];
1349 dmabuf = &s->dmabuf;
1350 dmabuf->fmt = state->dmabuf.fmt;
1351 dmabuf->rate = state->dmabuf.rate;
1354 spin_lock_irqsave(&s->card->lock, flags);
1355 dmabuf->hwptr = dmabuf->swptr = dmabuf->total_bytes = 0;
1356 dmabuf->count = dmabuf->error = 0;
1357 spin_unlock_irqrestore(&s->card->lock, flags);
1359 /* allocate DMA buffer if not allocated yet */
1360 if (!dmabuf->rawbuf) {
1361 if (i == 0) {
1362 if ((ret = alloc_main_dmabuf(state))) {
1363 unlock_set_fmt(state);
1364 return ret;
1366 } else {
1367 ret = -ENOMEM;
1368 order = state->dmabuf.buforder - 1;
1369 if (order >= DMABUF_MINORDER) {
1370 ret = alloc_dmabuf(dmabuf,
1371 state->card->pci_dev,
1372 order);
1374 if (ret) {
1375 /* release the main DMA buffer */
1376 dealloc_dmabuf(&state->dmabuf, state->card->pci_dev);
1377 /* release the auxiliary DMA buffers */
1378 for (i -= 2; i >= 0; i--)
1379 dealloc_dmabuf(&state->other_states[i]->dmabuf,
1380 state->card->pci_dev);
1381 unlock_set_fmt(state);
1382 return ret;
1386 /* FIXME: figure out all this OSS fragment stuff */
1387 bytepersec = dmabuf->rate << sample_shift[dmabuf->fmt];
1388 bufsize = PAGE_SIZE << dmabuf->buforder;
1389 if (dmabuf->ossfragshift) {
1390 if ((1000 << dmabuf->ossfragshift) < bytepersec)
1391 dmabuf->fragshift = ld2(bytepersec / 1000);
1392 else
1393 dmabuf->fragshift = dmabuf->ossfragshift;
1394 } else {
1395 /* lets hand out reasonable big ass buffers by default */
1396 dmabuf->fragshift = (dmabuf->buforder + PAGE_SHIFT - 2);
1398 dmabuf->numfrag = bufsize >> dmabuf->fragshift;
1399 while (dmabuf->numfrag < 4 && dmabuf->fragshift > 3) {
1400 dmabuf->fragshift--;
1401 dmabuf->numfrag = bufsize >> dmabuf->fragshift;
1403 dmabuf->fragsize = 1 << dmabuf->fragshift;
1404 if (dmabuf->ossmaxfrags >= 4 && dmabuf->ossmaxfrags < dmabuf->numfrag)
1405 dmabuf->numfrag = dmabuf->ossmaxfrags;
1406 dmabuf->fragsamples = dmabuf->fragsize >> sample_shift[dmabuf->fmt];
1407 dmabuf->dmasize = dmabuf->numfrag << dmabuf->fragshift;
1409 memset(dmabuf->rawbuf, (dmabuf->fmt & TRIDENT_FMT_16BIT) ? 0 : 0x80,
1410 dmabuf->dmasize);
1412 spin_lock_irqsave(&s->card->lock, flags);
1413 if (rec == DM_RECORD)
1414 trident_rec_setup(s);
1415 else /* DM_PLAYBACK */
1416 trident_play_setup(s);
1418 spin_unlock_irqrestore(&s->card->lock, flags);
1420 /* set the ready flag for the dma buffer */
1421 dmabuf->ready = 1;
1423 pr_debug("trident: prog_dmabuf(%d), sample rate = %d, "
1424 "format = %d, numfrag = %d, fragsize = %d "
1425 "dmasize = %d\n", dmabuf->channel->num,
1426 dmabuf->rate, dmabuf->fmt, dmabuf->numfrag,
1427 dmabuf->fragsize, dmabuf->dmasize);
1429 unlock_set_fmt(state);
1430 return 0;
1434 static inline int prog_dmabuf_record(struct trident_state* state)
1436 return prog_dmabuf(state, DM_RECORD);
1439 static inline int prog_dmabuf_playback(struct trident_state* state)
1441 return prog_dmabuf(state, DM_PLAYBACK);
1444 /* we are doing quantum mechanics here, the buffer can only be empty, half or full filled i.e.
1445 |------------|------------| or |xxxxxxxxxxxx|------------| or |xxxxxxxxxxxx|xxxxxxxxxxxx|
1446 but we almost always get this
1447 |xxxxxx------|------------| or |xxxxxxxxxxxx|xxxxx-------|
1448 so we have to clear the tail space to "silence"
1449 |xxxxxx000000|------------| or |xxxxxxxxxxxx|xxxxxx000000|
1451 static void
1452 trident_clear_tail(struct trident_state *state)
1454 struct dmabuf *dmabuf = &state->dmabuf;
1455 unsigned swptr;
1456 unsigned char silence = (dmabuf->fmt & TRIDENT_FMT_16BIT) ? 0 : 0x80;
1457 unsigned int len;
1458 unsigned long flags;
1460 spin_lock_irqsave(&state->card->lock, flags);
1461 swptr = dmabuf->swptr;
1462 spin_unlock_irqrestore(&state->card->lock, flags);
1464 if (swptr == 0 || swptr == dmabuf->dmasize / 2 ||
1465 swptr == dmabuf->dmasize)
1466 return;
1468 if (swptr < dmabuf->dmasize / 2)
1469 len = dmabuf->dmasize / 2 - swptr;
1470 else
1471 len = dmabuf->dmasize - swptr;
1473 memset(dmabuf->rawbuf + swptr, silence, len);
1474 if (state->card->pci_id != PCI_DEVICE_ID_ALI_5451) {
1475 spin_lock_irqsave(&state->card->lock, flags);
1476 dmabuf->swptr += len;
1477 dmabuf->count += len;
1478 spin_unlock_irqrestore(&state->card->lock, flags);
1481 /* restart the dma machine in case it is halted */
1482 start_dac(state);
1485 static int
1486 drain_dac(struct trident_state *state, int nonblock)
1488 DECLARE_WAITQUEUE(wait, current);
1489 struct dmabuf *dmabuf = &state->dmabuf;
1490 unsigned long flags;
1491 unsigned long tmo;
1492 int count;
1493 unsigned long diff = 0;
1495 if (dmabuf->mapped || !dmabuf->ready)
1496 return 0;
1498 add_wait_queue(&dmabuf->wait, &wait);
1499 for (;;) {
1500 /* It seems that we have to set the current state to TASK_INTERRUPTIBLE
1501 every time to make the process really go to sleep */
1502 set_current_state(TASK_INTERRUPTIBLE);
1504 spin_lock_irqsave(&state->card->lock, flags);
1505 count = dmabuf->count;
1506 spin_unlock_irqrestore(&state->card->lock, flags);
1508 if (count <= 0)
1509 break;
1511 if (signal_pending(current))
1512 break;
1514 if (nonblock) {
1515 remove_wait_queue(&dmabuf->wait, &wait);
1516 set_current_state(TASK_RUNNING);
1517 return -EBUSY;
1520 /* No matter how much data is left in the buffer, we have to wait until
1521 CSO == ESO/2 or CSO == ESO when address engine interrupts */
1522 if (state->card->pci_id == PCI_DEVICE_ID_ALI_5451 ||
1523 state->card->pci_id == PCI_DEVICE_ID_INTERG_5050) {
1524 diff = dmabuf->swptr - trident_get_dma_addr(state) + dmabuf->dmasize;
1525 diff = diff % (dmabuf->dmasize);
1526 tmo = (diff * HZ) / dmabuf->rate;
1527 } else {
1528 tmo = (dmabuf->dmasize * HZ) / dmabuf->rate;
1530 tmo >>= sample_shift[dmabuf->fmt];
1531 if (!schedule_timeout(tmo ? tmo : 1) && tmo) {
1532 break;
1535 remove_wait_queue(&dmabuf->wait, &wait);
1536 set_current_state(TASK_RUNNING);
1537 if (signal_pending(current))
1538 return -ERESTARTSYS;
1540 return 0;
1543 /* update buffer manangement pointers, especially, */
1544 /* dmabuf->count and dmabuf->hwptr */
1545 static void
1546 trident_update_ptr(struct trident_state *state)
1548 struct dmabuf *dmabuf = &state->dmabuf;
1549 unsigned hwptr, swptr;
1550 int clear_cnt = 0;
1551 int diff;
1552 unsigned char silence;
1553 unsigned half_dmasize;
1555 /* update hardware pointer */
1556 hwptr = trident_get_dma_addr(state);
1557 diff = (dmabuf->dmasize + hwptr - dmabuf->hwptr) % dmabuf->dmasize;
1558 dmabuf->hwptr = hwptr;
1559 dmabuf->total_bytes += diff;
1561 /* error handling and process wake up for ADC */
1562 if (dmabuf->enable == ADC_RUNNING) {
1563 if (dmabuf->mapped) {
1564 dmabuf->count -= diff;
1565 if (dmabuf->count >= (signed) dmabuf->fragsize)
1566 wake_up(&dmabuf->wait);
1567 } else {
1568 dmabuf->count += diff;
1570 if (dmabuf->count < 0 ||
1571 dmabuf->count > dmabuf->dmasize) {
1572 /* buffer underrun or buffer overrun, */
1573 /* we have no way to recover it here, just */
1574 /* stop the machine and let the process */
1575 /* force hwptr and swptr to sync */
1576 __stop_adc(state);
1577 dmabuf->error++;
1579 if (dmabuf->count < (signed) dmabuf->dmasize / 2)
1580 wake_up(&dmabuf->wait);
1584 /* error handling and process wake up for DAC */
1585 if (dmabuf->enable == DAC_RUNNING) {
1586 if (dmabuf->mapped) {
1587 dmabuf->count += diff;
1588 if (dmabuf->count >= (signed) dmabuf->fragsize)
1589 wake_up(&dmabuf->wait);
1590 } else {
1591 dmabuf->count -= diff;
1593 if (dmabuf->count < 0 ||
1594 dmabuf->count > dmabuf->dmasize) {
1595 /* buffer underrun or buffer overrun, we have no way to recover
1596 it here, just stop the machine and let the process force hwptr
1597 and swptr to sync */
1598 __stop_dac(state);
1599 dmabuf->error++;
1600 } else if (!dmabuf->endcleared) {
1601 swptr = dmabuf->swptr;
1602 silence = (dmabuf->fmt & TRIDENT_FMT_16BIT ? 0 : 0x80);
1603 if (dmabuf->update_flag & ALI_ADDRESS_INT_UPDATE) {
1604 /* We must clear end data of 1/2 dmabuf if needed.
1605 According to 1/2 algorithm of Address Engine Interrupt,
1606 check the validation of the data of half dmasize. */
1607 half_dmasize = dmabuf->dmasize / 2;
1608 if ((diff = hwptr - half_dmasize) < 0)
1609 diff = hwptr;
1610 if ((dmabuf->count + diff) < half_dmasize) {
1611 //there is invalid data in the end of half buffer
1612 if ((clear_cnt = half_dmasize - swptr) < 0)
1613 clear_cnt += half_dmasize;
1614 //clear the invalid data
1615 memset(dmabuf->rawbuf + swptr, silence, clear_cnt);
1616 if (state->chans_num == 6) {
1617 clear_cnt = clear_cnt / 2;
1618 swptr = swptr / 2;
1619 memset(state->other_states[0]->dmabuf.rawbuf + swptr,
1620 silence, clear_cnt);
1621 memset(state->other_states[1]->dmabuf.rawbuf + swptr,
1622 silence, clear_cnt);
1623 memset(state->other_states[2]->dmabuf.rawbuf + swptr,
1624 silence, clear_cnt);
1625 memset(state->other_states[3]->dmabuf.rawbuf + swptr,
1626 silence, clear_cnt);
1628 dmabuf->endcleared = 1;
1630 } else if (dmabuf->count < (signed) dmabuf->fragsize) {
1631 clear_cnt = dmabuf->fragsize;
1632 if ((swptr + clear_cnt) > dmabuf->dmasize)
1633 clear_cnt = dmabuf->dmasize - swptr;
1634 memset(dmabuf->rawbuf + swptr, silence, clear_cnt);
1635 if (state->chans_num == 6) {
1636 clear_cnt = clear_cnt / 2;
1637 swptr = swptr / 2;
1638 memset(state->other_states[0]->dmabuf.rawbuf + swptr,
1639 silence, clear_cnt);
1640 memset(state->other_states[1]->dmabuf.rawbuf + swptr,
1641 silence, clear_cnt);
1642 memset(state->other_states[2]->dmabuf.rawbuf + swptr,
1643 silence, clear_cnt);
1644 memset(state->other_states[3]->dmabuf.rawbuf + swptr,
1645 silence, clear_cnt);
1647 dmabuf->endcleared = 1;
1650 /* trident_update_ptr is called by interrupt handler or by process via
1651 ioctl/poll, we only wake up the waiting process when we have more
1652 than 1/2 buffer free (always true for interrupt handler) */
1653 if (dmabuf->count < (signed) dmabuf->dmasize / 2)
1654 wake_up(&dmabuf->wait);
1657 dmabuf->update_flag &= ~ALI_ADDRESS_INT_UPDATE;
1660 static void
1661 trident_address_interrupt(struct trident_card *card)
1663 int i;
1664 struct trident_state *state;
1665 unsigned int channel;
1667 /* Update the pointers for all channels we are running. */
1668 /* FIXME: should read interrupt status only once */
1669 for (i = 0; i < NR_HW_CH; i++) {
1670 channel = 63 - i;
1671 if (trident_check_channel_interrupt(card, channel)) {
1672 trident_ack_channel_interrupt(card, channel);
1673 if ((state = card->states[i]) != NULL) {
1674 trident_update_ptr(state);
1675 } else {
1676 printk(KERN_WARNING "trident: spurious channel "
1677 "irq %d.\n", channel);
1678 trident_stop_voice(card, channel);
1679 trident_disable_voice_irq(card, channel);
1685 static void
1686 ali_hwvol_control(struct trident_card *card, int opt)
1688 u16 dwTemp, volume[2], mute, diff, *pVol[2];
1690 dwTemp = ali_ac97_read(card->ac97_codec[0], 0x02);
1691 mute = dwTemp & 0x8000;
1692 volume[0] = dwTemp & 0x001f;
1693 volume[1] = (dwTemp & 0x1f00) >> 8;
1694 if (volume[0] < volume[1]) {
1695 pVol[0] = &volume[0];
1696 pVol[1] = &volume[1];
1697 } else {
1698 pVol[1] = &volume[0];
1699 pVol[0] = &volume[1];
1701 diff = *(pVol[1]) - *(pVol[0]);
1703 if (opt == 1) { // MUTE
1704 dwTemp ^= 0x8000;
1705 ali_ac97_write(card->ac97_codec[0],
1706 0x02, dwTemp);
1707 } else if (opt == 2) { // Down
1708 if (mute)
1709 return;
1710 if (*(pVol[1]) < 0x001f) {
1711 (*pVol[1])++;
1712 *(pVol[0]) = *(pVol[1]) - diff;
1714 dwTemp &= 0xe0e0;
1715 dwTemp |= (volume[0]) | (volume[1] << 8);
1716 ali_ac97_write(card->ac97_codec[0], 0x02, dwTemp);
1717 card->ac97_codec[0]->mixer_state[0] = ((32 - volume[0]) * 25 / 8) |
1718 (((32 - volume[1]) * 25 / 8) << 8);
1719 } else if (opt == 4) { // Up
1720 if (mute)
1721 return;
1722 if (*(pVol[0]) > 0) {
1723 (*pVol[0])--;
1724 *(pVol[1]) = *(pVol[0]) + diff;
1726 dwTemp &= 0xe0e0;
1727 dwTemp |= (volume[0]) | (volume[1] << 8);
1728 ali_ac97_write(card->ac97_codec[0], 0x02, dwTemp);
1729 card->ac97_codec[0]->mixer_state[0] = ((32 - volume[0]) * 25 / 8) |
1730 (((32 - volume[1]) * 25 / 8) << 8);
1731 } else {
1732 /* Nothing needs doing */
1737 * Re-enable reporting of vol change after 0.1 seconds
1740 static void
1741 ali_timeout(unsigned long ptr)
1743 struct trident_card *card = (struct trident_card *) ptr;
1744 u16 temp = 0;
1746 /* Enable GPIO IRQ (MISCINT bit 18h) */
1747 temp = inw(TRID_REG(card, T4D_MISCINT + 2));
1748 temp |= 0x0004;
1749 outw(temp, TRID_REG(card, T4D_MISCINT + 2));
1753 * Set up the timer to clear the vol change notification
1756 static void
1757 ali_set_timer(struct trident_card *card)
1759 /* Add Timer Routine to Enable GPIO IRQ */
1760 del_timer(&card->timer); /* Never queue twice */
1761 card->timer.function = ali_timeout;
1762 card->timer.data = (unsigned long) card;
1763 card->timer.expires = jiffies + HZ / 10;
1764 add_timer(&card->timer);
1768 * Process a GPIO event
1771 static void
1772 ali_queue_task(struct trident_card *card, int opt)
1774 u16 temp;
1776 /* Disable GPIO IRQ (MISCINT bit 18h) */
1777 temp = inw(TRID_REG(card, T4D_MISCINT + 2));
1778 temp &= (u16) (~0x0004);
1779 outw(temp, TRID_REG(card, T4D_MISCINT + 2));
1781 /* Adjust the volume */
1782 ali_hwvol_control(card, opt);
1784 /* Set the timer for 1/10th sec */
1785 ali_set_timer(card);
1788 static void
1789 cyber_address_interrupt(struct trident_card *card)
1791 int i, irq_status;
1792 struct trident_state *state;
1793 unsigned int channel;
1795 /* Update the pointers for all channels we are running. */
1796 /* FIXED: read interrupt status only once */
1797 irq_status = inl(TRID_REG(card, T4D_AINT_A));
1799 pr_debug("cyber_address_interrupt: irq_status 0x%X\n", irq_status);
1801 for (i = 0; i < NR_HW_CH; i++) {
1802 channel = 31 - i;
1803 if (irq_status & (1 << channel)) {
1804 /* clear bit by writing a 1, zeroes are ignored */
1805 outl((1 << channel), TRID_REG(card, T4D_AINT_A));
1807 pr_debug("cyber_interrupt: channel %d\n", channel);
1809 if ((state = card->states[i]) != NULL) {
1810 trident_update_ptr(state);
1811 } else {
1812 printk(KERN_WARNING "cyber5050: spurious "
1813 "channel irq %d.\n", channel);
1814 trident_stop_voice(card, channel);
1815 trident_disable_voice_irq(card, channel);
1821 static irqreturn_t
1822 trident_interrupt(int irq, void *dev_id, struct pt_regs *regs)
1824 struct trident_card *card = (struct trident_card *) dev_id;
1825 u32 event;
1826 u32 gpio;
1828 spin_lock(&card->lock);
1829 event = inl(TRID_REG(card, T4D_MISCINT));
1831 pr_debug("trident: trident_interrupt called, MISCINT = 0x%08x\n",
1832 event);
1834 if (event & ADDRESS_IRQ) {
1835 card->address_interrupt(card);
1838 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
1839 /* GPIO IRQ (H/W Volume Control) */
1840 event = inl(TRID_REG(card, T4D_MISCINT));
1841 if (event & (1 << 25)) {
1842 gpio = inl(TRID_REG(card, ALI_GPIO));
1843 if (!timer_pending(&card->timer))
1844 ali_queue_task(card, gpio & 0x07);
1846 event = inl(TRID_REG(card, T4D_MISCINT));
1847 outl(event | (ST_TARGET_REACHED | MIXER_OVERFLOW | MIXER_UNDERFLOW),
1848 TRID_REG(card, T4D_MISCINT));
1849 spin_unlock(&card->lock);
1850 return IRQ_HANDLED;
1853 /* manually clear interrupt status, bad hardware design, blame T^2 */
1854 outl((ST_TARGET_REACHED | MIXER_OVERFLOW | MIXER_UNDERFLOW),
1855 TRID_REG(card, T4D_MISCINT));
1856 spin_unlock(&card->lock);
1857 return IRQ_HANDLED;
1860 /* in this loop, dmabuf.count signifies the amount of data that is waiting */
1861 /* to be copied to the user's buffer. it is filled by the dma machine and */
1862 /* drained by this loop. */
1863 static ssize_t
1864 trident_read(struct file *file, char __user *buffer, size_t count, loff_t * ppos)
1866 struct trident_state *state = (struct trident_state *)file->private_data;
1867 struct dmabuf *dmabuf = &state->dmabuf;
1868 ssize_t ret = 0;
1869 unsigned long flags;
1870 unsigned swptr;
1871 int cnt;
1873 pr_debug("trident: trident_read called, count = %d\n", count);
1875 VALIDATE_STATE(state);
1877 if (dmabuf->mapped)
1878 return -ENXIO;
1879 if (!access_ok(VERIFY_WRITE, buffer, count))
1880 return -EFAULT;
1882 down(&state->sem);
1883 if (!dmabuf->ready && (ret = prog_dmabuf_record(state)))
1884 goto out;
1886 while (count > 0) {
1887 spin_lock_irqsave(&state->card->lock, flags);
1888 if (dmabuf->count > (signed) dmabuf->dmasize) {
1889 /* buffer overrun, we are recovering from */
1890 /* sleep_on_timeout, resync hwptr and swptr, */
1891 /* make process flush the buffer */
1892 dmabuf->count = dmabuf->dmasize;
1893 dmabuf->swptr = dmabuf->hwptr;
1895 swptr = dmabuf->swptr;
1896 cnt = dmabuf->dmasize - swptr;
1897 if (dmabuf->count < cnt)
1898 cnt = dmabuf->count;
1899 spin_unlock_irqrestore(&state->card->lock, flags);
1901 if (cnt > count)
1902 cnt = count;
1903 if (cnt <= 0) {
1904 unsigned long tmo;
1905 /* buffer is empty, start the dma machine and */
1906 /* wait for data to be recorded */
1907 start_adc(state);
1908 if (file->f_flags & O_NONBLOCK) {
1909 if (!ret)
1910 ret = -EAGAIN;
1911 goto out;
1914 up(&state->sem);
1915 /* No matter how much space left in the buffer, */
1916 /* we have to wait until CSO == ESO/2 or CSO == ESO */
1917 /* when address engine interrupts */
1918 tmo = (dmabuf->dmasize * HZ) / (dmabuf->rate * 2);
1919 tmo >>= sample_shift[dmabuf->fmt];
1920 /* There are two situations when sleep_on_timeout returns, one is when
1921 the interrupt is serviced correctly and the process is waked up by
1922 ISR ON TIME. Another is when timeout is expired, which means that
1923 either interrupt is NOT serviced correctly (pending interrupt) or it
1924 is TOO LATE for the process to be scheduled to run (scheduler latency)
1925 which results in a (potential) buffer overrun. And worse, there is
1926 NOTHING we can do to prevent it. */
1927 if (!interruptible_sleep_on_timeout(&dmabuf->wait, tmo)) {
1928 pr_debug(KERN_ERR "trident: recording schedule timeout, "
1929 "dmasz %u fragsz %u count %i hwptr %u swptr %u\n",
1930 dmabuf->dmasize, dmabuf->fragsize, dmabuf->count,
1931 dmabuf->hwptr, dmabuf->swptr);
1933 /* a buffer overrun, we delay the recovery until next time the
1934 while loop begin and we REALLY have space to record */
1936 if (signal_pending(current)) {
1937 if (!ret)
1938 ret = -ERESTARTSYS;
1939 goto out;
1941 down(&state->sem);
1942 if (dmabuf->mapped) {
1943 if (!ret)
1944 ret = -ENXIO;
1945 goto out;
1947 continue;
1950 if (copy_to_user(buffer, dmabuf->rawbuf + swptr, cnt)) {
1951 if (!ret)
1952 ret = -EFAULT;
1953 goto out;
1956 swptr = (swptr + cnt) % dmabuf->dmasize;
1958 spin_lock_irqsave(&state->card->lock, flags);
1959 dmabuf->swptr = swptr;
1960 dmabuf->count -= cnt;
1961 spin_unlock_irqrestore(&state->card->lock, flags);
1963 count -= cnt;
1964 buffer += cnt;
1965 ret += cnt;
1966 start_adc(state);
1968 out:
1969 up(&state->sem);
1970 return ret;
1973 /* in this loop, dmabuf.count signifies the amount of data that is waiting to be dma to
1974 the soundcard. it is drained by the dma machine and filled by this loop. */
1976 static ssize_t
1977 trident_write(struct file *file, const char __user *buffer, size_t count, loff_t * ppos)
1979 struct trident_state *state = (struct trident_state *)file->private_data;
1980 struct dmabuf *dmabuf = &state->dmabuf;
1981 ssize_t ret;
1982 unsigned long flags;
1983 unsigned swptr;
1984 int cnt;
1985 unsigned int state_cnt;
1986 unsigned int copy_count;
1987 int lret; /* for lock_set_fmt */
1989 pr_debug("trident: trident_write called, count = %d\n", count);
1991 VALIDATE_STATE(state);
1994 * Guard against an mmap or ioctl while writing
1997 down(&state->sem);
1999 if (dmabuf->mapped) {
2000 ret = -ENXIO;
2001 goto out;
2003 if (!dmabuf->ready && (ret = prog_dmabuf_playback(state)))
2004 goto out;
2006 if (!access_ok(VERIFY_READ, buffer, count)) {
2007 ret = -EFAULT;
2008 goto out;
2011 ret = 0;
2013 while (count > 0) {
2014 spin_lock_irqsave(&state->card->lock, flags);
2015 if (dmabuf->count < 0) {
2016 /* buffer underrun, we are recovering from */
2017 /* sleep_on_timeout, resync hwptr and swptr */
2018 dmabuf->count = 0;
2019 dmabuf->swptr = dmabuf->hwptr;
2021 swptr = dmabuf->swptr;
2022 cnt = dmabuf->dmasize - swptr;
2023 if (dmabuf->count + cnt > dmabuf->dmasize)
2024 cnt = dmabuf->dmasize - dmabuf->count;
2025 spin_unlock_irqrestore(&state->card->lock, flags);
2027 if (cnt > count)
2028 cnt = count;
2029 if (cnt <= 0) {
2030 unsigned long tmo;
2031 /* buffer is full, start the dma machine and */
2032 /* wait for data to be played */
2033 start_dac(state);
2034 if (file->f_flags & O_NONBLOCK) {
2035 if (!ret)
2036 ret = -EAGAIN;
2037 goto out;
2039 /* No matter how much data left in the buffer, */
2040 /* we have to wait until CSO == ESO/2 or CSO == ESO */
2041 /* when address engine interrupts */
2042 lock_set_fmt(state);
2043 tmo = (dmabuf->dmasize * HZ) / (dmabuf->rate * 2);
2044 tmo >>= sample_shift[dmabuf->fmt];
2045 unlock_set_fmt(state);
2046 up(&state->sem);
2048 /* There are two situations when sleep_on_timeout */
2049 /* returns, one is when the interrupt is serviced */
2050 /* correctly and the process is waked up by ISR */
2051 /* ON TIME. Another is when timeout is expired, which */
2052 /* means that either interrupt is NOT serviced */
2053 /* correctly (pending interrupt) or it is TOO LATE */
2054 /* for the process to be scheduled to run */
2055 /* (scheduler latency) which results in a (potential) */
2056 /* buffer underrun. And worse, there is NOTHING we */
2057 /* can do to prevent it. */
2058 if (!interruptible_sleep_on_timeout(&dmabuf->wait, tmo)) {
2059 pr_debug(KERN_ERR "trident: playback schedule "
2060 "timeout, dmasz %u fragsz %u count %i "
2061 "hwptr %u swptr %u\n", dmabuf->dmasize,
2062 dmabuf->fragsize, dmabuf->count,
2063 dmabuf->hwptr, dmabuf->swptr);
2065 /* a buffer underrun, we delay the recovery */
2066 /* until next time the while loop begin and */
2067 /* we REALLY have data to play */
2069 if (signal_pending(current)) {
2070 if (!ret)
2071 ret = -ERESTARTSYS;
2072 goto out_nolock;
2074 down(&state->sem);
2075 if (dmabuf->mapped) {
2076 if (!ret)
2077 ret = -ENXIO;
2078 goto out;
2080 continue;
2082 if ((lret = lock_set_fmt(state)) < 0) {
2083 ret = lret;
2084 goto out;
2087 if (state->chans_num == 6) {
2088 copy_count = 0;
2089 state_cnt = 0;
2090 if (ali_write_5_1(state, buffer, cnt, &copy_count,
2091 &state_cnt) == -EFAULT) {
2092 if (state_cnt) {
2093 swptr = (swptr + state_cnt) % dmabuf->dmasize;
2094 spin_lock_irqsave(&state->card->lock, flags);
2095 dmabuf->swptr = swptr;
2096 dmabuf->count += state_cnt;
2097 dmabuf->endcleared = 0;
2098 spin_unlock_irqrestore(&state->card->lock, flags);
2100 ret += copy_count;
2101 if (!ret)
2102 ret = -EFAULT;
2103 unlock_set_fmt(state);
2104 goto out;
2106 } else {
2107 if (copy_from_user(dmabuf->rawbuf + swptr,
2108 buffer, cnt)) {
2109 if (!ret)
2110 ret = -EFAULT;
2111 unlock_set_fmt(state);
2112 goto out;
2114 state_cnt = cnt;
2116 unlock_set_fmt(state);
2118 swptr = (swptr + state_cnt) % dmabuf->dmasize;
2120 spin_lock_irqsave(&state->card->lock, flags);
2121 dmabuf->swptr = swptr;
2122 dmabuf->count += state_cnt;
2123 dmabuf->endcleared = 0;
2124 spin_unlock_irqrestore(&state->card->lock, flags);
2126 count -= cnt;
2127 buffer += cnt;
2128 ret += cnt;
2129 start_dac(state);
2131 out:
2132 up(&state->sem);
2133 out_nolock:
2134 return ret;
2137 /* No kernel lock - we have our own spinlock */
2138 static unsigned int
2139 trident_poll(struct file *file, struct poll_table_struct *wait)
2141 struct trident_state *state = (struct trident_state *)file->private_data;
2142 struct dmabuf *dmabuf = &state->dmabuf;
2143 unsigned long flags;
2144 unsigned int mask = 0;
2146 VALIDATE_STATE(state);
2149 * Guard against a parallel poll and write causing multiple
2150 * prog_dmabuf events
2153 down(&state->sem);
2155 if (file->f_mode & FMODE_WRITE) {
2156 if (!dmabuf->ready && prog_dmabuf_playback(state)) {
2157 up(&state->sem);
2158 return 0;
2160 poll_wait(file, &dmabuf->wait, wait);
2162 if (file->f_mode & FMODE_READ) {
2163 if (!dmabuf->ready && prog_dmabuf_record(state)) {
2164 up(&state->sem);
2165 return 0;
2167 poll_wait(file, &dmabuf->wait, wait);
2170 up(&state->sem);
2172 spin_lock_irqsave(&state->card->lock, flags);
2173 trident_update_ptr(state);
2174 if (file->f_mode & FMODE_READ) {
2175 if (dmabuf->count >= (signed) dmabuf->fragsize)
2176 mask |= POLLIN | POLLRDNORM;
2178 if (file->f_mode & FMODE_WRITE) {
2179 if (dmabuf->mapped) {
2180 if (dmabuf->count >= (signed) dmabuf->fragsize)
2181 mask |= POLLOUT | POLLWRNORM;
2182 } else {
2183 if ((signed) dmabuf->dmasize >= dmabuf->count +
2184 (signed) dmabuf->fragsize)
2185 mask |= POLLOUT | POLLWRNORM;
2188 spin_unlock_irqrestore(&state->card->lock, flags);
2190 return mask;
2193 static int
2194 trident_mmap(struct file *file, struct vm_area_struct *vma)
2196 struct trident_state *state = (struct trident_state *)file->private_data;
2197 struct dmabuf *dmabuf = &state->dmabuf;
2198 int ret = -EINVAL;
2199 unsigned long size;
2201 VALIDATE_STATE(state);
2204 * Lock against poll read write or mmap creating buffers. Also lock
2205 * a read or write against an mmap.
2208 down(&state->sem);
2210 if (vma->vm_flags & VM_WRITE) {
2211 if ((ret = prog_dmabuf_playback(state)) != 0)
2212 goto out;
2213 } else if (vma->vm_flags & VM_READ) {
2214 if ((ret = prog_dmabuf_record(state)) != 0)
2215 goto out;
2216 } else
2217 goto out;
2219 ret = -EINVAL;
2220 if (vma->vm_pgoff != 0)
2221 goto out;
2222 size = vma->vm_end - vma->vm_start;
2223 if (size > (PAGE_SIZE << dmabuf->buforder))
2224 goto out;
2225 ret = -EAGAIN;
2226 if (remap_pfn_range(vma, vma->vm_start,
2227 virt_to_phys(dmabuf->rawbuf) >> PAGE_SHIFT,
2228 size, vma->vm_page_prot))
2229 goto out;
2230 dmabuf->mapped = 1;
2231 ret = 0;
2232 out:
2233 up(&state->sem);
2234 return ret;
2237 static int
2238 trident_ioctl(struct inode *inode, struct file *file,
2239 unsigned int cmd, unsigned long arg)
2241 struct trident_state *state = (struct trident_state *)file->private_data;
2242 struct dmabuf *dmabuf = &state->dmabuf;
2243 unsigned long flags;
2244 audio_buf_info abinfo;
2245 count_info cinfo;
2246 int val, mapped, ret = 0;
2247 struct trident_card *card = state->card;
2248 void __user *argp = (void __user *)arg;
2249 int __user *p = argp;
2251 VALIDATE_STATE(state);
2254 mapped = ((file->f_mode & (FMODE_WRITE | FMODE_READ)) && dmabuf->mapped);
2256 pr_debug("trident: trident_ioctl, command = %2d, arg = 0x%08x\n",
2257 _IOC_NR(cmd), arg ? *p : 0);
2259 switch (cmd) {
2260 case OSS_GETVERSION:
2261 ret = put_user(SOUND_VERSION, p);
2262 break;
2264 case SNDCTL_DSP_RESET:
2265 /* FIXME: spin_lock ? */
2266 if (file->f_mode & FMODE_WRITE) {
2267 stop_dac(state);
2268 synchronize_irq(card->irq);
2269 dmabuf->ready = 0;
2270 dmabuf->swptr = dmabuf->hwptr = 0;
2271 dmabuf->count = dmabuf->total_bytes = 0;
2273 if (file->f_mode & FMODE_READ) {
2274 stop_adc(state);
2275 synchronize_irq(card->irq);
2276 dmabuf->ready = 0;
2277 dmabuf->swptr = dmabuf->hwptr = 0;
2278 dmabuf->count = dmabuf->total_bytes = 0;
2280 break;
2282 case SNDCTL_DSP_SYNC:
2283 if (file->f_mode & FMODE_WRITE)
2284 ret = drain_dac(state, file->f_flags & O_NONBLOCK);
2285 break;
2287 case SNDCTL_DSP_SPEED: /* set smaple rate */
2288 if (get_user(val, p)) {
2289 ret = -EFAULT;
2290 break;
2292 if (val >= 0) {
2293 if (file->f_mode & FMODE_WRITE) {
2294 stop_dac(state);
2295 dmabuf->ready = 0;
2296 spin_lock_irqsave(&state->card->lock, flags);
2297 trident_set_dac_rate(state, val);
2298 spin_unlock_irqrestore(&state->card->lock, flags);
2300 if (file->f_mode & FMODE_READ) {
2301 stop_adc(state);
2302 dmabuf->ready = 0;
2303 spin_lock_irqsave(&state->card->lock, flags);
2304 trident_set_adc_rate(state, val);
2305 spin_unlock_irqrestore(&state->card->lock, flags);
2308 ret = put_user(dmabuf->rate, p);
2309 break;
2311 case SNDCTL_DSP_STEREO: /* set stereo or mono channel */
2312 if (get_user(val, p)) {
2313 ret = -EFAULT;
2314 break;
2316 if ((ret = lock_set_fmt(state)) < 0)
2317 return ret;
2319 if (file->f_mode & FMODE_WRITE) {
2320 stop_dac(state);
2321 dmabuf->ready = 0;
2322 if (val)
2323 dmabuf->fmt |= TRIDENT_FMT_STEREO;
2324 else
2325 dmabuf->fmt &= ~TRIDENT_FMT_STEREO;
2327 if (file->f_mode & FMODE_READ) {
2328 stop_adc(state);
2329 dmabuf->ready = 0;
2330 if (val)
2331 dmabuf->fmt |= TRIDENT_FMT_STEREO;
2332 else
2333 dmabuf->fmt &= ~TRIDENT_FMT_STEREO;
2335 unlock_set_fmt(state);
2336 break;
2338 case SNDCTL_DSP_GETBLKSIZE:
2339 if (file->f_mode & FMODE_WRITE) {
2340 if ((val = prog_dmabuf_playback(state)))
2341 ret = val;
2342 else
2343 ret = put_user(dmabuf->fragsize, p);
2344 break;
2346 if (file->f_mode & FMODE_READ) {
2347 if ((val = prog_dmabuf_record(state)))
2348 ret = val;
2349 else
2350 ret = put_user(dmabuf->fragsize, p);
2351 break;
2353 /* neither READ nor WRITE? is this even possible? */
2354 ret = -EINVAL;
2355 break;
2358 case SNDCTL_DSP_GETFMTS: /* Returns a mask of supported sample format */
2359 ret = put_user(AFMT_S16_LE | AFMT_U16_LE | AFMT_S8 |
2360 AFMT_U8, p);
2361 break;
2363 case SNDCTL_DSP_SETFMT: /* Select sample format */
2364 if (get_user(val, p)) {
2365 ret = -EFAULT;
2366 break;
2368 if ((ret = lock_set_fmt(state)) < 0)
2369 return ret;
2371 if (val != AFMT_QUERY) {
2372 if (file->f_mode & FMODE_WRITE) {
2373 stop_dac(state);
2374 dmabuf->ready = 0;
2375 if (val == AFMT_S16_LE)
2376 dmabuf->fmt |= TRIDENT_FMT_16BIT;
2377 else
2378 dmabuf->fmt &= ~TRIDENT_FMT_16BIT;
2380 if (file->f_mode & FMODE_READ) {
2381 stop_adc(state);
2382 dmabuf->ready = 0;
2383 if (val == AFMT_S16_LE)
2384 dmabuf->fmt |= TRIDENT_FMT_16BIT;
2385 else
2386 dmabuf->fmt &= ~TRIDENT_FMT_16BIT;
2389 unlock_set_fmt(state);
2390 ret = put_user((dmabuf->fmt & TRIDENT_FMT_16BIT) ? AFMT_S16_LE :
2391 AFMT_U8, p);
2392 break;
2394 case SNDCTL_DSP_CHANNELS:
2395 if (get_user(val, p)) {
2396 ret = -EFAULT;
2397 break;
2399 if (val != 0) {
2400 if ((ret = lock_set_fmt(state)) < 0)
2401 return ret;
2403 if (file->f_mode & FMODE_WRITE) {
2404 stop_dac(state);
2405 dmabuf->ready = 0;
2407 //prevent from memory leak
2408 if ((state->chans_num > 2) && (state->chans_num != val)) {
2409 ali_free_other_states_resources(state);
2410 state->chans_num = 1;
2413 if (val >= 2) {
2415 dmabuf->fmt |= TRIDENT_FMT_STEREO;
2416 if ((val == 6) && (state->card->pci_id == PCI_DEVICE_ID_ALI_5451)) {
2417 if (card->rec_channel_use_count > 0) {
2418 printk(KERN_ERR "trident: Record is "
2419 "working on the card!\n");
2420 ret = -EBUSY;
2421 unlock_set_fmt(state);
2422 break;
2425 ret = ali_setup_multi_channels(state->card, 6);
2426 if (ret < 0) {
2427 unlock_set_fmt(state);
2428 break;
2430 down(&state->card->open_sem);
2431 ret = ali_allocate_other_states_resources(state, 6);
2432 if (ret < 0) {
2433 up(&state->card->open_sem);
2434 unlock_set_fmt(state);
2435 break;
2437 state->card->multi_channel_use_count++;
2438 up(&state->card->open_sem);
2439 } else
2440 val = 2; /*yield to 2-channels */
2441 } else
2442 dmabuf->fmt &= ~TRIDENT_FMT_STEREO;
2443 state->chans_num = val;
2445 if (file->f_mode & FMODE_READ) {
2446 stop_adc(state);
2447 dmabuf->ready = 0;
2448 if (val >= 2) {
2449 if (!((file->f_mode & FMODE_WRITE) &&
2450 (val == 6)))
2451 val = 2;
2452 dmabuf->fmt |= TRIDENT_FMT_STEREO;
2453 } else
2454 dmabuf->fmt &= ~TRIDENT_FMT_STEREO;
2455 state->chans_num = val;
2457 unlock_set_fmt(state);
2459 ret = put_user(val, p);
2460 break;
2462 case SNDCTL_DSP_POST:
2463 /* Cause the working fragment to be output */
2464 break;
2466 case SNDCTL_DSP_SUBDIVIDE:
2467 if (dmabuf->subdivision) {
2468 ret = -EINVAL;
2469 break;
2471 if (get_user(val, p)) {
2472 ret = -EFAULT;
2473 break;
2475 if (val != 1 && val != 2 && val != 4) {
2476 ret = -EINVAL;
2477 break;
2479 dmabuf->subdivision = val;
2480 break;
2482 case SNDCTL_DSP_SETFRAGMENT:
2483 if (get_user(val, p)) {
2484 ret = -EFAULT;
2485 break;
2488 dmabuf->ossfragshift = val & 0xffff;
2489 dmabuf->ossmaxfrags = (val >> 16) & 0xffff;
2490 if (dmabuf->ossfragshift < 4)
2491 dmabuf->ossfragshift = 4;
2492 if (dmabuf->ossfragshift > 15)
2493 dmabuf->ossfragshift = 15;
2494 if (dmabuf->ossmaxfrags < 4)
2495 dmabuf->ossmaxfrags = 4;
2497 break;
2499 case SNDCTL_DSP_GETOSPACE:
2500 if (!(file->f_mode & FMODE_WRITE)) {
2501 ret = -EINVAL;
2502 break;
2504 if (!dmabuf->ready && (val = prog_dmabuf_playback(state)) != 0) {
2505 ret = val;
2506 break;
2508 spin_lock_irqsave(&state->card->lock, flags);
2509 trident_update_ptr(state);
2510 abinfo.fragsize = dmabuf->fragsize;
2511 abinfo.bytes = dmabuf->dmasize - dmabuf->count;
2512 abinfo.fragstotal = dmabuf->numfrag;
2513 abinfo.fragments = abinfo.bytes >> dmabuf->fragshift;
2514 spin_unlock_irqrestore(&state->card->lock, flags);
2515 ret = copy_to_user(argp, &abinfo, sizeof (abinfo)) ?
2516 -EFAULT : 0;
2517 break;
2519 case SNDCTL_DSP_GETISPACE:
2520 if (!(file->f_mode & FMODE_READ)) {
2521 ret = -EINVAL;
2522 break;
2524 if (!dmabuf->ready && (val = prog_dmabuf_record(state)) != 0) {
2525 ret = val;
2526 break;
2528 spin_lock_irqsave(&state->card->lock, flags);
2529 trident_update_ptr(state);
2530 abinfo.fragsize = dmabuf->fragsize;
2531 abinfo.bytes = dmabuf->count;
2532 abinfo.fragstotal = dmabuf->numfrag;
2533 abinfo.fragments = abinfo.bytes >> dmabuf->fragshift;
2534 spin_unlock_irqrestore(&state->card->lock, flags);
2535 ret = copy_to_user(argp, &abinfo, sizeof (abinfo)) ?
2536 -EFAULT : 0;
2537 break;
2539 case SNDCTL_DSP_NONBLOCK:
2540 file->f_flags |= O_NONBLOCK;
2541 break;
2543 case SNDCTL_DSP_GETCAPS:
2544 ret = put_user(DSP_CAP_REALTIME | DSP_CAP_TRIGGER |
2545 DSP_CAP_MMAP | DSP_CAP_BIND, p);
2546 break;
2548 case SNDCTL_DSP_GETTRIGGER:
2549 val = 0;
2550 if ((file->f_mode & FMODE_READ) && dmabuf->enable)
2551 val |= PCM_ENABLE_INPUT;
2552 if ((file->f_mode & FMODE_WRITE) && dmabuf->enable)
2553 val |= PCM_ENABLE_OUTPUT;
2554 ret = put_user(val, p);
2555 break;
2557 case SNDCTL_DSP_SETTRIGGER:
2558 if (get_user(val, p)) {
2559 ret = -EFAULT;
2560 break;
2562 if (file->f_mode & FMODE_READ) {
2563 if (val & PCM_ENABLE_INPUT) {
2564 if (!dmabuf->ready &&
2565 (ret = prog_dmabuf_record(state)))
2566 break;
2567 start_adc(state);
2568 } else
2569 stop_adc(state);
2571 if (file->f_mode & FMODE_WRITE) {
2572 if (val & PCM_ENABLE_OUTPUT) {
2573 if (!dmabuf->ready &&
2574 (ret = prog_dmabuf_playback(state)))
2575 break;
2576 start_dac(state);
2577 } else
2578 stop_dac(state);
2580 break;
2582 case SNDCTL_DSP_GETIPTR:
2583 if (!(file->f_mode & FMODE_READ)) {
2584 ret = -EINVAL;
2585 break;
2587 if (!dmabuf->ready && (val = prog_dmabuf_record(state))
2588 != 0) {
2589 ret = val;
2590 break;
2592 spin_lock_irqsave(&state->card->lock, flags);
2593 trident_update_ptr(state);
2594 cinfo.bytes = dmabuf->total_bytes;
2595 cinfo.blocks = dmabuf->count >> dmabuf->fragshift;
2596 cinfo.ptr = dmabuf->hwptr;
2597 if (dmabuf->mapped)
2598 dmabuf->count &= dmabuf->fragsize - 1;
2599 spin_unlock_irqrestore(&state->card->lock, flags);
2600 ret = copy_to_user(argp, &cinfo, sizeof (cinfo)) ?
2601 -EFAULT : 0;
2602 break;
2604 case SNDCTL_DSP_GETOPTR:
2605 if (!(file->f_mode & FMODE_WRITE)) {
2606 ret = -EINVAL;
2607 break;
2609 if (!dmabuf->ready && (val = prog_dmabuf_playback(state))
2610 != 0) {
2611 ret = val;
2612 break;
2615 spin_lock_irqsave(&state->card->lock, flags);
2616 trident_update_ptr(state);
2617 cinfo.bytes = dmabuf->total_bytes;
2618 cinfo.blocks = dmabuf->count >> dmabuf->fragshift;
2619 cinfo.ptr = dmabuf->hwptr;
2620 if (dmabuf->mapped)
2621 dmabuf->count &= dmabuf->fragsize - 1;
2622 spin_unlock_irqrestore(&state->card->lock, flags);
2623 ret = copy_to_user(argp, &cinfo, sizeof (cinfo)) ?
2624 -EFAULT : 0;
2625 break;
2627 case SNDCTL_DSP_SETDUPLEX:
2628 ret = -EINVAL;
2629 break;
2631 case SNDCTL_DSP_GETODELAY:
2632 if (!(file->f_mode & FMODE_WRITE)) {
2633 ret = -EINVAL;
2634 break;
2636 if (!dmabuf->ready && (val = prog_dmabuf_playback(state)) != 0) {
2637 ret = val;
2638 break;
2640 spin_lock_irqsave(&state->card->lock, flags);
2641 trident_update_ptr(state);
2642 val = dmabuf->count;
2643 spin_unlock_irqrestore(&state->card->lock, flags);
2644 ret = put_user(val, p);
2645 break;
2647 case SOUND_PCM_READ_RATE:
2648 ret = put_user(dmabuf->rate, p);
2649 break;
2651 case SOUND_PCM_READ_CHANNELS:
2652 ret = put_user((dmabuf->fmt & TRIDENT_FMT_STEREO) ? 2 : 1,
2654 break;
2656 case SOUND_PCM_READ_BITS:
2657 ret = put_user((dmabuf->fmt & TRIDENT_FMT_16BIT) ? AFMT_S16_LE :
2658 AFMT_U8, p);
2659 break;
2661 case SNDCTL_DSP_GETCHANNELMASK:
2662 ret = put_user(DSP_BIND_FRONT | DSP_BIND_SURR |
2663 DSP_BIND_CENTER_LFE, p);
2664 break;
2666 case SNDCTL_DSP_BIND_CHANNEL:
2667 if (state->card->pci_id != PCI_DEVICE_ID_SI_7018) {
2668 ret = -EINVAL;
2669 break;
2672 if (get_user(val, p)) {
2673 ret = -EFAULT;
2674 break;
2676 if (val == DSP_BIND_QUERY) {
2677 val = dmabuf->channel->attribute | 0x3c00;
2678 val = attr2mask[val >> 8];
2679 } else {
2680 dmabuf->ready = 0;
2681 if (file->f_mode & FMODE_READ)
2682 dmabuf->channel->attribute = (CHANNEL_REC |
2683 SRC_ENABLE);
2684 if (file->f_mode & FMODE_WRITE)
2685 dmabuf->channel->attribute = (CHANNEL_SPC_PB |
2686 SRC_ENABLE);
2687 dmabuf->channel->attribute |= mask2attr[ffs(val)];
2689 ret = put_user(val, p);
2690 break;
2692 case SNDCTL_DSP_MAPINBUF:
2693 case SNDCTL_DSP_MAPOUTBUF:
2694 case SNDCTL_DSP_SETSYNCRO:
2695 case SOUND_PCM_WRITE_FILTER:
2696 case SOUND_PCM_READ_FILTER:
2697 default:
2698 ret = -EINVAL;
2699 break;
2702 return ret;
2705 static int
2706 trident_open(struct inode *inode, struct file *file)
2708 int i = 0;
2709 int minor = iminor(inode);
2710 struct trident_card *card = devs;
2711 struct trident_state *state = NULL;
2712 struct dmabuf *dmabuf = NULL;
2714 /* Added by Matt Wu 01-05-2001 */
2715 /* TODO: there's some redundacy here wrt the check below */
2716 /* for multi_use_count > 0. Should we return -EBUSY or find */
2717 /* a different card? for now, don't break current behaviour */
2718 /* -- mulix */
2719 if (file->f_mode & FMODE_READ) {
2720 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
2721 if (card->multi_channel_use_count > 0)
2722 return -EBUSY;
2726 /* find an available virtual channel (instance of /dev/dsp) */
2727 while (card != NULL) {
2728 down(&card->open_sem);
2729 if (file->f_mode & FMODE_READ) {
2730 /* Skip opens on cards that are in 6 channel mode */
2731 if (card->multi_channel_use_count > 0) {
2732 up(&card->open_sem);
2733 card = card->next;
2734 continue;
2737 for (i = 0; i < NR_HW_CH; i++) {
2738 if (card->states[i] == NULL) {
2739 state = card->states[i] = kmalloc(sizeof(*state), GFP_KERNEL);
2740 if (state == NULL) {
2741 up(&card->open_sem);
2742 return -ENOMEM;
2744 memset(state, 0, sizeof(*state));
2745 init_MUTEX(&state->sem);
2746 dmabuf = &state->dmabuf;
2747 goto found_virt;
2750 up(&card->open_sem);
2751 card = card->next;
2753 /* no more virtual channel avaiable */
2754 if (!state) {
2755 return -ENODEV;
2757 found_virt:
2758 /* found a free virtual channel, allocate hardware channels */
2759 if (file->f_mode & FMODE_READ)
2760 dmabuf->channel = card->alloc_rec_pcm_channel(card);
2761 else
2762 dmabuf->channel = card->alloc_pcm_channel(card);
2764 if (dmabuf->channel == NULL) {
2765 kfree(card->states[i]);
2766 card->states[i] = NULL;
2767 return -ENODEV;
2770 /* initialize the virtual channel */
2771 state->virt = i;
2772 state->card = card;
2773 state->magic = TRIDENT_STATE_MAGIC;
2774 init_waitqueue_head(&dmabuf->wait);
2775 file->private_data = state;
2777 /* set default sample format. According to OSS Programmer's */
2778 /* Guide /dev/dsp should be default to unsigned 8-bits, mono, */
2779 /* with sample rate 8kHz and /dev/dspW will accept 16-bits sample */
2780 if (file->f_mode & FMODE_WRITE) {
2781 dmabuf->fmt &= ~TRIDENT_FMT_MASK;
2782 if ((minor & 0x0f) == SND_DEV_DSP16)
2783 dmabuf->fmt |= TRIDENT_FMT_16BIT;
2784 dmabuf->ossfragshift = 0;
2785 dmabuf->ossmaxfrags = 0;
2786 dmabuf->subdivision = 0;
2787 if (card->pci_id == PCI_DEVICE_ID_SI_7018) {
2788 /* set default channel attribute to normal playback */
2789 dmabuf->channel->attribute = CHANNEL_PB;
2791 trident_set_dac_rate(state, 8000);
2794 if (file->f_mode & FMODE_READ) {
2795 /* FIXME: Trident 4d can only record in signed 16-bits stereo, */
2796 /* 48kHz sample, to be dealed with in trident_set_adc_rate() ?? */
2797 dmabuf->fmt &= ~TRIDENT_FMT_MASK;
2798 if ((minor & 0x0f) == SND_DEV_DSP16)
2799 dmabuf->fmt |= TRIDENT_FMT_16BIT;
2800 dmabuf->ossfragshift = 0;
2801 dmabuf->ossmaxfrags = 0;
2802 dmabuf->subdivision = 0;
2803 if (card->pci_id == PCI_DEVICE_ID_SI_7018) {
2804 /* set default channel attribute to 0x8a80, record from
2805 PCM L/R FIFO and mono = (left + right + 1)/2 */
2806 dmabuf->channel->attribute = (CHANNEL_REC | PCM_LR |
2807 MONO_MIX);
2809 trident_set_adc_rate(state, 8000);
2811 /* Added by Matt Wu 01-05-2001 */
2812 if (card->pci_id == PCI_DEVICE_ID_ALI_5451)
2813 card->rec_channel_use_count++;
2816 state->open_mode |= file->f_mode & (FMODE_READ | FMODE_WRITE);
2817 up(&card->open_sem);
2819 pr_debug("trident: open virtual channel %d, hard channel %d\n",
2820 state->virt, dmabuf->channel->num);
2822 return nonseekable_open(inode, file);
2825 static int
2826 trident_release(struct inode *inode, struct file *file)
2828 struct trident_state *state = (struct trident_state *)file->private_data;
2829 struct trident_card *card;
2830 struct dmabuf *dmabuf;
2832 VALIDATE_STATE(state);
2834 card = state->card;
2835 dmabuf = &state->dmabuf;
2837 if (file->f_mode & FMODE_WRITE) {
2838 trident_clear_tail(state);
2839 drain_dac(state, file->f_flags & O_NONBLOCK);
2842 pr_debug("trident: closing virtual channel %d, hard channel %d\n",
2843 state->virt, dmabuf->channel->num);
2845 /* stop DMA state machine and free DMA buffers/channels */
2846 down(&card->open_sem);
2848 if (file->f_mode & FMODE_WRITE) {
2849 stop_dac(state);
2850 dealloc_dmabuf(&state->dmabuf, state->card->pci_dev);
2851 state->card->free_pcm_channel(state->card, dmabuf->channel->num);
2853 /* Added by Matt Wu */
2854 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
2855 if (state->chans_num > 2) {
2856 if (card->multi_channel_use_count-- < 0)
2857 card->multi_channel_use_count = 0;
2858 if (card->multi_channel_use_count == 0)
2859 ali_close_multi_channels();
2860 ali_free_other_states_resources(state);
2864 if (file->f_mode & FMODE_READ) {
2865 stop_adc(state);
2866 dealloc_dmabuf(&state->dmabuf, state->card->pci_dev);
2867 state->card->free_pcm_channel(state->card, dmabuf->channel->num);
2869 /* Added by Matt Wu */
2870 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
2871 if (card->rec_channel_use_count-- < 0)
2872 card->rec_channel_use_count = 0;
2876 card->states[state->virt] = NULL;
2877 kfree(state);
2879 /* we're covered by the open_sem */
2880 up(&card->open_sem);
2882 return 0;
2885 static /*const */ struct file_operations trident_audio_fops = {
2886 .owner = THIS_MODULE,
2887 .llseek = no_llseek,
2888 .read = trident_read,
2889 .write = trident_write,
2890 .poll = trident_poll,
2891 .ioctl = trident_ioctl,
2892 .mmap = trident_mmap,
2893 .open = trident_open,
2894 .release = trident_release,
2897 /* trident specific AC97 functions */
2898 /* Write AC97 codec registers */
2899 static void
2900 trident_ac97_set(struct ac97_codec *codec, u8 reg, u16 val)
2902 struct trident_card *card = (struct trident_card *)codec->private_data;
2903 unsigned int address, mask, busy;
2904 unsigned short count = 0xffff;
2905 unsigned long flags;
2906 u32 data;
2908 data = ((u32) val) << 16;
2910 switch (card->pci_id) {
2911 default:
2912 case PCI_DEVICE_ID_SI_7018:
2913 address = SI_AC97_WRITE;
2914 mask = SI_AC97_BUSY_WRITE | SI_AC97_AUDIO_BUSY;
2915 if (codec->id)
2916 mask |= SI_AC97_SECONDARY;
2917 busy = SI_AC97_BUSY_WRITE;
2918 break;
2919 case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
2920 address = DX_ACR0_AC97_W;
2921 mask = busy = DX_AC97_BUSY_WRITE;
2922 break;
2923 case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
2924 address = NX_ACR1_AC97_W;
2925 mask = NX_AC97_BUSY_WRITE;
2926 if (codec->id)
2927 mask |= NX_AC97_WRITE_SECONDARY;
2928 busy = NX_AC97_BUSY_WRITE;
2929 break;
2930 case PCI_DEVICE_ID_INTERG_5050:
2931 address = SI_AC97_WRITE;
2932 mask = busy = SI_AC97_BUSY_WRITE;
2933 if (codec->id)
2934 mask |= SI_AC97_SECONDARY;
2935 break;
2938 spin_lock_irqsave(&card->lock, flags);
2939 do {
2940 if ((inw(TRID_REG(card, address)) & busy) == 0)
2941 break;
2942 } while (count--);
2944 data |= (mask | (reg & AC97_REG_ADDR));
2946 if (count == 0) {
2947 printk(KERN_ERR "trident: AC97 CODEC write timed out.\n");
2948 spin_unlock_irqrestore(&card->lock, flags);
2949 return;
2952 outl(data, TRID_REG(card, address));
2953 spin_unlock_irqrestore(&card->lock, flags);
2956 /* Read AC97 codec registers */
2957 static u16
2958 trident_ac97_get(struct ac97_codec *codec, u8 reg)
2960 struct trident_card *card = (struct trident_card *)codec->private_data;
2961 unsigned int address, mask, busy;
2962 unsigned short count = 0xffff;
2963 unsigned long flags;
2964 u32 data;
2966 switch (card->pci_id) {
2967 default:
2968 case PCI_DEVICE_ID_SI_7018:
2969 address = SI_AC97_READ;
2970 mask = SI_AC97_BUSY_READ | SI_AC97_AUDIO_BUSY;
2971 if (codec->id)
2972 mask |= SI_AC97_SECONDARY;
2973 busy = SI_AC97_BUSY_READ;
2974 break;
2975 case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
2976 address = DX_ACR1_AC97_R;
2977 mask = busy = DX_AC97_BUSY_READ;
2978 break;
2979 case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
2980 if (codec->id)
2981 address = NX_ACR3_AC97_R_SECONDARY;
2982 else
2983 address = NX_ACR2_AC97_R_PRIMARY;
2984 mask = NX_AC97_BUSY_READ;
2985 busy = NX_AC97_BUSY_READ | NX_AC97_BUSY_DATA;
2986 break;
2987 case PCI_DEVICE_ID_INTERG_5050:
2988 address = SI_AC97_READ;
2989 mask = busy = SI_AC97_BUSY_READ;
2990 if (codec->id)
2991 mask |= SI_AC97_SECONDARY;
2992 break;
2995 data = (mask | (reg & AC97_REG_ADDR));
2997 spin_lock_irqsave(&card->lock, flags);
2998 outl(data, TRID_REG(card, address));
2999 do {
3000 data = inl(TRID_REG(card, address));
3001 if ((data & busy) == 0)
3002 break;
3003 } while (count--);
3004 spin_unlock_irqrestore(&card->lock, flags);
3006 if (count == 0) {
3007 printk(KERN_ERR "trident: AC97 CODEC read timed out.\n");
3008 data = 0;
3010 return ((u16) (data >> 16));
3013 /* rewrite ac97 read and write mixer register by hulei for ALI*/
3014 static int
3015 acquirecodecaccess(struct trident_card *card)
3017 u16 wsemamask = 0x6000; /* bit 14..13 */
3018 u16 wsemabits;
3019 u16 wcontrol;
3020 int block = 0;
3021 int ncount = 25;
3022 while (1) {
3023 wcontrol = inw(TRID_REG(card, ALI_AC97_WRITE));
3024 wsemabits = wcontrol & wsemamask;
3026 if (wsemabits == 0x4000)
3027 return 1; /* 0x4000 is audio ,then success */
3028 if (ncount-- < 0)
3029 break;
3030 if (wsemabits == 0) {
3031 unlock:
3032 outl(((u32) (wcontrol & 0x1eff) | 0x00004000),
3033 TRID_REG(card, ALI_AC97_WRITE));
3034 continue;
3036 udelay(20);
3038 if (!block) {
3039 pr_debug("accesscodecsemaphore: try unlock\n");
3040 block = 1;
3041 goto unlock;
3043 return 0;
3046 static void
3047 releasecodecaccess(struct trident_card *card)
3049 unsigned long wcontrol;
3050 wcontrol = inl(TRID_REG(card, ALI_AC97_WRITE));
3051 outl((wcontrol & 0xffff1eff), TRID_REG(card, ALI_AC97_WRITE));
3054 static int
3055 waitforstimertick(struct trident_card *card)
3057 unsigned long chk1, chk2;
3058 unsigned int wcount = 0xffff;
3059 chk1 = inl(TRID_REG(card, ALI_STIMER));
3061 while (1) {
3062 chk2 = inl(TRID_REG(card, ALI_STIMER));
3063 if ((wcount > 0) && chk1 != chk2)
3064 return 1;
3065 if (wcount <= 0)
3066 break;
3067 udelay(50);
3069 return 0;
3072 /* Read AC97 codec registers for ALi*/
3073 static u16
3074 ali_ac97_get(struct trident_card *card, int secondary, u8 reg)
3076 unsigned int address, mask;
3077 unsigned int ncount;
3078 unsigned long aud_reg;
3079 u32 data;
3080 u16 wcontrol;
3081 unsigned long flags;
3083 if (!card)
3084 BUG();
3086 address = ALI_AC97_READ;
3087 if (card->revision == ALI_5451_V02) {
3088 address = ALI_AC97_WRITE;
3090 mask = ALI_AC97_READ_ACTION | ALI_AC97_AUDIO_BUSY;
3091 if (secondary)
3092 mask |= ALI_AC97_SECONDARY;
3094 spin_lock_irqsave(&card->lock, flags);
3096 if (!acquirecodecaccess(card))
3097 printk(KERN_ERR "access codec fail\n");
3099 wcontrol = inw(TRID_REG(card, ALI_AC97_WRITE));
3100 wcontrol &= 0xfe00;
3101 wcontrol |= (0x8000 | reg);
3102 outw(wcontrol, TRID_REG(card, ALI_AC97_WRITE));
3104 data = (mask | (reg & AC97_REG_ADDR));
3106 if (!waitforstimertick(card)) {
3107 printk(KERN_ERR "ali_ac97_read: BIT_CLOCK is dead\n");
3108 goto releasecodec;
3111 udelay(20);
3113 ncount = 10;
3115 while (1) {
3116 if ((inw(TRID_REG(card, ALI_AC97_WRITE)) & ALI_AC97_BUSY_READ)
3117 != 0)
3118 break;
3119 if (ncount <= 0)
3120 break;
3121 if (ncount-- == 1) {
3122 pr_debug("ali_ac97_read :try clear busy flag\n");
3123 aud_reg = inl(TRID_REG(card, ALI_AC97_WRITE));
3124 outl((aud_reg & 0xffff7fff),
3125 TRID_REG(card, ALI_AC97_WRITE));
3127 udelay(10);
3130 data = inl(TRID_REG(card, address));
3132 spin_unlock_irqrestore(&card->lock, flags);
3134 return ((u16) (data >> 16));
3136 releasecodec:
3137 releasecodecaccess(card);
3138 spin_unlock_irqrestore(&card->lock, flags);
3139 printk(KERN_ERR "ali_ac97_read: AC97 CODEC read timed out.\n");
3140 return 0;
3143 /* Write AC97 codec registers for hulei*/
3144 static void
3145 ali_ac97_set(struct trident_card *card, int secondary, u8 reg, u16 val)
3147 unsigned int address, mask;
3148 unsigned int ncount;
3149 u32 data;
3150 u16 wcontrol;
3151 unsigned long flags;
3153 data = ((u32) val) << 16;
3155 if (!card)
3156 BUG();
3158 address = ALI_AC97_WRITE;
3159 mask = ALI_AC97_WRITE_ACTION | ALI_AC97_AUDIO_BUSY;
3160 if (secondary)
3161 mask |= ALI_AC97_SECONDARY;
3162 if (card->revision == ALI_5451_V02)
3163 mask |= ALI_AC97_WRITE_MIXER_REGISTER;
3165 spin_lock_irqsave(&card->lock, flags);
3166 if (!acquirecodecaccess(card))
3167 printk(KERN_ERR "ali_ac97_write: access codec fail\n");
3169 wcontrol = inw(TRID_REG(card, ALI_AC97_WRITE));
3170 wcontrol &= 0xff00;
3171 wcontrol |= (0x8100 | reg); /* bit 8=1: (ali1535 )reserved/ */
3172 /* ali1535+ write */
3173 outl((data | wcontrol), TRID_REG(card, ALI_AC97_WRITE));
3175 if (!waitforstimertick(card)) {
3176 printk(KERN_ERR "BIT_CLOCK is dead\n");
3177 goto releasecodec;
3180 ncount = 10;
3181 while (1) {
3182 wcontrol = inw(TRID_REG(card, ALI_AC97_WRITE));
3183 if (!(wcontrol & 0x8000))
3184 break;
3185 if (ncount <= 0)
3186 break;
3187 if (ncount-- == 1) {
3188 pr_debug("ali_ac97_set :try clear busy flag!!\n");
3189 outw(wcontrol & 0x7fff,
3190 TRID_REG(card, ALI_AC97_WRITE));
3192 udelay(10);
3195 releasecodec:
3196 releasecodecaccess(card);
3197 spin_unlock_irqrestore(&card->lock, flags);
3198 return;
3201 static void
3202 ali_enable_special_channel(struct trident_state *stat)
3204 struct trident_card *card = stat->card;
3205 unsigned long s_channels;
3207 s_channels = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
3208 s_channels |= (1 << stat->dmabuf.channel->num);
3209 outl(s_channels, TRID_REG(card, ALI_GLOBAL_CONTROL));
3212 static u16
3213 ali_ac97_read(struct ac97_codec *codec, u8 reg)
3215 int id;
3216 u16 data;
3217 struct trident_card *card = NULL;
3219 /* Added by Matt Wu */
3220 if (!codec)
3221 BUG();
3223 card = (struct trident_card *) codec->private_data;
3225 if (!card->mixer_regs_ready)
3226 return ali_ac97_get(card, codec->id, reg);
3229 * FIXME: need to stop this caching some registers
3231 if (codec->id)
3232 id = 1;
3233 else
3234 id = 0;
3236 data = card->mixer_regs[reg / 2][id];
3237 return data;
3240 static void
3241 ali_ac97_write(struct ac97_codec *codec, u8 reg, u16 val)
3243 int id;
3244 struct trident_card *card;
3246 /* Added by Matt Wu */
3247 if (!codec)
3248 BUG();
3250 card = (struct trident_card *) codec->private_data;
3252 if (!card->mixer_regs_ready) {
3253 ali_ac97_set(card, codec->id, reg, val);
3254 return;
3257 if (codec->id)
3258 id = 1;
3259 else
3260 id = 0;
3262 card->mixer_regs[reg / 2][id] = val;
3263 ali_ac97_set(card, codec->id, reg, val);
3267 flag: ALI_SPDIF_OUT_TO_SPDIF_OUT
3268 ALI_PCM_TO_SPDIF_OUT
3271 static void
3272 ali_setup_spdif_out(struct trident_card *card, int flag)
3274 unsigned long spdif;
3275 unsigned char ch;
3277 char temp;
3278 struct pci_dev *pci_dev = NULL;
3280 pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533,
3281 pci_dev);
3282 if (pci_dev == NULL)
3283 return;
3284 pci_read_config_byte(pci_dev, 0x61, &temp);
3285 temp |= 0x40;
3286 pci_write_config_byte(pci_dev, 0x61, temp);
3287 pci_read_config_byte(pci_dev, 0x7d, &temp);
3288 temp |= 0x01;
3289 pci_write_config_byte(pci_dev, 0x7d, temp);
3290 pci_read_config_byte(pci_dev, 0x7e, &temp);
3291 temp &= (~0x20);
3292 temp |= 0x10;
3293 pci_write_config_byte(pci_dev, 0x7e, temp);
3295 ch = inb(TRID_REG(card, ALI_SCTRL));
3296 outb(ch | ALI_SPDIF_OUT_ENABLE, TRID_REG(card, ALI_SCTRL));
3297 ch = inb(TRID_REG(card, ALI_SPDIF_CTRL));
3298 outb(ch & ALI_SPDIF_OUT_CH_STATUS, TRID_REG(card, ALI_SPDIF_CTRL));
3300 if (flag & ALI_SPDIF_OUT_TO_SPDIF_OUT) {
3301 spdif = inw(TRID_REG(card, ALI_GLOBAL_CONTROL));
3302 spdif |= ALI_SPDIF_OUT_CH_ENABLE;
3303 spdif &= ALI_SPDIF_OUT_SEL_SPDIF;
3304 outw(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
3305 spdif = inw(TRID_REG(card, ALI_SPDIF_CS));
3306 if (flag & ALI_SPDIF_OUT_NON_PCM)
3307 spdif |= 0x0002;
3308 else
3309 spdif &= (~0x0002);
3310 outw(spdif, TRID_REG(card, ALI_SPDIF_CS));
3311 } else {
3312 spdif = inw(TRID_REG(card, ALI_GLOBAL_CONTROL));
3313 spdif |= ALI_SPDIF_OUT_SEL_PCM;
3314 outw(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
3318 static void
3319 ali_disable_special_channel(struct trident_card *card, int ch)
3321 unsigned long sc;
3323 sc = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
3324 sc &= ~(1 << ch);
3325 outl(sc, TRID_REG(card, ALI_GLOBAL_CONTROL));
3328 static void
3329 ali_disable_spdif_in(struct trident_card *card)
3331 unsigned long spdif;
3333 spdif = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
3334 spdif &= (~ALI_SPDIF_IN_SUPPORT);
3335 outl(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
3337 ali_disable_special_channel(card, ALI_SPDIF_IN_CHANNEL);
3340 static void
3341 ali_setup_spdif_in(struct trident_card *card)
3343 unsigned long spdif;
3345 //Set SPDIF IN Supported
3346 spdif = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
3347 spdif |= ALI_SPDIF_IN_SUPPORT;
3348 outl(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
3350 //Set SPDIF IN Rec
3351 spdif = inl(TRID_REG(card, ALI_GLOBAL_CONTROL));
3352 spdif |= ALI_SPDIF_IN_CH_ENABLE;
3353 outl(spdif, TRID_REG(card, ALI_GLOBAL_CONTROL));
3355 spdif = inb(TRID_REG(card, ALI_SPDIF_CTRL));
3356 spdif |= ALI_SPDIF_IN_CH_STATUS;
3357 outb(spdif, TRID_REG(card, ALI_SPDIF_CTRL));
3359 spdif = inb(TRID_REG(card, ALI_SPDIF_CTRL));
3360 spdif |= ALI_SPDIF_IN_FUNC_ENABLE;
3361 outb(spdif, TRID_REG(card, ALI_SPDIF_CTRL));
3365 static void
3366 ali_delay(struct trident_card *card, int interval)
3368 unsigned long begintimer, currenttimer;
3370 begintimer = inl(TRID_REG(card, ALI_STIMER));
3371 currenttimer = inl(TRID_REG(card, ALI_STIMER));
3373 while (currenttimer < begintimer + interval)
3374 currenttimer = inl(TRID_REG(card, ALI_STIMER));
3377 static void
3378 ali_detect_spdif_rate(struct trident_card *card)
3380 u16 wval = 0;
3381 u16 count = 0;
3382 u8 bval = 0, R1 = 0, R2 = 0;
3384 bval = inb(TRID_REG(card, ALI_SPDIF_CTRL));
3385 bval |= 0x02;
3386 outb(bval, TRID_REG(card, ALI_SPDIF_CTRL));
3388 bval = inb(TRID_REG(card, ALI_SPDIF_CTRL + 1));
3389 bval |= 0x1F;
3390 outb(bval, TRID_REG(card, ALI_SPDIF_CTRL + 1));
3392 while (((R1 < 0x0B) || (R1 > 0x0E)) && (R1 != 0x12) &&
3393 count <= 50000) {
3394 count++;
3396 ali_delay(card, 6);
3398 bval = inb(TRID_REG(card, ALI_SPDIF_CTRL + 1));
3399 R1 = bval & 0x1F;
3402 if (count > 50000) {
3403 printk(KERN_WARNING "trident: Error in "
3404 "ali_detect_spdif_rate!\n");
3405 return;
3408 count = 0;
3410 while (count <= 50000) {
3411 count++;
3413 ali_delay(card, 6);
3415 bval = inb(TRID_REG(card, ALI_SPDIF_CTRL + 1));
3416 R2 = bval & 0x1F;
3418 if (R2 != R1)
3419 R1 = R2;
3420 else
3421 break;
3424 if (count > 50000) {
3425 printk(KERN_WARNING "trident: Error in "
3426 "ali_detect_spdif_rate!\n");
3427 return;
3430 switch (R2) {
3431 case 0x0b:
3432 case 0x0c:
3433 case 0x0d:
3434 case 0x0e:
3435 wval = inw(TRID_REG(card, ALI_SPDIF_CTRL + 2));
3436 wval &= 0xE0F0;
3437 wval |= (u16) 0x09 << 8 | (u16) 0x05;
3438 outw(wval, TRID_REG(card, ALI_SPDIF_CTRL + 2));
3440 bval = inb(TRID_REG(card, ALI_SPDIF_CS + 3)) & 0xF0;
3441 outb(bval | 0x02, TRID_REG(card, ALI_SPDIF_CS + 3));
3442 break;
3444 case 0x12:
3445 wval = inw(TRID_REG(card, ALI_SPDIF_CTRL + 2));
3446 wval &= 0xE0F0;
3447 wval |= (u16) 0x0E << 8 | (u16) 0x08;
3448 outw(wval, TRID_REG(card, ALI_SPDIF_CTRL + 2));
3450 bval = inb(TRID_REG(card, ALI_SPDIF_CS + 3)) & 0xF0;
3451 outb(bval | 0x03, TRID_REG(card, ALI_SPDIF_CS + 3));
3452 break;
3454 default:
3455 break;
3460 static unsigned int
3461 ali_get_spdif_in_rate(struct trident_card *card)
3463 u32 dwRate = 0;
3464 u8 bval = 0;
3466 ali_detect_spdif_rate(card);
3468 bval = inb(TRID_REG(card, ALI_SPDIF_CTRL));
3469 bval &= 0x7F;
3470 bval |= 0x40;
3471 outb(bval, TRID_REG(card, ALI_SPDIF_CTRL));
3473 bval = inb(TRID_REG(card, ALI_SPDIF_CS + 3));
3474 bval &= 0x0F;
3476 switch (bval) {
3477 case 0:
3478 dwRate = 44100;
3479 break;
3480 case 1:
3481 dwRate = 48000;
3482 break;
3483 case 2:
3484 dwRate = 32000;
3485 break;
3486 default:
3487 // Error occurs
3488 break;
3491 return dwRate;
3495 static int
3496 ali_close_multi_channels(void)
3498 char temp = 0;
3499 struct pci_dev *pci_dev = NULL;
3501 pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533,
3502 pci_dev);
3503 if (pci_dev == NULL)
3504 return -1;
3505 pci_read_config_byte(pci_dev, 0x59, &temp);
3506 temp &= ~0x80;
3507 pci_write_config_byte(pci_dev, 0x59, temp);
3509 pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M7101,
3510 pci_dev);
3511 if (pci_dev == NULL)
3512 return -1;
3514 pci_read_config_byte(pci_dev, 0xB8, &temp);
3515 temp &= ~0x20;
3516 pci_write_config_byte(pci_dev, 0xB8, temp);
3518 return 0;
3521 static int
3522 ali_setup_multi_channels(struct trident_card *card, int chan_nums)
3524 unsigned long dwValue;
3525 char temp = 0;
3526 struct pci_dev *pci_dev = NULL;
3528 pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533,
3529 pci_dev);
3530 if (pci_dev == NULL)
3531 return -1;
3532 pci_read_config_byte(pci_dev, 0x59, &temp);
3533 temp |= 0x80;
3534 pci_write_config_byte(pci_dev, 0x59, temp);
3536 pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M7101,
3537 pci_dev);
3538 if (pci_dev == NULL)
3539 return -1;
3540 pci_read_config_byte(pci_dev, (int) 0xB8, &temp);
3541 temp |= 0x20;
3542 pci_write_config_byte(pci_dev, (int) 0xB8, (u8) temp);
3543 if (chan_nums == 6) {
3544 dwValue = inl(TRID_REG(card, ALI_SCTRL)) | 0x000f0000;
3545 outl(dwValue, TRID_REG(card, ALI_SCTRL));
3546 mdelay(4);
3547 dwValue = inl(TRID_REG(card, ALI_SCTRL));
3548 if (dwValue & 0x2000000) {
3549 ali_ac97_write(card->ac97_codec[0], 0x02, 8080);
3550 ali_ac97_write(card->ac97_codec[0], 0x36, 0);
3551 ali_ac97_write(card->ac97_codec[0], 0x38, 0);
3553 * On a board with a single codec you won't get the
3554 * surround. On other boards configure it.
3556 if (card->ac97_codec[1] != NULL) {
3557 ali_ac97_write(card->ac97_codec[1], 0x36, 0);
3558 ali_ac97_write(card->ac97_codec[1], 0x38, 0);
3559 ali_ac97_write(card->ac97_codec[1], 0x02, 0x0606);
3560 ali_ac97_write(card->ac97_codec[1], 0x18, 0x0303);
3561 ali_ac97_write(card->ac97_codec[1], 0x74, 0x3);
3563 return 1;
3566 return -EINVAL;
3569 static void
3570 ali_free_pcm_channel(struct trident_card *card, unsigned int channel)
3572 int bank;
3574 if (channel > 31)
3575 return;
3577 bank = channel >> 5;
3578 channel = channel & 0x1f;
3580 card->banks[bank].bitmap &= ~(1 << (channel));
3583 static int
3584 ali_allocate_other_states_resources(struct trident_state *state, int chan_nums)
3586 struct trident_card *card = state->card;
3587 struct trident_state *s;
3588 int i, state_count = 0;
3589 struct trident_pcm_bank *bank;
3590 struct trident_channel *channel;
3591 unsigned long num;
3593 bank = &card->banks[BANK_A];
3595 if (chan_nums != 6)
3596 return 0;
3598 for (i = 0; (i < ALI_CHANNELS) && (state_count != 4); i++) {
3599 if (card->states[i])
3600 continue;
3602 num = ali_multi_channels_5_1[state_count];
3603 if (!(bank->bitmap & (1 << num))) {
3604 bank->bitmap |= 1 << num;
3605 channel = &bank->channels[num];
3606 channel->num = num;
3607 } else {
3608 state_count--;
3609 for (; state_count >= 0; state_count--) {
3610 kfree(state->other_states[state_count]);
3611 num = ali_multi_channels_5_1[state_count];
3612 ali_free_pcm_channel(card, num);
3614 return -EBUSY;
3616 s = card->states[i] = kmalloc(sizeof(*state), GFP_KERNEL);
3617 if (!s) {
3618 num = ali_multi_channels_5_1[state_count];
3619 ali_free_pcm_channel(card, num);
3620 state_count--;
3621 for (; state_count >= 0; state_count--) {
3622 num = ali_multi_channels_5_1[state_count];
3623 ali_free_pcm_channel(card, num);
3624 kfree(state->other_states[state_count]);
3626 return -ENOMEM;
3628 memset(s, 0, sizeof(*state));
3630 s->dmabuf.channel = channel;
3631 s->dmabuf.ossfragshift = s->dmabuf.ossmaxfrags =
3632 s->dmabuf.subdivision = 0;
3633 init_waitqueue_head(&s->dmabuf.wait);
3634 s->magic = card->magic;
3635 s->card = card;
3636 s->virt = i;
3637 ali_enable_special_channel(s);
3638 state->other_states[state_count++] = s;
3641 if (state_count != 4) {
3642 state_count--;
3643 for (; state_count >= 0; state_count--) {
3644 kfree(state->other_states[state_count]);
3645 num = ali_multi_channels_5_1[state_count];
3646 ali_free_pcm_channel(card, num);
3648 return -EBUSY;
3650 return 0;
3653 static void
3654 ali_save_regs(struct trident_card *card)
3656 unsigned long flags;
3657 int i, j;
3659 spin_lock_irqsave(&card->lock, flags);
3661 ali_registers.global_regs[0x2c] = inl(TRID_REG(card, T4D_MISCINT));
3662 //ali_registers.global_regs[0x20] = inl(TRID_REG(card,T4D_START_A));
3663 ali_registers.global_regs[0x21] = inl(TRID_REG(card, T4D_STOP_A));
3665 //disable all IRQ bits
3666 outl(ALI_DISABLE_ALL_IRQ, TRID_REG(card, T4D_MISCINT));
3668 for (i = 1; i < ALI_MIXER_REGS; i++)
3669 ali_registers.mixer_regs[i] = ali_ac97_read(card->ac97_codec[0],
3670 i * 2);
3672 for (i = 0; i < ALI_GLOBAL_REGS; i++) {
3673 if ((i * 4 == T4D_MISCINT) || (i * 4 == T4D_STOP_A))
3674 continue;
3675 ali_registers.global_regs[i] = inl(TRID_REG(card, i * 4));
3678 for (i = 0; i < ALI_CHANNELS; i++) {
3679 outb(i, TRID_REG(card, T4D_LFO_GC_CIR));
3680 for (j = 0; j < ALI_CHANNEL_REGS; j++)
3681 ali_registers.channel_regs[i][j] = inl(TRID_REG(card,
3682 j * 4 + 0xe0));
3685 //Stop all HW channel
3686 outl(ALI_STOP_ALL_CHANNELS, TRID_REG(card, T4D_STOP_A));
3688 spin_unlock_irqrestore(&card->lock, flags);
3691 static void
3692 ali_restore_regs(struct trident_card *card)
3694 unsigned long flags;
3695 int i, j;
3697 spin_lock_irqsave(&card->lock, flags);
3699 for (i = 1; i < ALI_MIXER_REGS; i++)
3700 ali_ac97_write(card->ac97_codec[0], i * 2,
3701 ali_registers.mixer_regs[i]);
3703 for (i = 0; i < ALI_CHANNELS; i++) {
3704 outb(i, TRID_REG(card, T4D_LFO_GC_CIR));
3705 for (j = 0; j < ALI_CHANNEL_REGS; j++)
3706 outl(ali_registers.channel_regs[i][j],
3707 TRID_REG(card, j * 4 + 0xe0));
3710 for (i = 0; i < ALI_GLOBAL_REGS; i++) {
3711 if ((i * 4 == T4D_MISCINT) || (i * 4 == T4D_STOP_A) ||
3712 (i * 4 == T4D_START_A))
3713 continue;
3714 outl(ali_registers.global_regs[i], TRID_REG(card, i * 4));
3717 //start HW channel
3718 outl(ali_registers.global_regs[0x20], TRID_REG(card, T4D_START_A));
3719 //restore IRQ enable bits
3720 outl(ali_registers.global_regs[0x2c], TRID_REG(card, T4D_MISCINT));
3722 spin_unlock_irqrestore(&card->lock, flags);
3725 static int
3726 trident_suspend(struct pci_dev *dev, pm_message_t unused)
3728 struct trident_card *card = pci_get_drvdata(dev);
3730 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
3731 ali_save_regs(card);
3733 return 0;
3736 static int
3737 trident_resume(struct pci_dev *dev)
3739 struct trident_card *card = pci_get_drvdata(dev);
3741 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
3742 ali_restore_regs(card);
3744 return 0;
3747 static struct trident_channel *
3748 ali_alloc_pcm_channel(struct trident_card *card)
3750 struct trident_pcm_bank *bank;
3751 int idx;
3753 bank = &card->banks[BANK_A];
3755 if (inl(TRID_REG(card, ALI_GLOBAL_CONTROL)) &
3756 (ALI_SPDIF_OUT_CH_ENABLE)) {
3757 idx = ALI_SPDIF_OUT_CHANNEL;
3758 if (!(bank->bitmap & (1 << idx))) {
3759 struct trident_channel *channel = &bank->channels[idx];
3760 bank->bitmap |= 1 << idx;
3761 channel->num = idx;
3762 return channel;
3766 for (idx = ALI_PCM_OUT_CHANNEL_FIRST; idx <= ALI_PCM_OUT_CHANNEL_LAST;
3767 idx++) {
3768 if (!(bank->bitmap & (1 << idx))) {
3769 struct trident_channel *channel = &bank->channels[idx];
3770 bank->bitmap |= 1 << idx;
3771 channel->num = idx;
3772 return channel;
3776 /* no more free channels avaliable */
3777 #if 0
3778 printk(KERN_ERR "ali: no more channels available on Bank A.\n");
3779 #endif /* 0 */
3780 return NULL;
3783 static struct trident_channel *
3784 ali_alloc_rec_pcm_channel(struct trident_card *card)
3786 struct trident_pcm_bank *bank;
3787 int idx;
3789 if (inl(TRID_REG(card, ALI_GLOBAL_CONTROL)) & ALI_SPDIF_IN_SUPPORT)
3790 idx = ALI_SPDIF_IN_CHANNEL;
3791 else
3792 idx = ALI_PCM_IN_CHANNEL;
3794 bank = &card->banks[BANK_A];
3796 if (!(bank->bitmap & (1 << idx))) {
3797 struct trident_channel *channel = &bank->channels[idx];
3798 bank->bitmap |= 1 << idx;
3799 channel->num = idx;
3800 return channel;
3803 /* no free recordable channels avaliable */
3804 #if 0
3805 printk(KERN_ERR "ali: no recordable channels available on Bank A.\n");
3806 #endif /* 0 */
3807 return NULL;
3810 static void
3811 ali_set_spdif_out_rate(struct trident_card *card, unsigned int rate)
3813 unsigned char ch_st_sel;
3814 unsigned short status_rate;
3816 switch (rate) {
3817 case 44100:
3818 status_rate = 0;
3819 break;
3820 case 32000:
3821 status_rate = 0x300;
3822 break;
3823 case 48000:
3824 default:
3825 status_rate = 0x200;
3826 break;
3829 /* select spdif_out */
3830 ch_st_sel = inb(TRID_REG(card, ALI_SPDIF_CTRL)) & ALI_SPDIF_OUT_CH_STATUS;
3832 ch_st_sel |= 0x80; /* select right */
3833 outb(ch_st_sel, TRID_REG(card, ALI_SPDIF_CTRL));
3834 outb(status_rate | 0x20, TRID_REG(card, ALI_SPDIF_CS + 2));
3836 ch_st_sel &= (~0x80); /* select left */
3837 outb(ch_st_sel, TRID_REG(card, ALI_SPDIF_CTRL));
3838 outw(status_rate | 0x10, TRID_REG(card, ALI_SPDIF_CS + 2));
3841 static void
3842 ali_address_interrupt(struct trident_card *card)
3844 int i, channel;
3845 struct trident_state *state;
3846 u32 mask, channel_mask;
3848 mask = trident_get_interrupt_mask(card, 0);
3849 for (i = 0; i < NR_HW_CH; i++) {
3850 if ((state = card->states[i]) == NULL)
3851 continue;
3852 channel = state->dmabuf.channel->num;
3853 if ((channel_mask = 1 << channel) & mask) {
3854 mask &= ~channel_mask;
3855 trident_ack_channel_interrupt(card, channel);
3856 udelay(100);
3857 state->dmabuf.update_flag |= ALI_ADDRESS_INT_UPDATE;
3858 trident_update_ptr(state);
3861 if (mask) {
3862 for (i = 0; i < NR_HW_CH; i++) {
3863 if (mask & (1 << i)) {
3864 printk("ali: spurious channel irq %d.\n", i);
3865 trident_ack_channel_interrupt(card, i);
3866 trident_stop_voice(card, i);
3867 trident_disable_voice_irq(card, i);
3873 /* Updating the values of counters of other_states' DMAs without lock
3874 protection is no harm because all DMAs of multi-channels and interrupt
3875 depend on a master state's DMA, and changing the counters of the master
3876 state DMA is protected by a spinlock.
3878 static int
3879 ali_write_5_1(struct trident_state *state, const char __user *buf,
3880 int cnt_for_multi_channel, unsigned int *copy_count,
3881 unsigned int *state_cnt)
3884 struct dmabuf *dmabuf = &state->dmabuf;
3885 struct dmabuf *dmabuf_temp;
3886 const char __user *buffer = buf;
3887 unsigned swptr, other_dma_nums, sample_s;
3888 unsigned int i, loop;
3890 other_dma_nums = 4;
3891 sample_s = sample_size[dmabuf->fmt] >> 1;
3892 swptr = dmabuf->swptr;
3894 if ((i = state->multi_channels_adjust_count) > 0) {
3895 if (i == 1) {
3896 if (copy_from_user(dmabuf->rawbuf + swptr,
3897 buffer, sample_s))
3898 return -EFAULT;
3899 seek_offset(swptr, buffer, cnt_for_multi_channel,
3900 sample_s, *copy_count);
3901 i--;
3902 (*state_cnt) += sample_s;
3903 state->multi_channels_adjust_count++;
3904 } else
3905 i = i - (state->chans_num - other_dma_nums);
3906 for (; (i < other_dma_nums) && (cnt_for_multi_channel > 0); i++) {
3907 dmabuf_temp = &state->other_states[i]->dmabuf;
3908 if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
3909 buffer, sample_s))
3910 return -EFAULT;
3911 seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
3912 sample_s, *copy_count);
3914 if (cnt_for_multi_channel == 0)
3915 state->multi_channels_adjust_count += i;
3917 if (cnt_for_multi_channel > 0) {
3918 loop = cnt_for_multi_channel / (state->chans_num * sample_s);
3919 for (i = 0; i < loop; i++) {
3920 if (copy_from_user(dmabuf->rawbuf + swptr, buffer,
3921 sample_s * 2))
3922 return -EFAULT;
3923 seek_offset(swptr, buffer, cnt_for_multi_channel,
3924 sample_s * 2, *copy_count);
3925 (*state_cnt) += (sample_s * 2);
3927 dmabuf_temp = &state->other_states[0]->dmabuf;
3928 if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
3929 buffer, sample_s))
3930 return -EFAULT;
3931 seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
3932 sample_s, *copy_count);
3934 dmabuf_temp = &state->other_states[1]->dmabuf;
3935 if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
3936 buffer, sample_s))
3937 return -EFAULT;
3938 seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
3939 sample_s, *copy_count);
3941 dmabuf_temp = &state->other_states[2]->dmabuf;
3942 if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
3943 buffer, sample_s))
3944 return -EFAULT;
3945 seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
3946 sample_s, *copy_count);
3948 dmabuf_temp = &state->other_states[3]->dmabuf;
3949 if (copy_from_user(dmabuf_temp->rawbuf + dmabuf_temp->swptr,
3950 buffer, sample_s))
3951 return -EFAULT;
3952 seek_offset(dmabuf_temp->swptr, buffer, cnt_for_multi_channel,
3953 sample_s, *copy_count);
3956 if (cnt_for_multi_channel > 0) {
3957 state->multi_channels_adjust_count = cnt_for_multi_channel / sample_s;
3959 if (copy_from_user(dmabuf->rawbuf + swptr, buffer, sample_s))
3960 return -EFAULT;
3961 seek_offset(swptr, buffer, cnt_for_multi_channel,
3962 sample_s, *copy_count);
3963 (*state_cnt) += sample_s;
3965 if (cnt_for_multi_channel > 0) {
3966 if (copy_from_user(dmabuf->rawbuf + swptr,
3967 buffer, sample_s))
3968 return -EFAULT;
3969 seek_offset(swptr, buffer, cnt_for_multi_channel,
3970 sample_s, *copy_count);
3971 (*state_cnt) += sample_s;
3973 if (cnt_for_multi_channel > 0) {
3974 int diff = state->chans_num - other_dma_nums;
3975 loop = state->multi_channels_adjust_count - diff;
3976 for (i = 0; i < loop; i++) {
3977 dmabuf_temp = &state->other_states[i]->dmabuf;
3978 if (copy_from_user(dmabuf_temp->rawbuf +
3979 dmabuf_temp->swptr,
3980 buffer, sample_s))
3981 return -EFAULT;
3982 seek_offset(dmabuf_temp->swptr, buffer,
3983 cnt_for_multi_channel,
3984 sample_s, *copy_count);
3988 } else
3989 state->multi_channels_adjust_count = 0;
3991 for (i = 0; i < other_dma_nums; i++) {
3992 dmabuf_temp = &state->other_states[i]->dmabuf;
3993 dmabuf_temp->swptr = dmabuf_temp->swptr % dmabuf_temp->dmasize;
3995 return *state_cnt;
3998 static void
3999 ali_free_other_states_resources(struct trident_state *state)
4001 int i;
4002 struct trident_card *card = state->card;
4003 struct trident_state *s;
4004 unsigned other_states_count;
4006 other_states_count = state->chans_num - 2; /* except PCM L/R channels */
4007 for (i = 0; i < other_states_count; i++) {
4008 s = state->other_states[i];
4009 dealloc_dmabuf(&s->dmabuf, card->pci_dev);
4010 ali_disable_special_channel(s->card, s->dmabuf.channel->num);
4011 state->card->free_pcm_channel(s->card, s->dmabuf.channel->num);
4012 card->states[s->virt] = NULL;
4013 kfree(s);
4017 static struct proc_dir_entry *res;
4019 static int
4020 ali_write_proc(struct file *file, const char __user *buffer, unsigned long count, void *data)
4022 struct trident_card *card = (struct trident_card *) data;
4023 unsigned long flags;
4024 char c;
4026 if (count < 0)
4027 return -EINVAL;
4028 if (count == 0)
4029 return 0;
4030 if (get_user(c, buffer))
4031 return -EFAULT;
4033 spin_lock_irqsave(&card->lock, flags);
4034 switch (c) {
4035 case '0':
4036 ali_setup_spdif_out(card, ALI_PCM_TO_SPDIF_OUT);
4037 ali_disable_special_channel(card, ALI_SPDIF_OUT_CHANNEL);
4038 break;
4039 case '1':
4040 ali_setup_spdif_out(card, ALI_SPDIF_OUT_TO_SPDIF_OUT |
4041 ALI_SPDIF_OUT_PCM);
4042 break;
4043 case '2':
4044 ali_setup_spdif_out(card, ALI_SPDIF_OUT_TO_SPDIF_OUT |
4045 ALI_SPDIF_OUT_NON_PCM);
4046 break;
4047 case '3':
4048 ali_disable_spdif_in(card); //default
4049 break;
4050 case '4':
4051 ali_setup_spdif_in(card);
4052 break;
4054 spin_unlock_irqrestore(&card->lock, flags);
4056 return count;
4059 /* OSS /dev/mixer file operation methods */
4060 static int
4061 trident_open_mixdev(struct inode *inode, struct file *file)
4063 int i = 0;
4064 int minor = iminor(inode);
4065 struct trident_card *card = devs;
4067 for (card = devs; card != NULL; card = card->next)
4068 for (i = 0; i < NR_AC97; i++)
4069 if (card->ac97_codec[i] != NULL &&
4070 card->ac97_codec[i]->dev_mixer == minor)
4071 goto match;
4073 if (!card) {
4074 return -ENODEV;
4076 match:
4077 file->private_data = card->ac97_codec[i];
4079 return nonseekable_open(inode, file);
4082 static int
4083 trident_ioctl_mixdev(struct inode *inode, struct file *file, unsigned int cmd,
4084 unsigned long arg)
4086 struct ac97_codec *codec = (struct ac97_codec *) file->private_data;
4088 return codec->mixer_ioctl(codec, cmd, arg);
4091 static /*const */ struct file_operations trident_mixer_fops = {
4092 .owner = THIS_MODULE,
4093 .llseek = no_llseek,
4094 .ioctl = trident_ioctl_mixdev,
4095 .open = trident_open_mixdev,
4098 static int
4099 ali_reset_5451(struct trident_card *card)
4101 struct pci_dev *pci_dev = NULL;
4102 unsigned int dwVal;
4103 unsigned short wCount, wReg;
4105 pci_dev = pci_find_device(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1533,
4106 pci_dev);
4107 if (pci_dev == NULL)
4108 return -1;
4110 pci_read_config_dword(pci_dev, 0x7c, &dwVal);
4111 pci_write_config_dword(pci_dev, 0x7c, dwVal | 0x08000000);
4112 udelay(5000);
4113 pci_read_config_dword(pci_dev, 0x7c, &dwVal);
4114 pci_write_config_dword(pci_dev, 0x7c, dwVal & 0xf7ffffff);
4115 udelay(5000);
4117 pci_dev = card->pci_dev;
4118 if (pci_dev == NULL)
4119 return -1;
4121 pci_read_config_dword(pci_dev, 0x44, &dwVal);
4122 pci_write_config_dword(pci_dev, 0x44, dwVal | 0x000c0000);
4123 udelay(500);
4124 pci_read_config_dword(pci_dev, 0x44, &dwVal);
4125 pci_write_config_dword(pci_dev, 0x44, dwVal & 0xfffbffff);
4126 udelay(5000);
4128 /* TODO: recognize if we have a PM capable codec and only do this */
4129 /* if the codec is PM capable */
4130 wCount = 2000;
4131 while (wCount--) {
4132 wReg = ali_ac97_get(card, 0, AC97_POWER_CONTROL);
4133 if ((wReg & 0x000f) == 0x000f)
4134 return 0;
4135 udelay(5000);
4137 /* This is non fatal if you have a non PM capable codec.. */
4138 return 0;
4141 /* AC97 codec initialisation. */
4142 static int __devinit
4143 trident_ac97_init(struct trident_card *card)
4145 int num_ac97 = 0;
4146 unsigned long ready_2nd = 0;
4147 struct ac97_codec *codec;
4148 int i = 0;
4150 /* initialize controller side of AC link, and find out if secondary codes
4151 really exist */
4152 switch (card->pci_id) {
4153 case PCI_DEVICE_ID_ALI_5451:
4154 if (ali_reset_5451(card)) {
4155 printk(KERN_ERR "trident_ac97_init: error "
4156 "resetting 5451.\n");
4157 return -1;
4159 outl(0x80000001, TRID_REG(card, ALI_GLOBAL_CONTROL));
4160 outl(0x00000000, TRID_REG(card, T4D_AINTEN_A));
4161 outl(0xffffffff, TRID_REG(card, T4D_AINT_A));
4162 outl(0x00000000, TRID_REG(card, T4D_MUSICVOL_WAVEVOL));
4163 outb(0x10, TRID_REG(card, ALI_MPUR2));
4164 ready_2nd = inl(TRID_REG(card, ALI_SCTRL));
4165 ready_2nd &= 0x3fff;
4166 outl(ready_2nd | PCMOUT | 0x8000, TRID_REG(card, ALI_SCTRL));
4167 ready_2nd = inl(TRID_REG(card, ALI_SCTRL));
4168 ready_2nd &= SI_AC97_SECONDARY_READY;
4169 if (card->revision < ALI_5451_V02)
4170 ready_2nd = 0;
4171 break;
4172 case PCI_DEVICE_ID_SI_7018:
4173 /* disable AC97 GPIO interrupt */
4174 outl(0x00, TRID_REG(card, SI_AC97_GPIO));
4175 /* when power up the AC link is in cold reset mode so stop it */
4176 outl(PCMOUT | SURROUT | CENTEROUT | LFEOUT | SECONDARY_ID,
4177 TRID_REG(card, SI_SERIAL_INTF_CTRL));
4178 /* it take a long time to recover from a cold reset */
4179 /* (especially when you have more than one codec) */
4180 udelay(2000);
4181 ready_2nd = inl(TRID_REG(card, SI_SERIAL_INTF_CTRL));
4182 ready_2nd &= SI_AC97_SECONDARY_READY;
4183 break;
4184 case PCI_DEVICE_ID_TRIDENT_4DWAVE_DX:
4185 /* playback on */
4186 outl(DX_AC97_PLAYBACK, TRID_REG(card, DX_ACR2_AC97_COM_STAT));
4187 break;
4188 case PCI_DEVICE_ID_TRIDENT_4DWAVE_NX:
4189 /* enable AC97 Output Slot 3,4 (PCM Left/Right Playback) */
4190 outl(NX_AC97_PCM_OUTPUT, TRID_REG(card, NX_ACR0_AC97_COM_STAT));
4191 ready_2nd = inl(TRID_REG(card, NX_ACR0_AC97_COM_STAT));
4192 ready_2nd &= NX_AC97_SECONDARY_READY;
4193 break;
4194 case PCI_DEVICE_ID_INTERG_5050:
4195 /* disable AC97 GPIO interrupt */
4196 outl(0x00, TRID_REG(card, SI_AC97_GPIO));
4197 /* when power up, the AC link is in cold reset mode, so stop it */
4198 outl(PCMOUT | SURROUT | CENTEROUT | LFEOUT,
4199 TRID_REG(card, SI_SERIAL_INTF_CTRL));
4200 /* it take a long time to recover from a cold reset (especially */
4201 /* when you have more than one codec) */
4202 udelay(2000);
4203 ready_2nd = inl(TRID_REG(card, SI_SERIAL_INTF_CTRL));
4204 ready_2nd &= SI_AC97_SECONDARY_READY;
4205 break;
4208 for (num_ac97 = 0; num_ac97 < NR_AC97; num_ac97++) {
4209 if ((codec = ac97_alloc_codec()) == NULL)
4210 return -ENOMEM;
4212 /* initialize some basic codec information, other fields */
4213 /* will be filled in ac97_probe_codec */
4214 codec->private_data = card;
4215 codec->id = num_ac97;
4217 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
4218 codec->codec_read = ali_ac97_read;
4219 codec->codec_write = ali_ac97_write;
4220 } else {
4221 codec->codec_read = trident_ac97_get;
4222 codec->codec_write = trident_ac97_set;
4225 if (ac97_probe_codec(codec) == 0)
4226 break;
4228 codec->dev_mixer = register_sound_mixer(&trident_mixer_fops, -1);
4229 if (codec->dev_mixer < 0) {
4230 printk(KERN_ERR "trident: couldn't register mixer!\n");
4231 ac97_release_codec(codec);
4232 break;
4235 card->ac97_codec[num_ac97] = codec;
4237 /* if there is no secondary codec at all, don't probe any more */
4238 if (!ready_2nd)
4239 break;
4242 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
4243 for (num_ac97 = 0; num_ac97 < NR_AC97; num_ac97++) {
4244 if (card->ac97_codec[num_ac97] == NULL)
4245 break;
4246 for (i = 0; i < 64; i++) {
4247 u16 reg = ali_ac97_get(card, num_ac97, i * 2);
4248 card->mixer_regs[i][num_ac97] = reg;
4252 return num_ac97 + 1;
4255 /* Gameport functions for the cards ADC gameport */
4257 static unsigned char
4258 trident_game_read(struct gameport *gameport)
4260 struct trident_card *card = gameport->port_data;
4261 return inb(TRID_REG(card, T4D_GAME_LEG));
4264 static void
4265 trident_game_trigger(struct gameport *gameport)
4267 struct trident_card *card = gameport->port_data;
4268 outb(0xff, TRID_REG(card, T4D_GAME_LEG));
4271 static int
4272 trident_game_cooked_read(struct gameport *gameport, int *axes, int *buttons)
4274 struct trident_card *card = gameport->port_data;
4275 int i;
4277 *buttons = (~inb(TRID_REG(card, T4D_GAME_LEG)) >> 4) & 0xf;
4279 for (i = 0; i < 4; i++) {
4280 axes[i] = inw(TRID_REG(card, T4D_GAME_AXD) + i * sizeof (u16));
4281 if (axes[i] == 0xffff)
4282 axes[i] = -1;
4285 return 0;
4288 static int
4289 trident_game_open(struct gameport *gameport, int mode)
4291 struct trident_card *card = gameport->port_data;
4293 switch (mode) {
4294 case GAMEPORT_MODE_COOKED:
4295 outb(0x80, TRID_REG(card, T4D_GAME_CR));
4296 msleep(20);
4297 return 0;
4298 case GAMEPORT_MODE_RAW:
4299 outb(0x00, TRID_REG(card, T4D_GAME_CR));
4300 return 0;
4301 default:
4302 return -1;
4305 return 0;
4308 static int __devinit
4309 trident_register_gameport(struct trident_card *card)
4311 struct gameport *gp;
4313 card->gameport = gp = gameport_allocate_port();
4314 if (!gp) {
4315 printk(KERN_ERR "trident: can not allocate memory for gameport\n");
4316 return -ENOMEM;
4319 gameport_set_name(gp, "Trident 4DWave");
4320 gameport_set_phys(gp, "pci%s/gameport0", pci_name(card->pci_dev));
4321 gp->read = trident_game_read;
4322 gp->trigger = trident_game_trigger;
4323 gp->cooked_read = trident_game_cooked_read;
4324 gp->open = trident_game_open;
4325 gp->fuzz = 64;
4326 gp->port_data = card;
4328 gameport_register_port(gp);
4330 return 0;
4333 /* install the driver, we do not allocate hardware channel nor DMA buffer */
4334 /* now, they are defered until "ACCESS" time (in prog_dmabuf called by */
4335 /* open/read/write/ioctl/mmap) */
4336 static int __devinit
4337 trident_probe(struct pci_dev *pci_dev, const struct pci_device_id *pci_id)
4339 unsigned long iobase;
4340 struct trident_card *card;
4341 u8 bits;
4342 u8 revision;
4343 int i = 0;
4344 u16 temp;
4345 struct pci_dev *pci_dev_m1533 = NULL;
4346 int rc = -ENODEV;
4347 u64 dma_mask;
4349 if (pci_enable_device(pci_dev))
4350 goto out;
4352 if (pci_dev->device == PCI_DEVICE_ID_ALI_5451)
4353 dma_mask = ALI_DMA_MASK;
4354 else
4355 dma_mask = TRIDENT_DMA_MASK;
4356 if (pci_set_dma_mask(pci_dev, dma_mask)) {
4357 printk(KERN_ERR "trident: architecture does not support"
4358 " %s PCI busmaster DMA\n",
4359 pci_dev->device == PCI_DEVICE_ID_ALI_5451 ?
4360 "32-bit" : "30-bit");
4361 goto out;
4363 pci_read_config_byte(pci_dev, PCI_CLASS_REVISION, &revision);
4365 if (pci_id->device == PCI_DEVICE_ID_INTERG_5050)
4366 iobase = pci_resource_start(pci_dev, 1);
4367 else
4368 iobase = pci_resource_start(pci_dev, 0);
4370 if (!request_region(iobase, 256, card_names[pci_id->driver_data])) {
4371 printk(KERN_ERR "trident: can't allocate I/O space at "
4372 "0x%4.4lx\n", iobase);
4373 goto out;
4376 rc = -ENOMEM;
4377 if ((card = kmalloc(sizeof(*card), GFP_KERNEL)) == NULL) {
4378 printk(KERN_ERR "trident: out of memory\n");
4379 goto out_release_region;
4381 memset(card, 0, sizeof (*card));
4383 init_timer(&card->timer);
4384 card->iobase = iobase;
4385 card->pci_dev = pci_dev;
4386 card->pci_id = pci_id->device;
4387 card->revision = revision;
4388 card->irq = pci_dev->irq;
4389 card->next = devs;
4390 card->magic = TRIDENT_CARD_MAGIC;
4391 card->banks[BANK_A].addresses = &bank_a_addrs;
4392 card->banks[BANK_A].bitmap = 0UL;
4393 card->banks[BANK_B].addresses = &bank_b_addrs;
4394 card->banks[BANK_B].bitmap = 0UL;
4396 init_MUTEX(&card->open_sem);
4397 spin_lock_init(&card->lock);
4398 init_timer(&card->timer);
4400 devs = card;
4402 pci_set_master(pci_dev);
4404 printk(KERN_INFO "trident: %s found at IO 0x%04lx, IRQ %d\n",
4405 card_names[pci_id->driver_data], card->iobase, card->irq);
4407 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
4408 /* ALi channel Management */
4409 card->alloc_pcm_channel = ali_alloc_pcm_channel;
4410 card->alloc_rec_pcm_channel = ali_alloc_rec_pcm_channel;
4411 card->free_pcm_channel = ali_free_pcm_channel;
4413 card->address_interrupt = ali_address_interrupt;
4415 /* Added by Matt Wu 01-05-2001 for spdif in */
4416 card->multi_channel_use_count = 0;
4417 card->rec_channel_use_count = 0;
4419 /* ALi SPDIF OUT function */
4420 if (card->revision == ALI_5451_V02) {
4421 ali_setup_spdif_out(card, ALI_PCM_TO_SPDIF_OUT);
4422 res = create_proc_entry("ALi5451", 0, NULL);
4423 if (res) {
4424 res->write_proc = ali_write_proc;
4425 res->data = card;
4429 /* Add H/W Volume Control By Matt Wu Jul. 06, 2001 */
4430 card->hwvolctl = 0;
4431 pci_dev_m1533 = pci_find_device(PCI_VENDOR_ID_AL,
4432 PCI_DEVICE_ID_AL_M1533,
4433 pci_dev_m1533);
4434 rc = -ENODEV;
4435 if (pci_dev_m1533 == NULL)
4436 goto out_proc_fs;
4437 pci_read_config_byte(pci_dev_m1533, 0x63, &bits);
4438 if (bits & (1 << 5))
4439 card->hwvolctl = 1;
4440 if (card->hwvolctl) {
4441 /* Clear m1533 pci cfg 78h bit 30 to zero, which makes
4442 GPIO11/12/13 work as ACGP_UP/DOWN/MUTE. */
4443 pci_read_config_byte(pci_dev_m1533, 0x7b, &bits);
4444 bits &= 0xbf; /*clear bit 6 */
4445 pci_write_config_byte(pci_dev_m1533, 0x7b, bits);
4447 } else if (card->pci_id == PCI_DEVICE_ID_INTERG_5050) {
4448 card->alloc_pcm_channel = cyber_alloc_pcm_channel;
4449 card->alloc_rec_pcm_channel = cyber_alloc_pcm_channel;
4450 card->free_pcm_channel = cyber_free_pcm_channel;
4451 card->address_interrupt = cyber_address_interrupt;
4452 cyber_init_ritual(card);
4453 } else {
4454 card->alloc_pcm_channel = trident_alloc_pcm_channel;
4455 card->alloc_rec_pcm_channel = trident_alloc_pcm_channel;
4456 card->free_pcm_channel = trident_free_pcm_channel;
4457 card->address_interrupt = trident_address_interrupt;
4460 /* claim our irq */
4461 rc = -ENODEV;
4462 if (request_irq(card->irq, &trident_interrupt, SA_SHIRQ,
4463 card_names[pci_id->driver_data], card)) {
4464 printk(KERN_ERR "trident: unable to allocate irq %d\n",
4465 card->irq);
4466 goto out_proc_fs;
4468 /* register /dev/dsp */
4469 if ((card->dev_audio = register_sound_dsp(&trident_audio_fops, -1)) < 0) {
4470 printk(KERN_ERR "trident: couldn't register DSP device!\n");
4471 goto out_free_irq;
4473 card->mixer_regs_ready = 0;
4474 /* initialize AC97 codec and register /dev/mixer */
4475 if (trident_ac97_init(card) <= 0) {
4476 /* unregister audio devices */
4477 for (i = 0; i < NR_AC97; i++) {
4478 if (card->ac97_codec[i] != NULL) {
4479 struct ac97_codec* codec = card->ac97_codec[i];
4480 unregister_sound_mixer(codec->dev_mixer);
4481 ac97_release_codec(codec);
4484 goto out_unregister_sound_dsp;
4486 card->mixer_regs_ready = 1;
4487 outl(0x00, TRID_REG(card, T4D_MUSICVOL_WAVEVOL));
4489 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
4490 /* Add H/W Volume Control By Matt Wu Jul. 06, 2001 */
4491 if (card->hwvolctl) {
4492 /* Enable GPIO IRQ (MISCINT bit 18h) */
4493 temp = inw(TRID_REG(card, T4D_MISCINT + 2));
4494 temp |= 0x0004;
4495 outw(temp, TRID_REG(card, T4D_MISCINT + 2));
4497 /* Enable H/W Volume Control GLOVAL CONTROL bit 0 */
4498 temp = inw(TRID_REG(card, ALI_GLOBAL_CONTROL));
4499 temp |= 0x0001;
4500 outw(temp, TRID_REG(card, ALI_GLOBAL_CONTROL));
4503 if (card->revision == ALI_5451_V02)
4504 ali_close_multi_channels();
4505 /* edited by HMSEO for GT sound */
4506 #if defined(CONFIG_ALPHA_NAUTILUS) || defined(CONFIG_ALPHA_GENERIC)
4508 u16 ac97_data;
4509 extern struct hwrpb_struct *hwrpb;
4511 if ((hwrpb->sys_type) == 201) {
4512 printk(KERN_INFO "trident: Running on Alpha system "
4513 "type Nautilus\n");
4514 ac97_data = ali_ac97_get(card, 0, AC97_POWER_CONTROL);
4515 ali_ac97_set(card, 0, AC97_POWER_CONTROL,
4516 ac97_data | ALI_EAPD_POWER_DOWN);
4519 #endif /* CONFIG_ALPHA_NAUTILUS || CONFIG_ALPHA_GENERIC */
4520 /* edited by HMSEO for GT sound */
4522 rc = 0;
4523 pci_set_drvdata(pci_dev, card);
4525 /* Enable Address Engine Interrupts */
4526 trident_enable_loop_interrupts(card);
4528 /* Register gameport */
4529 trident_register_gameport(card);
4531 out:
4532 return rc;
4534 out_unregister_sound_dsp:
4535 unregister_sound_dsp(card->dev_audio);
4536 out_free_irq:
4537 free_irq(card->irq, card);
4538 out_proc_fs:
4539 if (res) {
4540 remove_proc_entry("ALi5451", NULL);
4541 res = NULL;
4543 kfree(card);
4544 devs = NULL;
4545 out_release_region:
4546 release_region(iobase, 256);
4547 return rc;
4550 static void __devexit
4551 trident_remove(struct pci_dev *pci_dev)
4553 int i;
4554 struct trident_card *card = pci_get_drvdata(pci_dev);
4557 * Kill running timers before unload. We can't have them
4558 * going off after rmmod!
4560 if (card->hwvolctl)
4561 del_timer_sync(&card->timer);
4563 /* ALi S/PDIF and Power Management */
4564 if (card->pci_id == PCI_DEVICE_ID_ALI_5451) {
4565 ali_setup_spdif_out(card, ALI_PCM_TO_SPDIF_OUT);
4566 ali_disable_special_channel(card, ALI_SPDIF_OUT_CHANNEL);
4567 ali_disable_spdif_in(card);
4568 remove_proc_entry("ALi5451", NULL);
4571 /* Unregister gameport */
4572 if (card->gameport)
4573 gameport_unregister_port(card->gameport);
4575 /* Kill interrupts, and SP/DIF */
4576 trident_disable_loop_interrupts(card);
4578 /* free hardware resources */
4579 free_irq(card->irq, card);
4580 release_region(card->iobase, 256);
4582 /* unregister audio devices */
4583 for (i = 0; i < NR_AC97; i++)
4584 if (card->ac97_codec[i] != NULL) {
4585 unregister_sound_mixer(card->ac97_codec[i]->dev_mixer);
4586 ac97_release_codec(card->ac97_codec[i]);
4588 unregister_sound_dsp(card->dev_audio);
4590 kfree(card);
4592 pci_set_drvdata(pci_dev, NULL);
4595 MODULE_AUTHOR("Alan Cox, Aaron Holtzman, Ollie Lho, Ching Ling Lee, Muli Ben-Yehuda");
4596 MODULE_DESCRIPTION("Trident 4DWave/SiS 7018/ALi 5451 and Tvia/IGST CyberPro5050 PCI "
4597 "Audio Driver");
4598 MODULE_LICENSE("GPL");
4600 #define TRIDENT_MODULE_NAME "trident"
4602 static struct pci_driver trident_pci_driver = {
4603 .name = TRIDENT_MODULE_NAME,
4604 .id_table = trident_pci_tbl,
4605 .probe = trident_probe,
4606 .remove = __devexit_p(trident_remove),
4607 .suspend = trident_suspend,
4608 .resume = trident_resume
4611 static int __init
4612 trident_init_module(void)
4614 printk(KERN_INFO "Trident 4DWave/SiS 7018/ALi 5451,Tvia CyberPro "
4615 "5050 PCI Audio, version " DRIVER_VERSION ", " __TIME__ " "
4616 __DATE__ "\n");
4618 return pci_register_driver(&trident_pci_driver);
4621 static void __exit
4622 trident_cleanup_module(void)
4624 pci_unregister_driver(&trident_pci_driver);
4627 module_init(trident_init_module);
4628 module_exit(trident_cleanup_module);