diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /sound/oss/via82cxxx_audio.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'sound/oss/via82cxxx_audio.c')
-rw-r--r-- | sound/oss/via82cxxx_audio.c | 3615 |
1 files changed, 3615 insertions, 0 deletions
diff --git a/sound/oss/via82cxxx_audio.c b/sound/oss/via82cxxx_audio.c new file mode 100644 index 000000000000..b387e1e52485 --- /dev/null +++ b/sound/oss/via82cxxx_audio.c | |||
@@ -0,0 +1,3615 @@ | |||
1 | /* | ||
2 | * Support for VIA 82Cxxx Audio Codecs | ||
3 | * Copyright 1999,2000 Jeff Garzik | ||
4 | * | ||
5 | * Updated to support the VIA 8233/8235 audio subsystem | ||
6 | * Alan Cox <alan@redhat.com> (C) Copyright 2002, 2003 Red Hat Inc | ||
7 | * | ||
8 | * Distributed under the GNU GENERAL PUBLIC LICENSE (GPL) Version 2. | ||
9 | * See the "COPYING" file distributed with this software for more info. | ||
10 | * NO WARRANTY | ||
11 | * | ||
12 | * For a list of known bugs (errata) and documentation, | ||
13 | * see via-audio.pdf in Documentation/DocBook. | ||
14 | * If this documentation does not exist, run "make pdfdocs". | ||
15 | */ | ||
16 | |||
17 | |||
18 | #define VIA_VERSION "1.9.1-ac4-2.5" | ||
19 | |||
20 | |||
21 | #include <linux/config.h> | ||
22 | #include <linux/module.h> | ||
23 | #include <linux/kernel.h> | ||
24 | #include <linux/fs.h> | ||
25 | #include <linux/mm.h> | ||
26 | #include <linux/pci.h> | ||
27 | #include <linux/init.h> | ||
28 | #include <linux/interrupt.h> | ||
29 | #include <linux/proc_fs.h> | ||
30 | #include <linux/spinlock.h> | ||
31 | #include <linux/sound.h> | ||
32 | #include <linux/poll.h> | ||
33 | #include <linux/soundcard.h> | ||
34 | #include <linux/ac97_codec.h> | ||
35 | #include <linux/smp_lock.h> | ||
36 | #include <linux/ioport.h> | ||
37 | #include <linux/delay.h> | ||
38 | #include <asm/io.h> | ||
39 | #include <asm/uaccess.h> | ||
40 | #include <asm/semaphore.h> | ||
41 | #include "sound_config.h" | ||
42 | #include "dev_table.h" | ||
43 | #include "mpu401.h" | ||
44 | |||
45 | |||
46 | #undef VIA_DEBUG /* define to enable debugging output and checks */ | ||
47 | #ifdef VIA_DEBUG | ||
48 | /* note: prints function name for you */ | ||
49 | #define DPRINTK(fmt, args...) printk(KERN_DEBUG "%s: " fmt, __FUNCTION__ , ## args) | ||
50 | #else | ||
51 | #define DPRINTK(fmt, args...) | ||
52 | #endif | ||
53 | |||
54 | #undef VIA_NDEBUG /* define to disable lightweight runtime checks */ | ||
55 | #ifdef VIA_NDEBUG | ||
56 | #define assert(expr) | ||
57 | #else | ||
58 | #define assert(expr) \ | ||
59 | if(!(expr)) { \ | ||
60 | printk( "Assertion failed! %s,%s,%s,line=%d\n", \ | ||
61 | #expr,__FILE__,__FUNCTION__,__LINE__); \ | ||
62 | } | ||
63 | #endif | ||
64 | |||
65 | #define VIA_SUPPORT_MMAP 1 /* buggy, for now... */ | ||
66 | |||
67 | #define MAX_CARDS 1 | ||
68 | |||
69 | #define VIA_CARD_NAME "VIA 82Cxxx Audio driver " VIA_VERSION | ||
70 | #define VIA_MODULE_NAME "via82cxxx" | ||
71 | #define PFX VIA_MODULE_NAME ": " | ||
72 | |||
73 | #define VIA_COUNTER_LIMIT 100000 | ||
74 | |||
75 | /* size of DMA buffers */ | ||
76 | #define VIA_MAX_BUFFER_DMA_PAGES 32 | ||
77 | |||
78 | /* buffering default values in ms */ | ||
79 | #define VIA_DEFAULT_FRAG_TIME 20 | ||
80 | #define VIA_DEFAULT_BUFFER_TIME 500 | ||
81 | |||
82 | /* the hardware has a 256 fragment limit */ | ||
83 | #define VIA_MIN_FRAG_NUMBER 2 | ||
84 | #define VIA_MAX_FRAG_NUMBER 128 | ||
85 | |||
86 | #define VIA_MAX_FRAG_SIZE PAGE_SIZE | ||
87 | #define VIA_MIN_FRAG_SIZE (VIA_MAX_BUFFER_DMA_PAGES * PAGE_SIZE / VIA_MAX_FRAG_NUMBER) | ||
88 | |||
89 | |||
90 | /* 82C686 function 5 (audio codec) PCI configuration registers */ | ||
91 | #define VIA_ACLINK_STATUS 0x40 | ||
92 | #define VIA_ACLINK_CTRL 0x41 | ||
93 | #define VIA_FUNC_ENABLE 0x42 | ||
94 | #define VIA_PNP_CONTROL 0x43 | ||
95 | #define VIA_FM_NMI_CTRL 0x48 | ||
96 | |||
97 | /* | ||
98 | * controller base 0 (scatter-gather) registers | ||
99 | * | ||
100 | * NOTE: Via datasheet lists first channel as "read" | ||
101 | * channel and second channel as "write" channel. | ||
102 | * I changed the naming of the constants to be more | ||
103 | * clear than I felt the datasheet to be. | ||
104 | */ | ||
105 | |||
106 | #define VIA_BASE0_PCM_OUT_CHAN 0x00 /* output PCM to user */ | ||
107 | #define VIA_BASE0_PCM_OUT_CHAN_STATUS 0x00 | ||
108 | #define VIA_BASE0_PCM_OUT_CHAN_CTRL 0x01 | ||
109 | #define VIA_BASE0_PCM_OUT_CHAN_TYPE 0x02 | ||
110 | |||
111 | #define VIA_BASE0_PCM_IN_CHAN 0x10 /* input PCM from user */ | ||
112 | #define VIA_BASE0_PCM_IN_CHAN_STATUS 0x10 | ||
113 | #define VIA_BASE0_PCM_IN_CHAN_CTRL 0x11 | ||
114 | #define VIA_BASE0_PCM_IN_CHAN_TYPE 0x12 | ||
115 | |||
116 | /* offsets from base */ | ||
117 | #define VIA_PCM_STATUS 0x00 | ||
118 | #define VIA_PCM_CONTROL 0x01 | ||
119 | #define VIA_PCM_TYPE 0x02 | ||
120 | #define VIA_PCM_LEFTVOL 0x02 | ||
121 | #define VIA_PCM_RIGHTVOL 0x03 | ||
122 | #define VIA_PCM_TABLE_ADDR 0x04 | ||
123 | #define VIA_PCM_STOPRATE 0x08 /* 8233+ */ | ||
124 | #define VIA_PCM_BLOCK_COUNT 0x0C | ||
125 | |||
126 | /* XXX unused DMA channel for FM PCM data */ | ||
127 | #define VIA_BASE0_FM_OUT_CHAN 0x20 | ||
128 | #define VIA_BASE0_FM_OUT_CHAN_STATUS 0x20 | ||
129 | #define VIA_BASE0_FM_OUT_CHAN_CTRL 0x21 | ||
130 | #define VIA_BASE0_FM_OUT_CHAN_TYPE 0x22 | ||
131 | |||
132 | /* Six channel audio output on 8233 */ | ||
133 | #define VIA_BASE0_MULTI_OUT_CHAN 0x40 | ||
134 | #define VIA_BASE0_MULTI_OUT_CHAN_STATUS 0x40 | ||
135 | #define VIA_BASE0_MULTI_OUT_CHAN_CTRL 0x41 | ||
136 | #define VIA_BASE0_MULTI_OUT_CHAN_TYPE 0x42 | ||
137 | |||
138 | #define VIA_BASE0_AC97_CTRL 0x80 | ||
139 | #define VIA_BASE0_SGD_STATUS_SHADOW 0x84 | ||
140 | #define VIA_BASE0_GPI_INT_ENABLE 0x8C | ||
141 | #define VIA_INTR_OUT ((1<<0) | (1<<4) | (1<<8)) | ||
142 | #define VIA_INTR_IN ((1<<1) | (1<<5) | (1<<9)) | ||
143 | #define VIA_INTR_FM ((1<<2) | (1<<6) | (1<<10)) | ||
144 | #define VIA_INTR_MASK (VIA_INTR_OUT | VIA_INTR_IN | VIA_INTR_FM) | ||
145 | |||
146 | /* Newer VIA we need to monitor the low 3 bits of each channel. This | ||
147 | mask covers the channels we don't yet use as well | ||
148 | */ | ||
149 | |||
150 | #define VIA_NEW_INTR_MASK 0x77077777UL | ||
151 | |||
152 | /* VIA_BASE0_AUDIO_xxx_CHAN_TYPE bits */ | ||
153 | #define VIA_IRQ_ON_FLAG (1<<0) /* int on each flagged scatter block */ | ||
154 | #define VIA_IRQ_ON_EOL (1<<1) /* int at end of scatter list */ | ||
155 | #define VIA_INT_SEL_PCI_LAST_LINE_READ (0) /* int at PCI read of last line */ | ||
156 | #define VIA_INT_SEL_LAST_SAMPLE_SENT (1<<2) /* int at last sample sent */ | ||
157 | #define VIA_INT_SEL_ONE_LINE_LEFT (1<<3) /* int at less than one line to send */ | ||
158 | #define VIA_PCM_FMT_STEREO (1<<4) /* PCM stereo format (bit clear == mono) */ | ||
159 | #define VIA_PCM_FMT_16BIT (1<<5) /* PCM 16-bit format (bit clear == 8-bit) */ | ||
160 | #define VIA_PCM_REC_FIFO (1<<6) /* PCM Recording FIFO */ | ||
161 | #define VIA_RESTART_SGD_ON_EOL (1<<7) /* restart scatter-gather at EOL */ | ||
162 | #define VIA_PCM_FMT_MASK (VIA_PCM_FMT_STEREO|VIA_PCM_FMT_16BIT) | ||
163 | #define VIA_CHAN_TYPE_MASK (VIA_RESTART_SGD_ON_EOL | \ | ||
164 | VIA_IRQ_ON_FLAG | \ | ||
165 | VIA_IRQ_ON_EOL) | ||
166 | #define VIA_CHAN_TYPE_INT_SELECT (VIA_INT_SEL_LAST_SAMPLE_SENT) | ||
167 | |||
168 | /* PCI configuration register bits and masks */ | ||
169 | #define VIA_CR40_AC97_READY 0x01 | ||
170 | #define VIA_CR40_AC97_LOW_POWER 0x02 | ||
171 | #define VIA_CR40_SECONDARY_READY 0x04 | ||
172 | |||
173 | #define VIA_CR41_AC97_ENABLE 0x80 /* enable AC97 codec */ | ||
174 | #define VIA_CR41_AC97_RESET 0x40 /* clear bit to reset AC97 */ | ||
175 | #define VIA_CR41_AC97_WAKEUP 0x20 /* wake up from power-down mode */ | ||
176 | #define VIA_CR41_AC97_SDO 0x10 /* force Serial Data Out (SDO) high */ | ||
177 | #define VIA_CR41_VRA 0x08 /* enable variable sample rate */ | ||
178 | #define VIA_CR41_PCM_ENABLE 0x04 /* AC Link SGD Read Channel PCM Data Output */ | ||
179 | #define VIA_CR41_FM_PCM_ENABLE 0x02 /* AC Link FM Channel PCM Data Out */ | ||
180 | #define VIA_CR41_SB_PCM_ENABLE 0x01 /* AC Link SB PCM Data Output */ | ||
181 | #define VIA_CR41_BOOT_MASK (VIA_CR41_AC97_ENABLE | \ | ||
182 | VIA_CR41_AC97_WAKEUP | \ | ||
183 | VIA_CR41_AC97_SDO) | ||
184 | #define VIA_CR41_RUN_MASK (VIA_CR41_AC97_ENABLE | \ | ||
185 | VIA_CR41_AC97_RESET | \ | ||
186 | VIA_CR41_VRA | \ | ||
187 | VIA_CR41_PCM_ENABLE) | ||
188 | |||
189 | #define VIA_CR42_SB_ENABLE 0x01 | ||
190 | #define VIA_CR42_MIDI_ENABLE 0x02 | ||
191 | #define VIA_CR42_FM_ENABLE 0x04 | ||
192 | #define VIA_CR42_GAME_ENABLE 0x08 | ||
193 | #define VIA_CR42_MIDI_IRQMASK 0x40 | ||
194 | #define VIA_CR42_MIDI_PNP 0x80 | ||
195 | |||
196 | #define VIA_CR44_SECOND_CODEC_SUPPORT (1 << 6) | ||
197 | #define VIA_CR44_AC_LINK_ACCESS (1 << 7) | ||
198 | |||
199 | #define VIA_CR48_FM_TRAP_TO_NMI (1 << 2) | ||
200 | |||
201 | /* controller base 0 register bitmasks */ | ||
202 | #define VIA_INT_DISABLE_MASK (~(0x01|0x02)) | ||
203 | #define VIA_SGD_STOPPED (1 << 2) | ||
204 | #define VIA_SGD_PAUSED (1 << 6) | ||
205 | #define VIA_SGD_ACTIVE (1 << 7) | ||
206 | #define VIA_SGD_TERMINATE (1 << 6) | ||
207 | #define VIA_SGD_FLAG (1 << 0) | ||
208 | #define VIA_SGD_EOL (1 << 1) | ||
209 | #define VIA_SGD_START (1 << 7) | ||
210 | |||
211 | #define VIA_CR80_FIRST_CODEC 0 | ||
212 | #define VIA_CR80_SECOND_CODEC (1 << 30) | ||
213 | #define VIA_CR80_FIRST_CODEC_VALID (1 << 25) | ||
214 | #define VIA_CR80_VALID (1 << 25) | ||
215 | #define VIA_CR80_SECOND_CODEC_VALID (1 << 27) | ||
216 | #define VIA_CR80_BUSY (1 << 24) | ||
217 | #define VIA_CR83_BUSY (1) | ||
218 | #define VIA_CR83_FIRST_CODEC_VALID (1 << 1) | ||
219 | #define VIA_CR80_READ (1 << 23) | ||
220 | #define VIA_CR80_WRITE_MODE 0 | ||
221 | #define VIA_CR80_REG_IDX(idx) ((((idx) & 0xFF) >> 1) << 16) | ||
222 | |||
223 | /* capabilities we announce */ | ||
224 | #ifdef VIA_SUPPORT_MMAP | ||
225 | #define VIA_DSP_CAP (DSP_CAP_REVISION | DSP_CAP_DUPLEX | DSP_CAP_MMAP | \ | ||
226 | DSP_CAP_TRIGGER | DSP_CAP_REALTIME) | ||
227 | #else | ||
228 | #define VIA_DSP_CAP (DSP_CAP_REVISION | DSP_CAP_DUPLEX | \ | ||
229 | DSP_CAP_TRIGGER | DSP_CAP_REALTIME) | ||
230 | #endif | ||
231 | |||
232 | /* scatter-gather DMA table entry, exactly as passed to hardware */ | ||
233 | struct via_sgd_table { | ||
234 | u32 addr; | ||
235 | u32 count; /* includes additional VIA_xxx bits also */ | ||
236 | }; | ||
237 | |||
238 | #define VIA_EOL (1 << 31) | ||
239 | #define VIA_FLAG (1 << 30) | ||
240 | #define VIA_STOP (1 << 29) | ||
241 | |||
242 | |||
243 | enum via_channel_states { | ||
244 | sgd_stopped = 0, | ||
245 | sgd_in_progress = 1, | ||
246 | }; | ||
247 | |||
248 | |||
249 | struct via_buffer_pgtbl { | ||
250 | dma_addr_t handle; | ||
251 | void *cpuaddr; | ||
252 | }; | ||
253 | |||
254 | |||
255 | struct via_channel { | ||
256 | atomic_t n_frags; | ||
257 | atomic_t hw_ptr; | ||
258 | wait_queue_head_t wait; | ||
259 | |||
260 | unsigned int sw_ptr; | ||
261 | unsigned int slop_len; | ||
262 | unsigned int n_irqs; | ||
263 | int bytes; | ||
264 | |||
265 | unsigned is_active : 1; | ||
266 | unsigned is_record : 1; | ||
267 | unsigned is_mapped : 1; | ||
268 | unsigned is_enabled : 1; | ||
269 | unsigned is_multi: 1; /* 8233 6 channel */ | ||
270 | u8 pcm_fmt; /* VIA_PCM_FMT_xxx */ | ||
271 | u8 channels; /* Channel count */ | ||
272 | |||
273 | unsigned rate; /* sample rate */ | ||
274 | unsigned int frag_size; | ||
275 | unsigned int frag_number; | ||
276 | |||
277 | unsigned char intmask; | ||
278 | |||
279 | volatile struct via_sgd_table *sgtable; | ||
280 | dma_addr_t sgt_handle; | ||
281 | |||
282 | unsigned int page_number; | ||
283 | struct via_buffer_pgtbl pgtbl[VIA_MAX_BUFFER_DMA_PAGES]; | ||
284 | |||
285 | long iobase; | ||
286 | |||
287 | const char *name; | ||
288 | }; | ||
289 | |||
290 | |||
291 | /* data stored for each chip */ | ||
292 | struct via_info { | ||
293 | struct pci_dev *pdev; | ||
294 | long baseaddr; | ||
295 | |||
296 | struct ac97_codec *ac97; | ||
297 | spinlock_t ac97_lock; | ||
298 | spinlock_t lock; | ||
299 | int card_num; /* unique card number, from 0 */ | ||
300 | |||
301 | int dev_dsp; /* /dev/dsp index from register_sound_dsp() */ | ||
302 | |||
303 | unsigned rev_h : 1; | ||
304 | unsigned legacy: 1; /* Has legacy ports */ | ||
305 | unsigned intmask: 1; /* Needs int bits */ | ||
306 | unsigned sixchannel: 1; /* 8233/35 with 6 channel support */ | ||
307 | unsigned volume: 1; | ||
308 | |||
309 | int locked_rate : 1; | ||
310 | |||
311 | int mixer_vol; /* 8233/35 volume - not yet implemented */ | ||
312 | |||
313 | struct semaphore syscall_sem; | ||
314 | struct semaphore open_sem; | ||
315 | |||
316 | /* The 8233/8235 have 4 DX audio channels, two record and | ||
317 | one six channel out. We bind ch_in to DX 1, ch_out to multichannel | ||
318 | and ch_fm to DX 2. DX 3 and REC0/REC1 are unused at the | ||
319 | moment */ | ||
320 | |||
321 | struct via_channel ch_in; | ||
322 | struct via_channel ch_out; | ||
323 | struct via_channel ch_fm; | ||
324 | |||
325 | #ifdef CONFIG_MIDI_VIA82CXXX | ||
326 | void *midi_devc; | ||
327 | struct address_info midi_info; | ||
328 | #endif | ||
329 | }; | ||
330 | |||
331 | |||
332 | /* number of cards, used for assigning unique numbers to cards */ | ||
333 | static unsigned via_num_cards; | ||
334 | |||
335 | |||
336 | |||
337 | /**************************************************************** | ||
338 | * | ||
339 | * prototypes | ||
340 | * | ||
341 | * | ||
342 | */ | ||
343 | |||
344 | static int via_init_one (struct pci_dev *dev, const struct pci_device_id *id); | ||
345 | static void __devexit via_remove_one (struct pci_dev *pdev); | ||
346 | |||
347 | static ssize_t via_dsp_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos); | ||
348 | static ssize_t via_dsp_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos); | ||
349 | static unsigned int via_dsp_poll(struct file *file, struct poll_table_struct *wait); | ||
350 | static int via_dsp_ioctl (struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg); | ||
351 | static int via_dsp_open (struct inode *inode, struct file *file); | ||
352 | static int via_dsp_release(struct inode *inode, struct file *file); | ||
353 | static int via_dsp_mmap(struct file *file, struct vm_area_struct *vma); | ||
354 | |||
355 | static u16 via_ac97_read_reg (struct ac97_codec *codec, u8 reg); | ||
356 | static void via_ac97_write_reg (struct ac97_codec *codec, u8 reg, u16 value); | ||
357 | static u8 via_ac97_wait_idle (struct via_info *card); | ||
358 | |||
359 | static void via_chan_free (struct via_info *card, struct via_channel *chan); | ||
360 | static void via_chan_clear (struct via_info *card, struct via_channel *chan); | ||
361 | static void via_chan_pcm_fmt (struct via_channel *chan, int reset); | ||
362 | static void via_chan_buffer_free (struct via_info *card, struct via_channel *chan); | ||
363 | |||
364 | |||
365 | /**************************************************************** | ||
366 | * | ||
367 | * Various data the driver needs | ||
368 | * | ||
369 | * | ||
370 | */ | ||
371 | |||
372 | |||
373 | static struct pci_device_id via_pci_tbl[] = { | ||
374 | { PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C686_5, | ||
375 | PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, | ||
376 | { PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8233_5, | ||
377 | PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1}, | ||
378 | { 0, } | ||
379 | }; | ||
380 | MODULE_DEVICE_TABLE(pci,via_pci_tbl); | ||
381 | |||
382 | |||
383 | static struct pci_driver via_driver = { | ||
384 | .name = VIA_MODULE_NAME, | ||
385 | .id_table = via_pci_tbl, | ||
386 | .probe = via_init_one, | ||
387 | .remove = __devexit_p(via_remove_one), | ||
388 | }; | ||
389 | |||
390 | |||
391 | /**************************************************************** | ||
392 | * | ||
393 | * Low-level base 0 register read/write helpers | ||
394 | * | ||
395 | * | ||
396 | */ | ||
397 | |||
398 | /** | ||
399 | * via_chan_stop - Terminate DMA on specified PCM channel | ||
400 | * @iobase: PCI base address for SGD channel registers | ||
401 | * | ||
402 | * Terminate scatter-gather DMA operation for given | ||
403 | * channel (derived from @iobase), if DMA is active. | ||
404 | * | ||
405 | * Note that @iobase is not the PCI base address, | ||
406 | * but the PCI base address plus an offset to | ||
407 | * one of three PCM channels supported by the chip. | ||
408 | * | ||
409 | */ | ||
410 | |||
411 | static inline void via_chan_stop (long iobase) | ||
412 | { | ||
413 | if (inb (iobase + VIA_PCM_STATUS) & VIA_SGD_ACTIVE) | ||
414 | outb (VIA_SGD_TERMINATE, iobase + VIA_PCM_CONTROL); | ||
415 | } | ||
416 | |||
417 | |||
418 | /** | ||
419 | * via_chan_status_clear - Clear status flags on specified DMA channel | ||
420 | * @iobase: PCI base address for SGD channel registers | ||
421 | * | ||
422 | * Clear any pending status flags for the given | ||
423 | * DMA channel (derived from @iobase), if any | ||
424 | * flags are asserted. | ||
425 | * | ||
426 | * Note that @iobase is not the PCI base address, | ||
427 | * but the PCI base address plus an offset to | ||
428 | * one of three PCM channels supported by the chip. | ||
429 | * | ||
430 | */ | ||
431 | |||
432 | static inline void via_chan_status_clear (long iobase) | ||
433 | { | ||
434 | u8 tmp = inb (iobase + VIA_PCM_STATUS); | ||
435 | |||
436 | if (tmp != 0) | ||
437 | outb (tmp, iobase + VIA_PCM_STATUS); | ||
438 | } | ||
439 | |||
440 | |||
441 | /** | ||
442 | * sg_begin - Begin recording or playback on a PCM channel | ||
443 | * @chan: Channel for which DMA operation shall begin | ||
444 | * | ||
445 | * Start scatter-gather DMA for the given channel. | ||
446 | * | ||
447 | */ | ||
448 | |||
449 | static inline void sg_begin (struct via_channel *chan) | ||
450 | { | ||
451 | DPRINTK("Start with intmask %d\n", chan->intmask); | ||
452 | DPRINTK("About to start from %d to %d\n", | ||
453 | inl(chan->iobase + VIA_PCM_BLOCK_COUNT), | ||
454 | inb(chan->iobase + VIA_PCM_STOPRATE + 3)); | ||
455 | outb (VIA_SGD_START|chan->intmask, chan->iobase + VIA_PCM_CONTROL); | ||
456 | DPRINTK("Status is now %02X\n", inb(chan->iobase + VIA_PCM_STATUS)); | ||
457 | DPRINTK("Control is now %02X\n", inb(chan->iobase + VIA_PCM_CONTROL)); | ||
458 | } | ||
459 | |||
460 | |||
461 | static int sg_active (long iobase) | ||
462 | { | ||
463 | u8 tmp = inb (iobase + VIA_PCM_STATUS); | ||
464 | if ((tmp & VIA_SGD_STOPPED) || (tmp & VIA_SGD_PAUSED)) { | ||
465 | printk(KERN_WARNING "via82cxxx warning: SG stopped or paused\n"); | ||
466 | return 0; | ||
467 | } | ||
468 | if (tmp & VIA_SGD_ACTIVE) | ||
469 | return 1; | ||
470 | return 0; | ||
471 | } | ||
472 | |||
473 | static int via_sg_offset(struct via_channel *chan) | ||
474 | { | ||
475 | return inl (chan->iobase + VIA_PCM_BLOCK_COUNT) & 0x00FFFFFF; | ||
476 | } | ||
477 | |||
478 | /**************************************************************** | ||
479 | * | ||
480 | * Miscellaneous debris | ||
481 | * | ||
482 | * | ||
483 | */ | ||
484 | |||
485 | |||
486 | /** | ||
487 | * via_syscall_down - down the card-specific syscell semaphore | ||
488 | * @card: Private info for specified board | ||
489 | * @nonblock: boolean, non-zero if O_NONBLOCK is set | ||
490 | * | ||
491 | * Encapsulates standard method of acquiring the syscall sem. | ||
492 | * | ||
493 | * Returns negative errno on error, or zero for success. | ||
494 | */ | ||
495 | |||
496 | static inline int via_syscall_down (struct via_info *card, int nonblock) | ||
497 | { | ||
498 | /* Thomas Sailer: | ||
499 | * EAGAIN is supposed to be used if IO is pending, | ||
500 | * not if there is contention on some internal | ||
501 | * synchronization primitive which should be | ||
502 | * held only for a short time anyway | ||
503 | */ | ||
504 | nonblock = 0; | ||
505 | |||
506 | if (nonblock) { | ||
507 | if (down_trylock (&card->syscall_sem)) | ||
508 | return -EAGAIN; | ||
509 | } else { | ||
510 | if (down_interruptible (&card->syscall_sem)) | ||
511 | return -ERESTARTSYS; | ||
512 | } | ||
513 | |||
514 | return 0; | ||
515 | } | ||
516 | |||
517 | |||
518 | /** | ||
519 | * via_stop_everything - Stop all audio operations | ||
520 | * @card: Private info for specified board | ||
521 | * | ||
522 | * Stops all DMA operations and interrupts, and clear | ||
523 | * any pending status bits resulting from those operations. | ||
524 | */ | ||
525 | |||
526 | static void via_stop_everything (struct via_info *card) | ||
527 | { | ||
528 | u8 tmp, new_tmp; | ||
529 | |||
530 | DPRINTK ("ENTER\n"); | ||
531 | |||
532 | assert (card != NULL); | ||
533 | |||
534 | /* | ||
535 | * terminate any existing operations on audio read/write channels | ||
536 | */ | ||
537 | via_chan_stop (card->baseaddr + VIA_BASE0_PCM_OUT_CHAN); | ||
538 | via_chan_stop (card->baseaddr + VIA_BASE0_PCM_IN_CHAN); | ||
539 | via_chan_stop (card->baseaddr + VIA_BASE0_FM_OUT_CHAN); | ||
540 | if(card->sixchannel) | ||
541 | via_chan_stop (card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN); | ||
542 | |||
543 | /* | ||
544 | * clear any existing stops / flags (sanity check mainly) | ||
545 | */ | ||
546 | via_chan_status_clear (card->baseaddr + VIA_BASE0_PCM_OUT_CHAN); | ||
547 | via_chan_status_clear (card->baseaddr + VIA_BASE0_PCM_IN_CHAN); | ||
548 | via_chan_status_clear (card->baseaddr + VIA_BASE0_FM_OUT_CHAN); | ||
549 | if(card->sixchannel) | ||
550 | via_chan_status_clear (card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN); | ||
551 | |||
552 | /* | ||
553 | * clear any enabled interrupt bits | ||
554 | */ | ||
555 | tmp = inb (card->baseaddr + VIA_BASE0_PCM_OUT_CHAN_TYPE); | ||
556 | new_tmp = tmp & ~(VIA_IRQ_ON_FLAG|VIA_IRQ_ON_EOL|VIA_RESTART_SGD_ON_EOL); | ||
557 | if (tmp != new_tmp) | ||
558 | outb (0, card->baseaddr + VIA_BASE0_PCM_OUT_CHAN_TYPE); | ||
559 | |||
560 | tmp = inb (card->baseaddr + VIA_BASE0_PCM_IN_CHAN_TYPE); | ||
561 | new_tmp = tmp & ~(VIA_IRQ_ON_FLAG|VIA_IRQ_ON_EOL|VIA_RESTART_SGD_ON_EOL); | ||
562 | if (tmp != new_tmp) | ||
563 | outb (0, card->baseaddr + VIA_BASE0_PCM_IN_CHAN_TYPE); | ||
564 | |||
565 | tmp = inb (card->baseaddr + VIA_BASE0_FM_OUT_CHAN_TYPE); | ||
566 | new_tmp = tmp & ~(VIA_IRQ_ON_FLAG|VIA_IRQ_ON_EOL|VIA_RESTART_SGD_ON_EOL); | ||
567 | if (tmp != new_tmp) | ||
568 | outb (0, card->baseaddr + VIA_BASE0_FM_OUT_CHAN_TYPE); | ||
569 | |||
570 | if(card->sixchannel) | ||
571 | { | ||
572 | tmp = inb (card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN_TYPE); | ||
573 | new_tmp = tmp & ~(VIA_IRQ_ON_FLAG|VIA_IRQ_ON_EOL|VIA_RESTART_SGD_ON_EOL); | ||
574 | if (tmp != new_tmp) | ||
575 | outb (0, card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN_TYPE); | ||
576 | } | ||
577 | |||
578 | udelay(10); | ||
579 | |||
580 | /* | ||
581 | * clear any existing flags | ||
582 | */ | ||
583 | via_chan_status_clear (card->baseaddr + VIA_BASE0_PCM_OUT_CHAN); | ||
584 | via_chan_status_clear (card->baseaddr + VIA_BASE0_PCM_IN_CHAN); | ||
585 | via_chan_status_clear (card->baseaddr + VIA_BASE0_FM_OUT_CHAN); | ||
586 | |||
587 | DPRINTK ("EXIT\n"); | ||
588 | } | ||
589 | |||
590 | |||
591 | /** | ||
592 | * via_set_rate - Set PCM rate for given channel | ||
593 | * @ac97: Pointer to generic codec info struct | ||
594 | * @chan: Private info for specified channel | ||
595 | * @rate: Desired PCM sample rate, in Khz | ||
596 | * | ||
597 | * Sets the PCM sample rate for a channel. | ||
598 | * | ||
599 | * Values for @rate are clamped to a range of 4000 Khz through 48000 Khz, | ||
600 | * due to hardware constraints. | ||
601 | */ | ||
602 | |||
603 | static int via_set_rate (struct ac97_codec *ac97, | ||
604 | struct via_channel *chan, unsigned rate) | ||
605 | { | ||
606 | struct via_info *card = ac97->private_data; | ||
607 | int rate_reg; | ||
608 | u32 dacp; | ||
609 | u32 mast_vol, phone_vol, mono_vol, pcm_vol; | ||
610 | u32 mute_vol = 0x8000; /* The mute volume? -- Seems to work! */ | ||
611 | |||
612 | DPRINTK ("ENTER, rate = %d\n", rate); | ||
613 | |||
614 | if (chan->rate == rate) | ||
615 | goto out; | ||
616 | if (card->locked_rate) { | ||
617 | chan->rate = 48000; | ||
618 | goto out; | ||
619 | } | ||
620 | |||
621 | if (rate > 48000) rate = 48000; | ||
622 | if (rate < 4000) rate = 4000; | ||
623 | |||
624 | rate_reg = chan->is_record ? AC97_PCM_LR_ADC_RATE : | ||
625 | AC97_PCM_FRONT_DAC_RATE; | ||
626 | |||
627 | /* Save current state */ | ||
628 | dacp=via_ac97_read_reg(ac97, AC97_POWER_CONTROL); | ||
629 | mast_vol = via_ac97_read_reg(ac97, AC97_MASTER_VOL_STEREO); | ||
630 | mono_vol = via_ac97_read_reg(ac97, AC97_MASTER_VOL_MONO); | ||
631 | phone_vol = via_ac97_read_reg(ac97, AC97_HEADPHONE_VOL); | ||
632 | pcm_vol = via_ac97_read_reg(ac97, AC97_PCMOUT_VOL); | ||
633 | /* Mute - largely reduces popping */ | ||
634 | via_ac97_write_reg(ac97, AC97_MASTER_VOL_STEREO, mute_vol); | ||
635 | via_ac97_write_reg(ac97, AC97_MASTER_VOL_MONO, mute_vol); | ||
636 | via_ac97_write_reg(ac97, AC97_HEADPHONE_VOL, mute_vol); | ||
637 | via_ac97_write_reg(ac97, AC97_PCMOUT_VOL, mute_vol); | ||
638 | /* Power down the DAC */ | ||
639 | via_ac97_write_reg(ac97, AC97_POWER_CONTROL, dacp|0x0200); | ||
640 | |||
641 | /* Set new rate */ | ||
642 | via_ac97_write_reg (ac97, rate_reg, rate); | ||
643 | |||
644 | /* Power DAC back up */ | ||
645 | via_ac97_write_reg(ac97, AC97_POWER_CONTROL, dacp); | ||
646 | udelay (200); /* reduces popping */ | ||
647 | |||
648 | /* Restore volumes */ | ||
649 | via_ac97_write_reg(ac97, AC97_MASTER_VOL_STEREO, mast_vol); | ||
650 | via_ac97_write_reg(ac97, AC97_MASTER_VOL_MONO, mono_vol); | ||
651 | via_ac97_write_reg(ac97, AC97_HEADPHONE_VOL, phone_vol); | ||
652 | via_ac97_write_reg(ac97, AC97_PCMOUT_VOL, pcm_vol); | ||
653 | |||
654 | /* the hardware might return a value different than what we | ||
655 | * passed to it, so read the rate value back from hardware | ||
656 | * to see what we came up with | ||
657 | */ | ||
658 | chan->rate = via_ac97_read_reg (ac97, rate_reg); | ||
659 | |||
660 | if (chan->rate == 0) { | ||
661 | card->locked_rate = 1; | ||
662 | chan->rate = 48000; | ||
663 | printk (KERN_WARNING PFX "Codec rate locked at 48Khz\n"); | ||
664 | } | ||
665 | |||
666 | out: | ||
667 | DPRINTK ("EXIT, returning rate %d Hz\n", chan->rate); | ||
668 | return chan->rate; | ||
669 | } | ||
670 | |||
671 | |||
672 | /**************************************************************** | ||
673 | * | ||
674 | * Channel-specific operations | ||
675 | * | ||
676 | * | ||
677 | */ | ||
678 | |||
679 | |||
680 | /** | ||
681 | * via_chan_init_defaults - Initialize a struct via_channel | ||
682 | * @card: Private audio chip info | ||
683 | * @chan: Channel to be initialized | ||
684 | * | ||
685 | * Zero @chan, and then set all static defaults for the structure. | ||
686 | */ | ||
687 | |||
688 | static void via_chan_init_defaults (struct via_info *card, struct via_channel *chan) | ||
689 | { | ||
690 | memset (chan, 0, sizeof (*chan)); | ||
691 | |||
692 | if(card->intmask) | ||
693 | chan->intmask = 0x23; /* Turn on the IRQ bits */ | ||
694 | |||
695 | if (chan == &card->ch_out) { | ||
696 | chan->name = "PCM-OUT"; | ||
697 | if(card->sixchannel) | ||
698 | { | ||
699 | chan->iobase = card->baseaddr + VIA_BASE0_MULTI_OUT_CHAN; | ||
700 | chan->is_multi = 1; | ||
701 | DPRINTK("Using multichannel for pcm out\n"); | ||
702 | } | ||
703 | else | ||
704 | chan->iobase = card->baseaddr + VIA_BASE0_PCM_OUT_CHAN; | ||
705 | } else if (chan == &card->ch_in) { | ||
706 | chan->name = "PCM-IN"; | ||
707 | chan->iobase = card->baseaddr + VIA_BASE0_PCM_IN_CHAN; | ||
708 | chan->is_record = 1; | ||
709 | } else if (chan == &card->ch_fm) { | ||
710 | chan->name = "PCM-OUT-FM"; | ||
711 | chan->iobase = card->baseaddr + VIA_BASE0_FM_OUT_CHAN; | ||
712 | } else { | ||
713 | BUG(); | ||
714 | } | ||
715 | |||
716 | init_waitqueue_head (&chan->wait); | ||
717 | |||
718 | chan->pcm_fmt = VIA_PCM_FMT_MASK; | ||
719 | chan->is_enabled = 1; | ||
720 | |||
721 | chan->frag_number = 0; | ||
722 | chan->frag_size = 0; | ||
723 | atomic_set(&chan->n_frags, 0); | ||
724 | atomic_set (&chan->hw_ptr, 0); | ||
725 | } | ||
726 | |||
727 | /** | ||
728 | * via_chan_init - Initialize PCM channel | ||
729 | * @card: Private audio chip info | ||
730 | * @chan: Channel to be initialized | ||
731 | * | ||
732 | * Performs some of the preparations necessary to begin | ||
733 | * using a PCM channel. | ||
734 | * | ||
735 | * Currently the preparations consist of | ||
736 | * setting the PCM channel to a known state. | ||
737 | */ | ||
738 | |||
739 | |||
740 | static void via_chan_init (struct via_info *card, struct via_channel *chan) | ||
741 | { | ||
742 | |||
743 | DPRINTK ("ENTER\n"); | ||
744 | |||
745 | /* bzero channel structure, and init members to defaults */ | ||
746 | via_chan_init_defaults (card, chan); | ||
747 | |||
748 | /* stop any existing channel output */ | ||
749 | via_chan_clear (card, chan); | ||
750 | via_chan_status_clear (chan->iobase); | ||
751 | via_chan_pcm_fmt (chan, 1); | ||
752 | |||
753 | DPRINTK ("EXIT\n"); | ||
754 | } | ||
755 | |||
756 | /** | ||
757 | * via_chan_buffer_init - Initialize PCM channel buffer | ||
758 | * @card: Private audio chip info | ||
759 | * @chan: Channel to be initialized | ||
760 | * | ||
761 | * Performs some of the preparations necessary to begin | ||
762 | * using a PCM channel. | ||
763 | * | ||
764 | * Currently the preparations include allocating the | ||
765 | * scatter-gather DMA table and buffers, | ||
766 | * and passing the | ||
767 | * address of the DMA table to the hardware. | ||
768 | * | ||
769 | * Note that special care is taken when passing the | ||
770 | * DMA table address to hardware, because it was found | ||
771 | * during driver development that the hardware did not | ||
772 | * always "take" the address. | ||
773 | */ | ||
774 | |||
775 | static int via_chan_buffer_init (struct via_info *card, struct via_channel *chan) | ||
776 | { | ||
777 | int page, offset; | ||
778 | int i; | ||
779 | |||
780 | DPRINTK ("ENTER\n"); | ||
781 | |||
782 | |||
783 | chan->intmask = 0; | ||
784 | if(card->intmask) | ||
785 | chan->intmask = 0x23; /* Turn on the IRQ bits */ | ||
786 | |||
787 | if (chan->sgtable != NULL) { | ||
788 | DPRINTK ("EXIT\n"); | ||
789 | return 0; | ||
790 | } | ||
791 | |||
792 | /* alloc DMA-able memory for scatter-gather table */ | ||
793 | chan->sgtable = pci_alloc_consistent (card->pdev, | ||
794 | (sizeof (struct via_sgd_table) * chan->frag_number), | ||
795 | &chan->sgt_handle); | ||
796 | if (!chan->sgtable) { | ||
797 | printk (KERN_ERR PFX "DMA table alloc fail, aborting\n"); | ||
798 | DPRINTK ("EXIT\n"); | ||
799 | return -ENOMEM; | ||
800 | } | ||
801 | |||
802 | memset ((void*)chan->sgtable, 0, | ||
803 | (sizeof (struct via_sgd_table) * chan->frag_number)); | ||
804 | |||
805 | /* alloc DMA-able memory for scatter-gather buffers */ | ||
806 | |||
807 | chan->page_number = (chan->frag_number * chan->frag_size) / PAGE_SIZE + | ||
808 | (((chan->frag_number * chan->frag_size) % PAGE_SIZE) ? 1 : 0); | ||
809 | |||
810 | for (i = 0; i < chan->page_number; i++) { | ||
811 | chan->pgtbl[i].cpuaddr = pci_alloc_consistent (card->pdev, PAGE_SIZE, | ||
812 | &chan->pgtbl[i].handle); | ||
813 | |||
814 | if (!chan->pgtbl[i].cpuaddr) { | ||
815 | chan->page_number = i; | ||
816 | goto err_out_nomem; | ||
817 | } | ||
818 | |||
819 | #ifndef VIA_NDEBUG | ||
820 | memset (chan->pgtbl[i].cpuaddr, 0xBC, chan->frag_size); | ||
821 | #endif | ||
822 | |||
823 | #if 1 | ||
824 | DPRINTK ("dmabuf_pg #%d (h=%lx, v2p=%lx, a=%p)\n", | ||
825 | i, (long)chan->pgtbl[i].handle, | ||
826 | virt_to_phys(chan->pgtbl[i].cpuaddr), | ||
827 | chan->pgtbl[i].cpuaddr); | ||
828 | #endif | ||
829 | } | ||
830 | |||
831 | for (i = 0; i < chan->frag_number; i++) { | ||
832 | |||
833 | page = i / (PAGE_SIZE / chan->frag_size); | ||
834 | offset = (i % (PAGE_SIZE / chan->frag_size)) * chan->frag_size; | ||
835 | |||
836 | chan->sgtable[i].count = cpu_to_le32 (chan->frag_size | VIA_FLAG); | ||
837 | chan->sgtable[i].addr = cpu_to_le32 (chan->pgtbl[page].handle + offset); | ||
838 | |||
839 | #if 1 | ||
840 | DPRINTK ("dmabuf #%d (32(h)=%lx)\n", | ||
841 | i, | ||
842 | (long)chan->sgtable[i].addr); | ||
843 | #endif | ||
844 | } | ||
845 | |||
846 | /* overwrite the last buffer information */ | ||
847 | chan->sgtable[chan->frag_number - 1].count = cpu_to_le32 (chan->frag_size | VIA_EOL); | ||
848 | |||
849 | /* set location of DMA-able scatter-gather info table */ | ||
850 | DPRINTK ("outl (0x%X, 0x%04lX)\n", | ||
851 | chan->sgt_handle, chan->iobase + VIA_PCM_TABLE_ADDR); | ||
852 | |||
853 | via_ac97_wait_idle (card); | ||
854 | outl (chan->sgt_handle, chan->iobase + VIA_PCM_TABLE_ADDR); | ||
855 | udelay (20); | ||
856 | via_ac97_wait_idle (card); | ||
857 | /* load no rate adaption, stereo 16bit, set up ring slots */ | ||
858 | if(card->sixchannel) | ||
859 | { | ||
860 | if(!chan->is_multi) | ||
861 | { | ||
862 | outl (0xFFFFF | (0x3 << 20) | (chan->frag_number << 24), chan->iobase + VIA_PCM_STOPRATE); | ||
863 | udelay (20); | ||
864 | via_ac97_wait_idle (card); | ||
865 | } | ||
866 | } | ||
867 | |||
868 | DPRINTK ("inl (0x%lX) = %x\n", | ||
869 | chan->iobase + VIA_PCM_TABLE_ADDR, | ||
870 | inl(chan->iobase + VIA_PCM_TABLE_ADDR)); | ||
871 | |||
872 | DPRINTK ("EXIT\n"); | ||
873 | return 0; | ||
874 | |||
875 | err_out_nomem: | ||
876 | printk (KERN_ERR PFX "DMA buffer alloc fail, aborting\n"); | ||
877 | via_chan_buffer_free (card, chan); | ||
878 | DPRINTK ("EXIT\n"); | ||
879 | return -ENOMEM; | ||
880 | } | ||
881 | |||
882 | |||
883 | /** | ||
884 | * via_chan_free - Release a PCM channel | ||
885 | * @card: Private audio chip info | ||
886 | * @chan: Channel to be released | ||
887 | * | ||
888 | * Performs all the functions necessary to clean up | ||
889 | * an initialized channel. | ||
890 | * | ||
891 | * Currently these functions include disabled any | ||
892 | * active DMA operations, setting the PCM channel | ||
893 | * back to a known state, and releasing any allocated | ||
894 | * sound buffers. | ||
895 | */ | ||
896 | |||
897 | static void via_chan_free (struct via_info *card, struct via_channel *chan) | ||
898 | { | ||
899 | DPRINTK ("ENTER\n"); | ||
900 | |||
901 | spin_lock_irq (&card->lock); | ||
902 | |||
903 | /* stop any existing channel output */ | ||
904 | via_chan_status_clear (chan->iobase); | ||
905 | via_chan_stop (chan->iobase); | ||
906 | via_chan_status_clear (chan->iobase); | ||
907 | |||
908 | spin_unlock_irq (&card->lock); | ||
909 | |||
910 | synchronize_irq(card->pdev->irq); | ||
911 | |||
912 | DPRINTK ("EXIT\n"); | ||
913 | } | ||
914 | |||
915 | static void via_chan_buffer_free (struct via_info *card, struct via_channel *chan) | ||
916 | { | ||
917 | int i; | ||
918 | |||
919 | DPRINTK ("ENTER\n"); | ||
920 | |||
921 | /* zero location of DMA-able scatter-gather info table */ | ||
922 | via_ac97_wait_idle(card); | ||
923 | outl (0, chan->iobase + VIA_PCM_TABLE_ADDR); | ||
924 | |||
925 | for (i = 0; i < chan->page_number; i++) | ||
926 | if (chan->pgtbl[i].cpuaddr) { | ||
927 | pci_free_consistent (card->pdev, PAGE_SIZE, | ||
928 | chan->pgtbl[i].cpuaddr, | ||
929 | chan->pgtbl[i].handle); | ||
930 | chan->pgtbl[i].cpuaddr = NULL; | ||
931 | chan->pgtbl[i].handle = 0; | ||
932 | } | ||
933 | |||
934 | chan->page_number = 0; | ||
935 | |||
936 | if (chan->sgtable) { | ||
937 | pci_free_consistent (card->pdev, | ||
938 | (sizeof (struct via_sgd_table) * chan->frag_number), | ||
939 | (void*)chan->sgtable, chan->sgt_handle); | ||
940 | chan->sgtable = NULL; | ||
941 | } | ||
942 | |||
943 | DPRINTK ("EXIT\n"); | ||
944 | } | ||
945 | |||
946 | |||
947 | /** | ||
948 | * via_chan_pcm_fmt - Update PCM channel settings | ||
949 | * @chan: Channel to be updated | ||
950 | * @reset: Boolean. If non-zero, channel will be reset | ||
951 | * to 8-bit mono mode. | ||
952 | * | ||
953 | * Stores the settings of the current PCM format, | ||
954 | * 8-bit or 16-bit, and mono/stereo, into the | ||
955 | * hardware settings for the specified channel. | ||
956 | * If @reset is non-zero, the channel is reset | ||
957 | * to 8-bit mono mode. Otherwise, the channel | ||
958 | * is set to the values stored in the channel | ||
959 | * information struct @chan. | ||
960 | */ | ||
961 | |||
962 | static void via_chan_pcm_fmt (struct via_channel *chan, int reset) | ||
963 | { | ||
964 | DPRINTK ("ENTER, pcm_fmt=0x%02X, reset=%s\n", | ||
965 | chan->pcm_fmt, reset ? "yes" : "no"); | ||
966 | |||
967 | assert (chan != NULL); | ||
968 | |||
969 | if (reset) | ||
970 | { | ||
971 | /* reset to 8-bit mono mode */ | ||
972 | chan->pcm_fmt = 0; | ||
973 | chan->channels = 1; | ||
974 | } | ||
975 | |||
976 | /* enable interrupts on FLAG and EOL */ | ||
977 | chan->pcm_fmt |= VIA_CHAN_TYPE_MASK; | ||
978 | |||
979 | /* if we are recording, enable recording fifo bit */ | ||
980 | if (chan->is_record) | ||
981 | chan->pcm_fmt |= VIA_PCM_REC_FIFO; | ||
982 | /* set interrupt select bits where applicable (PCM in & out channels) */ | ||
983 | if (!chan->is_record) | ||
984 | chan->pcm_fmt |= VIA_CHAN_TYPE_INT_SELECT; | ||
985 | |||
986 | DPRINTK("SET FMT - %02x %02x\n", chan->intmask , chan->is_multi); | ||
987 | |||
988 | if(chan->intmask) | ||
989 | { | ||
990 | u32 m; | ||
991 | |||
992 | /* | ||
993 | * Channel 0x4 is up to 6 x 16bit and has to be | ||
994 | * programmed differently | ||
995 | */ | ||
996 | |||
997 | if(chan->is_multi) | ||
998 | { | ||
999 | u8 c = 0; | ||
1000 | |||
1001 | /* | ||
1002 | * Load the type bit for num channels | ||
1003 | * and 8/16bit | ||
1004 | */ | ||
1005 | |||
1006 | if(chan->pcm_fmt & VIA_PCM_FMT_16BIT) | ||
1007 | c = 1 << 7; | ||
1008 | if(chan->pcm_fmt & VIA_PCM_FMT_STEREO) | ||
1009 | c |= (2<<4); | ||
1010 | else | ||
1011 | c |= (1<<4); | ||
1012 | |||
1013 | outb(c, chan->iobase + VIA_PCM_TYPE); | ||
1014 | |||
1015 | /* | ||
1016 | * Set the channel steering | ||
1017 | * Mono | ||
1018 | * Channel 0 to slot 3 | ||
1019 | * Channel 0 to slot 4 | ||
1020 | * Stereo | ||
1021 | * Channel 0 to slot 3 | ||
1022 | * Channel 1 to slot 4 | ||
1023 | */ | ||
1024 | |||
1025 | switch(chan->channels) | ||
1026 | { | ||
1027 | case 1: | ||
1028 | outl(0xFF000000 | (1<<0) | (1<<4) , chan->iobase + VIA_PCM_STOPRATE); | ||
1029 | break; | ||
1030 | case 2: | ||
1031 | outl(0xFF000000 | (1<<0) | (2<<4) , chan->iobase + VIA_PCM_STOPRATE); | ||
1032 | break; | ||
1033 | case 4: | ||
1034 | outl(0xFF000000 | (1<<0) | (2<<4) | (3<<8) | (4<<12), chan->iobase + VIA_PCM_STOPRATE); | ||
1035 | break; | ||
1036 | case 6: | ||
1037 | outl(0xFF000000 | (1<<0) | (2<<4) | (5<<8) | (6<<12) | (3<<16) | (4<<20), chan->iobase + VIA_PCM_STOPRATE); | ||
1038 | break; | ||
1039 | } | ||
1040 | } | ||
1041 | else | ||
1042 | { | ||
1043 | /* | ||
1044 | * New style, turn off channel volume | ||
1045 | * control, set bits in the right register | ||
1046 | */ | ||
1047 | outb(0x0, chan->iobase + VIA_PCM_LEFTVOL); | ||
1048 | outb(0x0, chan->iobase + VIA_PCM_RIGHTVOL); | ||
1049 | |||
1050 | m = inl(chan->iobase + VIA_PCM_STOPRATE); | ||
1051 | m &= ~(3<<20); | ||
1052 | if(chan->pcm_fmt & VIA_PCM_FMT_STEREO) | ||
1053 | m |= (1 << 20); | ||
1054 | if(chan->pcm_fmt & VIA_PCM_FMT_16BIT) | ||
1055 | m |= (1 << 21); | ||
1056 | outl(m, chan->iobase + VIA_PCM_STOPRATE); | ||
1057 | } | ||
1058 | } | ||
1059 | else | ||
1060 | outb (chan->pcm_fmt, chan->iobase + VIA_PCM_TYPE); | ||
1061 | |||
1062 | |||
1063 | DPRINTK ("EXIT, pcm_fmt = 0x%02X, reg = 0x%02X\n", | ||
1064 | chan->pcm_fmt, | ||
1065 | inb (chan->iobase + VIA_PCM_TYPE)); | ||
1066 | } | ||
1067 | |||
1068 | |||
1069 | /** | ||
1070 | * via_chan_clear - Stop DMA channel operation, and reset pointers | ||
1071 | * @card: the chip to accessed | ||
1072 | * @chan: Channel to be cleared | ||
1073 | * | ||
1074 | * Call via_chan_stop to halt DMA operations, and then resets | ||
1075 | * all software pointers which track DMA operation. | ||
1076 | */ | ||
1077 | |||
1078 | static void via_chan_clear (struct via_info *card, struct via_channel *chan) | ||
1079 | { | ||
1080 | DPRINTK ("ENTER\n"); | ||
1081 | via_chan_stop (chan->iobase); | ||
1082 | via_chan_buffer_free(card, chan); | ||
1083 | chan->is_active = 0; | ||
1084 | chan->is_mapped = 0; | ||
1085 | chan->is_enabled = 1; | ||
1086 | chan->slop_len = 0; | ||
1087 | chan->sw_ptr = 0; | ||
1088 | chan->n_irqs = 0; | ||
1089 | atomic_set (&chan->hw_ptr, 0); | ||
1090 | DPRINTK ("EXIT\n"); | ||
1091 | } | ||
1092 | |||
1093 | |||
1094 | /** | ||
1095 | * via_chan_set_speed - Set PCM sample rate for given channel | ||
1096 | * @card: Private info for specified board | ||
1097 | * @chan: Channel whose sample rate will be adjusted | ||
1098 | * @val: New sample rate, in Khz | ||
1099 | * | ||
1100 | * Helper function for the %SNDCTL_DSP_SPEED ioctl. OSS semantics | ||
1101 | * demand that all audio operations halt (if they are not already | ||
1102 | * halted) when the %SNDCTL_DSP_SPEED is given. | ||
1103 | * | ||
1104 | * This function halts all audio operations for the given channel | ||
1105 | * @chan, and then calls via_set_rate to set the audio hardware | ||
1106 | * to the new rate. | ||
1107 | */ | ||
1108 | |||
1109 | static int via_chan_set_speed (struct via_info *card, | ||
1110 | struct via_channel *chan, int val) | ||
1111 | { | ||
1112 | DPRINTK ("ENTER, requested rate = %d\n", val); | ||
1113 | |||
1114 | via_chan_clear (card, chan); | ||
1115 | |||
1116 | val = via_set_rate (card->ac97, chan, val); | ||
1117 | |||
1118 | DPRINTK ("EXIT, returning %d\n", val); | ||
1119 | return val; | ||
1120 | } | ||
1121 | |||
1122 | |||
1123 | /** | ||
1124 | * via_chan_set_fmt - Set PCM sample size for given channel | ||
1125 | * @card: Private info for specified board | ||
1126 | * @chan: Channel whose sample size will be adjusted | ||
1127 | * @val: New sample size, use the %AFMT_xxx constants | ||
1128 | * | ||
1129 | * Helper function for the %SNDCTL_DSP_SETFMT ioctl. OSS semantics | ||
1130 | * demand that all audio operations halt (if they are not already | ||
1131 | * halted) when the %SNDCTL_DSP_SETFMT is given. | ||
1132 | * | ||
1133 | * This function halts all audio operations for the given channel | ||
1134 | * @chan, and then calls via_chan_pcm_fmt to set the audio hardware | ||
1135 | * to the new sample size, either 8-bit or 16-bit. | ||
1136 | */ | ||
1137 | |||
1138 | static int via_chan_set_fmt (struct via_info *card, | ||
1139 | struct via_channel *chan, int val) | ||
1140 | { | ||
1141 | DPRINTK ("ENTER, val=%s\n", | ||
1142 | val == AFMT_U8 ? "AFMT_U8" : | ||
1143 | val == AFMT_S16_LE ? "AFMT_S16_LE" : | ||
1144 | "unknown"); | ||
1145 | |||
1146 | via_chan_clear (card, chan); | ||
1147 | |||
1148 | assert (val != AFMT_QUERY); /* this case is handled elsewhere */ | ||
1149 | |||
1150 | switch (val) { | ||
1151 | case AFMT_S16_LE: | ||
1152 | if ((chan->pcm_fmt & VIA_PCM_FMT_16BIT) == 0) { | ||
1153 | chan->pcm_fmt |= VIA_PCM_FMT_16BIT; | ||
1154 | via_chan_pcm_fmt (chan, 0); | ||
1155 | } | ||
1156 | break; | ||
1157 | |||
1158 | case AFMT_U8: | ||
1159 | if (chan->pcm_fmt & VIA_PCM_FMT_16BIT) { | ||
1160 | chan->pcm_fmt &= ~VIA_PCM_FMT_16BIT; | ||
1161 | via_chan_pcm_fmt (chan, 0); | ||
1162 | } | ||
1163 | break; | ||
1164 | |||
1165 | default: | ||
1166 | DPRINTK ("unknown AFMT: 0x%X\n", val); | ||
1167 | val = AFMT_S16_LE; | ||
1168 | } | ||
1169 | |||
1170 | DPRINTK ("EXIT\n"); | ||
1171 | return val; | ||
1172 | } | ||
1173 | |||
1174 | |||
1175 | /** | ||
1176 | * via_chan_set_stereo - Enable or disable stereo for a DMA channel | ||
1177 | * @card: Private info for specified board | ||
1178 | * @chan: Channel whose stereo setting will be adjusted | ||
1179 | * @val: New sample size, use the %AFMT_xxx constants | ||
1180 | * | ||
1181 | * Helper function for the %SNDCTL_DSP_CHANNELS and %SNDCTL_DSP_STEREO ioctls. OSS semantics | ||
1182 | * demand that all audio operations halt (if they are not already | ||
1183 | * halted) when %SNDCTL_DSP_CHANNELS or SNDCTL_DSP_STEREO is given. | ||
1184 | * | ||
1185 | * This function halts all audio operations for the given channel | ||
1186 | * @chan, and then calls via_chan_pcm_fmt to set the audio hardware | ||
1187 | * to enable or disable stereo. | ||
1188 | */ | ||
1189 | |||
1190 | static int via_chan_set_stereo (struct via_info *card, | ||
1191 | struct via_channel *chan, int val) | ||
1192 | { | ||
1193 | DPRINTK ("ENTER, channels = %d\n", val); | ||
1194 | |||
1195 | via_chan_clear (card, chan); | ||
1196 | |||
1197 | switch (val) { | ||
1198 | |||
1199 | /* mono */ | ||
1200 | case 1: | ||
1201 | chan->pcm_fmt &= ~VIA_PCM_FMT_STEREO; | ||
1202 | chan->channels = 1; | ||
1203 | via_chan_pcm_fmt (chan, 0); | ||
1204 | break; | ||
1205 | |||
1206 | /* stereo */ | ||
1207 | case 2: | ||
1208 | chan->pcm_fmt |= VIA_PCM_FMT_STEREO; | ||
1209 | chan->channels = 2; | ||
1210 | via_chan_pcm_fmt (chan, 0); | ||
1211 | break; | ||
1212 | |||
1213 | case 4: | ||
1214 | case 6: | ||
1215 | if(chan->is_multi) | ||
1216 | { | ||
1217 | chan->pcm_fmt |= VIA_PCM_FMT_STEREO; | ||
1218 | chan->channels = val; | ||
1219 | break; | ||
1220 | } | ||
1221 | /* unknown */ | ||
1222 | default: | ||
1223 | val = -EINVAL; | ||
1224 | break; | ||
1225 | } | ||
1226 | |||
1227 | DPRINTK ("EXIT, returning %d\n", val); | ||
1228 | return val; | ||
1229 | } | ||
1230 | |||
1231 | static int via_chan_set_buffering (struct via_info *card, | ||
1232 | struct via_channel *chan, int val) | ||
1233 | { | ||
1234 | int shift; | ||
1235 | |||
1236 | DPRINTK ("ENTER\n"); | ||
1237 | |||
1238 | /* in both cases the buffer cannot be changed */ | ||
1239 | if (chan->is_active || chan->is_mapped) { | ||
1240 | DPRINTK ("EXIT\n"); | ||
1241 | return -EINVAL; | ||
1242 | } | ||
1243 | |||
1244 | /* called outside SETFRAGMENT */ | ||
1245 | /* set defaults or do nothing */ | ||
1246 | if (val < 0) { | ||
1247 | |||
1248 | if (chan->frag_size && chan->frag_number) | ||
1249 | goto out; | ||
1250 | |||
1251 | DPRINTK ("\n"); | ||
1252 | |||
1253 | chan->frag_size = (VIA_DEFAULT_FRAG_TIME * chan->rate * chan->channels | ||
1254 | * ((chan->pcm_fmt & VIA_PCM_FMT_16BIT) ? 2 : 1)) / 1000 - 1; | ||
1255 | |||
1256 | shift = 0; | ||
1257 | while (chan->frag_size) { | ||
1258 | chan->frag_size >>= 1; | ||
1259 | shift++; | ||
1260 | } | ||
1261 | chan->frag_size = 1 << shift; | ||
1262 | |||
1263 | chan->frag_number = (VIA_DEFAULT_BUFFER_TIME / VIA_DEFAULT_FRAG_TIME); | ||
1264 | |||
1265 | DPRINTK ("setting default values %d %d\n", chan->frag_size, chan->frag_number); | ||
1266 | } else { | ||
1267 | chan->frag_size = 1 << (val & 0xFFFF); | ||
1268 | chan->frag_number = (val >> 16) & 0xFFFF; | ||
1269 | |||
1270 | DPRINTK ("using user values %d %d\n", chan->frag_size, chan->frag_number); | ||
1271 | } | ||
1272 | |||
1273 | /* quake3 wants frag_number to be a power of two */ | ||
1274 | shift = 0; | ||
1275 | while (chan->frag_number) { | ||
1276 | chan->frag_number >>= 1; | ||
1277 | shift++; | ||
1278 | } | ||
1279 | chan->frag_number = 1 << shift; | ||
1280 | |||
1281 | if (chan->frag_size > VIA_MAX_FRAG_SIZE) | ||
1282 | chan->frag_size = VIA_MAX_FRAG_SIZE; | ||
1283 | else if (chan->frag_size < VIA_MIN_FRAG_SIZE) | ||
1284 | chan->frag_size = VIA_MIN_FRAG_SIZE; | ||
1285 | |||
1286 | if (chan->frag_number < VIA_MIN_FRAG_NUMBER) | ||
1287 | chan->frag_number = VIA_MIN_FRAG_NUMBER; | ||
1288 | if (chan->frag_number > VIA_MAX_FRAG_NUMBER) | ||
1289 | chan->frag_number = VIA_MAX_FRAG_NUMBER; | ||
1290 | |||
1291 | if ((chan->frag_number * chan->frag_size) / PAGE_SIZE > VIA_MAX_BUFFER_DMA_PAGES) | ||
1292 | chan->frag_number = (VIA_MAX_BUFFER_DMA_PAGES * PAGE_SIZE) / chan->frag_size; | ||
1293 | |||
1294 | out: | ||
1295 | if (chan->is_record) | ||
1296 | atomic_set (&chan->n_frags, 0); | ||
1297 | else | ||
1298 | atomic_set (&chan->n_frags, chan->frag_number); | ||
1299 | |||
1300 | DPRINTK ("EXIT\n"); | ||
1301 | |||
1302 | return 0; | ||
1303 | } | ||
1304 | |||
1305 | #ifdef VIA_CHAN_DUMP_BUFS | ||
1306 | /** | ||
1307 | * via_chan_dump_bufs - Display DMA table contents | ||
1308 | * @chan: Channel whose DMA table will be displayed | ||
1309 | * | ||
1310 | * Debugging function which displays the contents of the | ||
1311 | * scatter-gather DMA table for the given channel @chan. | ||
1312 | */ | ||
1313 | |||
1314 | static void via_chan_dump_bufs (struct via_channel *chan) | ||
1315 | { | ||
1316 | int i; | ||
1317 | |||
1318 | for (i = 0; i < chan->frag_number; i++) { | ||
1319 | DPRINTK ("#%02d: addr=%x, count=%u, flag=%d, eol=%d\n", | ||
1320 | i, chan->sgtable[i].addr, | ||
1321 | chan->sgtable[i].count & 0x00FFFFFF, | ||
1322 | chan->sgtable[i].count & VIA_FLAG ? 1 : 0, | ||
1323 | chan->sgtable[i].count & VIA_EOL ? 1 : 0); | ||
1324 | } | ||
1325 | DPRINTK ("buf_in_use = %d, nextbuf = %d\n", | ||
1326 | atomic_read (&chan->buf_in_use), | ||
1327 | atomic_read (&chan->sw_ptr)); | ||
1328 | } | ||
1329 | #endif /* VIA_CHAN_DUMP_BUFS */ | ||
1330 | |||
1331 | |||
1332 | /** | ||
1333 | * via_chan_flush_frag - Flush partially-full playback buffer to hardware | ||
1334 | * @chan: Channel whose DMA table will be flushed | ||
1335 | * | ||
1336 | * Flushes partially-full playback buffer to hardware. | ||
1337 | */ | ||
1338 | |||
1339 | static void via_chan_flush_frag (struct via_channel *chan) | ||
1340 | { | ||
1341 | DPRINTK ("ENTER\n"); | ||
1342 | |||
1343 | assert (chan->slop_len > 0); | ||
1344 | |||
1345 | if (chan->sw_ptr == (chan->frag_number - 1)) | ||
1346 | chan->sw_ptr = 0; | ||
1347 | else | ||
1348 | chan->sw_ptr++; | ||
1349 | |||
1350 | chan->slop_len = 0; | ||
1351 | |||
1352 | assert (atomic_read (&chan->n_frags) > 0); | ||
1353 | atomic_dec (&chan->n_frags); | ||
1354 | |||
1355 | DPRINTK ("EXIT\n"); | ||
1356 | } | ||
1357 | |||
1358 | |||
1359 | |||
1360 | /** | ||
1361 | * via_chan_maybe_start - Initiate audio hardware DMA operation | ||
1362 | * @chan: Channel whose DMA is to be started | ||
1363 | * | ||
1364 | * Initiate DMA operation, if the DMA engine for the given | ||
1365 | * channel @chan is not already active. | ||
1366 | */ | ||
1367 | |||
1368 | static inline void via_chan_maybe_start (struct via_channel *chan) | ||
1369 | { | ||
1370 | assert (chan->is_active == sg_active(chan->iobase)); | ||
1371 | |||
1372 | DPRINTK ("MAYBE START %s\n", chan->name); | ||
1373 | if (!chan->is_active && chan->is_enabled) { | ||
1374 | chan->is_active = 1; | ||
1375 | sg_begin (chan); | ||
1376 | DPRINTK ("starting channel %s\n", chan->name); | ||
1377 | } | ||
1378 | } | ||
1379 | |||
1380 | |||
1381 | /**************************************************************** | ||
1382 | * | ||
1383 | * Interface to ac97-codec module | ||
1384 | * | ||
1385 | * | ||
1386 | */ | ||
1387 | |||
1388 | /** | ||
1389 | * via_ac97_wait_idle - Wait until AC97 codec is not busy | ||
1390 | * @card: Private info for specified board | ||
1391 | * | ||
1392 | * Sleep until the AC97 codec is no longer busy. | ||
1393 | * Returns the final value read from the SGD | ||
1394 | * register being polled. | ||
1395 | */ | ||
1396 | |||
1397 | static u8 via_ac97_wait_idle (struct via_info *card) | ||
1398 | { | ||
1399 | u8 tmp8; | ||
1400 | int counter = VIA_COUNTER_LIMIT; | ||
1401 | |||
1402 | DPRINTK ("ENTER/EXIT\n"); | ||
1403 | |||
1404 | assert (card != NULL); | ||
1405 | assert (card->pdev != NULL); | ||
1406 | |||
1407 | do { | ||
1408 | udelay (15); | ||
1409 | |||
1410 | tmp8 = inb (card->baseaddr + 0x83); | ||
1411 | } while ((tmp8 & VIA_CR83_BUSY) && (counter-- > 0)); | ||
1412 | |||
1413 | if (tmp8 & VIA_CR83_BUSY) | ||
1414 | printk (KERN_WARNING PFX "timeout waiting on AC97 codec\n"); | ||
1415 | return tmp8; | ||
1416 | } | ||
1417 | |||
1418 | |||
1419 | /** | ||
1420 | * via_ac97_read_reg - Read AC97 standard register | ||
1421 | * @codec: Pointer to generic AC97 codec info | ||
1422 | * @reg: Index of AC97 register to be read | ||
1423 | * | ||
1424 | * Read the value of a single AC97 codec register, | ||
1425 | * as defined by the Intel AC97 specification. | ||
1426 | * | ||
1427 | * Defines the standard AC97 read-register operation | ||
1428 | * required by the kernel's ac97_codec interface. | ||
1429 | * | ||
1430 | * Returns the 16-bit value stored in the specified | ||
1431 | * register. | ||
1432 | */ | ||
1433 | |||
1434 | static u16 via_ac97_read_reg (struct ac97_codec *codec, u8 reg) | ||
1435 | { | ||
1436 | unsigned long data; | ||
1437 | struct via_info *card; | ||
1438 | int counter; | ||
1439 | |||
1440 | DPRINTK ("ENTER\n"); | ||
1441 | |||
1442 | assert (codec != NULL); | ||
1443 | assert (codec->private_data != NULL); | ||
1444 | |||
1445 | card = codec->private_data; | ||
1446 | |||
1447 | spin_lock(&card->ac97_lock); | ||
1448 | |||
1449 | /* Every time we write to register 80 we cause a transaction. | ||
1450 | The only safe way to clear the valid bit is to write it at | ||
1451 | the same time as the command */ | ||
1452 | data = (reg << 16) | VIA_CR80_READ | VIA_CR80_VALID; | ||
1453 | |||
1454 | outl (data, card->baseaddr + VIA_BASE0_AC97_CTRL); | ||
1455 | udelay (20); | ||
1456 | |||
1457 | for (counter = VIA_COUNTER_LIMIT; counter > 0; counter--) { | ||
1458 | udelay (1); | ||
1459 | if ((((data = inl(card->baseaddr + VIA_BASE0_AC97_CTRL)) & | ||
1460 | (VIA_CR80_VALID|VIA_CR80_BUSY)) == VIA_CR80_VALID)) | ||
1461 | goto out; | ||
1462 | } | ||
1463 | |||
1464 | printk (KERN_WARNING PFX "timeout while reading AC97 codec (0x%lX)\n", data); | ||
1465 | goto err_out; | ||
1466 | |||
1467 | out: | ||
1468 | /* Once the valid bit has become set, we must wait a complete AC97 | ||
1469 | frame before the data has settled. */ | ||
1470 | udelay(25); | ||
1471 | data = (unsigned long) inl (card->baseaddr + VIA_BASE0_AC97_CTRL); | ||
1472 | |||
1473 | outb (0x02, card->baseaddr + 0x83); | ||
1474 | |||
1475 | if (((data & 0x007F0000) >> 16) == reg) { | ||
1476 | DPRINTK ("EXIT, success, data=0x%lx, retval=0x%lx\n", | ||
1477 | data, data & 0x0000FFFF); | ||
1478 | spin_unlock(&card->ac97_lock); | ||
1479 | return data & 0x0000FFFF; | ||
1480 | } | ||
1481 | |||
1482 | printk (KERN_WARNING "via82cxxx_audio: not our index: reg=0x%x, newreg=0x%lx\n", | ||
1483 | reg, ((data & 0x007F0000) >> 16)); | ||
1484 | |||
1485 | err_out: | ||
1486 | spin_unlock(&card->ac97_lock); | ||
1487 | DPRINTK ("EXIT, returning 0\n"); | ||
1488 | return 0; | ||
1489 | } | ||
1490 | |||
1491 | |||
1492 | /** | ||
1493 | * via_ac97_write_reg - Write AC97 standard register | ||
1494 | * @codec: Pointer to generic AC97 codec info | ||
1495 | * @reg: Index of AC97 register to be written | ||
1496 | * @value: Value to be written to AC97 register | ||
1497 | * | ||
1498 | * Write the value of a single AC97 codec register, | ||
1499 | * as defined by the Intel AC97 specification. | ||
1500 | * | ||
1501 | * Defines the standard AC97 write-register operation | ||
1502 | * required by the kernel's ac97_codec interface. | ||
1503 | */ | ||
1504 | |||
1505 | static void via_ac97_write_reg (struct ac97_codec *codec, u8 reg, u16 value) | ||
1506 | { | ||
1507 | u32 data; | ||
1508 | struct via_info *card; | ||
1509 | int counter; | ||
1510 | |||
1511 | DPRINTK ("ENTER\n"); | ||
1512 | |||
1513 | assert (codec != NULL); | ||
1514 | assert (codec->private_data != NULL); | ||
1515 | |||
1516 | card = codec->private_data; | ||
1517 | |||
1518 | spin_lock(&card->ac97_lock); | ||
1519 | |||
1520 | data = (reg << 16) + value; | ||
1521 | outl (data, card->baseaddr + VIA_BASE0_AC97_CTRL); | ||
1522 | udelay (10); | ||
1523 | |||
1524 | for (counter = VIA_COUNTER_LIMIT; counter > 0; counter--) { | ||
1525 | if ((inb (card->baseaddr + 0x83) & VIA_CR83_BUSY) == 0) | ||
1526 | goto out; | ||
1527 | |||
1528 | udelay (15); | ||
1529 | } | ||
1530 | |||
1531 | printk (KERN_WARNING PFX "timeout after AC97 codec write (0x%X, 0x%X)\n", reg, value); | ||
1532 | |||
1533 | out: | ||
1534 | spin_unlock(&card->ac97_lock); | ||
1535 | DPRINTK ("EXIT\n"); | ||
1536 | } | ||
1537 | |||
1538 | |||
1539 | static int via_mixer_open (struct inode *inode, struct file *file) | ||
1540 | { | ||
1541 | int minor = iminor(inode); | ||
1542 | struct via_info *card; | ||
1543 | struct pci_dev *pdev = NULL; | ||
1544 | struct pci_driver *drvr; | ||
1545 | |||
1546 | DPRINTK ("ENTER\n"); | ||
1547 | |||
1548 | while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev)) != NULL) { | ||
1549 | drvr = pci_dev_driver (pdev); | ||
1550 | if (drvr == &via_driver) { | ||
1551 | assert (pci_get_drvdata (pdev) != NULL); | ||
1552 | |||
1553 | card = pci_get_drvdata (pdev); | ||
1554 | if (card->ac97->dev_mixer == minor) | ||
1555 | goto match; | ||
1556 | } | ||
1557 | } | ||
1558 | |||
1559 | DPRINTK ("EXIT, returning -ENODEV\n"); | ||
1560 | return -ENODEV; | ||
1561 | |||
1562 | match: | ||
1563 | file->private_data = card->ac97; | ||
1564 | |||
1565 | DPRINTK ("EXIT, returning 0\n"); | ||
1566 | return nonseekable_open(inode, file); | ||
1567 | } | ||
1568 | |||
1569 | static int via_mixer_ioctl (struct inode *inode, struct file *file, unsigned int cmd, | ||
1570 | unsigned long arg) | ||
1571 | { | ||
1572 | struct ac97_codec *codec = file->private_data; | ||
1573 | struct via_info *card; | ||
1574 | int nonblock = (file->f_flags & O_NONBLOCK); | ||
1575 | int rc; | ||
1576 | |||
1577 | DPRINTK ("ENTER\n"); | ||
1578 | |||
1579 | assert (codec != NULL); | ||
1580 | card = codec->private_data; | ||
1581 | assert (card != NULL); | ||
1582 | |||
1583 | rc = via_syscall_down (card, nonblock); | ||
1584 | if (rc) goto out; | ||
1585 | |||
1586 | #if 0 | ||
1587 | /* | ||
1588 | * Intercept volume control on 8233 and 8235 | ||
1589 | */ | ||
1590 | if(card->volume) | ||
1591 | { | ||
1592 | switch(cmd) | ||
1593 | { | ||
1594 | case SOUND_MIXER_READ_VOLUME: | ||
1595 | return card->mixer_vol; | ||
1596 | case SOUND_MIXER_WRITE_VOLUME: | ||
1597 | { | ||
1598 | int v; | ||
1599 | if(get_user(v, (int *)arg)) | ||
1600 | { | ||
1601 | rc = -EFAULT; | ||
1602 | goto out; | ||
1603 | } | ||
1604 | card->mixer_vol = v; | ||
1605 | } | ||
1606 | } | ||
1607 | } | ||
1608 | #endif | ||
1609 | rc = codec->mixer_ioctl(codec, cmd, arg); | ||
1610 | |||
1611 | up (&card->syscall_sem); | ||
1612 | |||
1613 | out: | ||
1614 | DPRINTK ("EXIT, returning %d\n", rc); | ||
1615 | return rc; | ||
1616 | } | ||
1617 | |||
1618 | |||
1619 | static struct file_operations via_mixer_fops = { | ||
1620 | .owner = THIS_MODULE, | ||
1621 | .open = via_mixer_open, | ||
1622 | .llseek = no_llseek, | ||
1623 | .ioctl = via_mixer_ioctl, | ||
1624 | }; | ||
1625 | |||
1626 | |||
1627 | static int __devinit via_ac97_reset (struct via_info *card) | ||
1628 | { | ||
1629 | struct pci_dev *pdev = card->pdev; | ||
1630 | u8 tmp8; | ||
1631 | u16 tmp16; | ||
1632 | |||
1633 | DPRINTK ("ENTER\n"); | ||
1634 | |||
1635 | assert (pdev != NULL); | ||
1636 | |||
1637 | #ifndef NDEBUG | ||
1638 | { | ||
1639 | u8 r40,r41,r42,r43,r44,r48; | ||
1640 | pci_read_config_byte (card->pdev, 0x40, &r40); | ||
1641 | pci_read_config_byte (card->pdev, 0x41, &r41); | ||
1642 | pci_read_config_byte (card->pdev, 0x42, &r42); | ||
1643 | pci_read_config_byte (card->pdev, 0x43, &r43); | ||
1644 | pci_read_config_byte (card->pdev, 0x44, &r44); | ||
1645 | pci_read_config_byte (card->pdev, 0x48, &r48); | ||
1646 | DPRINTK ("PCI config: %02X %02X %02X %02X %02X %02X\n", | ||
1647 | r40,r41,r42,r43,r44,r48); | ||
1648 | |||
1649 | spin_lock_irq (&card->lock); | ||
1650 | DPRINTK ("regs==%02X %02X %02X %08X %08X %08X %08X\n", | ||
1651 | inb (card->baseaddr + 0x00), | ||
1652 | inb (card->baseaddr + 0x01), | ||
1653 | inb (card->baseaddr + 0x02), | ||
1654 | inl (card->baseaddr + 0x04), | ||
1655 | inl (card->baseaddr + 0x0C), | ||
1656 | inl (card->baseaddr + 0x80), | ||
1657 | inl (card->baseaddr + 0x84)); | ||
1658 | spin_unlock_irq (&card->lock); | ||
1659 | |||
1660 | } | ||
1661 | #endif | ||
1662 | |||
1663 | /* | ||
1664 | * Reset AC97 controller: enable, disable, enable, | ||
1665 | * pausing after each command for good luck. Only | ||
1666 | * do this if the codec is not ready, because it causes | ||
1667 | * loud pops and such due to such a hard codec reset. | ||
1668 | */ | ||
1669 | pci_read_config_byte (pdev, VIA_ACLINK_STATUS, &tmp8); | ||
1670 | if ((tmp8 & VIA_CR40_AC97_READY) == 0) { | ||
1671 | pci_write_config_byte (pdev, VIA_ACLINK_CTRL, | ||
1672 | VIA_CR41_AC97_ENABLE | | ||
1673 | VIA_CR41_AC97_RESET | | ||
1674 | VIA_CR41_AC97_WAKEUP); | ||
1675 | udelay (100); | ||
1676 | |||
1677 | pci_write_config_byte (pdev, VIA_ACLINK_CTRL, 0); | ||
1678 | udelay (100); | ||
1679 | |||
1680 | pci_write_config_byte (pdev, VIA_ACLINK_CTRL, | ||
1681 | VIA_CR41_AC97_ENABLE | | ||
1682 | VIA_CR41_PCM_ENABLE | | ||
1683 | VIA_CR41_VRA | VIA_CR41_AC97_RESET); | ||
1684 | udelay (100); | ||
1685 | } | ||
1686 | |||
1687 | /* Make sure VRA is enabled, in case we didn't do a | ||
1688 | * complete codec reset, above | ||
1689 | */ | ||
1690 | pci_read_config_byte (pdev, VIA_ACLINK_CTRL, &tmp8); | ||
1691 | if (((tmp8 & VIA_CR41_VRA) == 0) || | ||
1692 | ((tmp8 & VIA_CR41_AC97_ENABLE) == 0) || | ||
1693 | ((tmp8 & VIA_CR41_PCM_ENABLE) == 0) || | ||
1694 | ((tmp8 & VIA_CR41_AC97_RESET) == 0)) { | ||
1695 | pci_write_config_byte (pdev, VIA_ACLINK_CTRL, | ||
1696 | VIA_CR41_AC97_ENABLE | | ||
1697 | VIA_CR41_PCM_ENABLE | | ||
1698 | VIA_CR41_VRA | VIA_CR41_AC97_RESET); | ||
1699 | udelay (100); | ||
1700 | } | ||
1701 | |||
1702 | if(card->legacy) | ||
1703 | { | ||
1704 | #if 0 /* this breaks on K7M */ | ||
1705 | /* disable legacy stuff */ | ||
1706 | pci_write_config_byte (pdev, 0x42, 0x00); | ||
1707 | udelay(10); | ||
1708 | #endif | ||
1709 | |||
1710 | /* route FM trap to IRQ, disable FM trap */ | ||
1711 | pci_write_config_byte (pdev, 0x48, 0x05); | ||
1712 | udelay(10); | ||
1713 | } | ||
1714 | |||
1715 | /* disable all codec GPI interrupts */ | ||
1716 | outl (0, pci_resource_start (pdev, 0) + 0x8C); | ||
1717 | |||
1718 | /* WARNING: this line is magic. Remove this | ||
1719 | * and things break. */ | ||
1720 | /* enable variable rate */ | ||
1721 | tmp16 = via_ac97_read_reg (card->ac97, AC97_EXTENDED_STATUS); | ||
1722 | if ((tmp16 & 1) == 0) | ||
1723 | via_ac97_write_reg (card->ac97, AC97_EXTENDED_STATUS, tmp16 | 1); | ||
1724 | |||
1725 | DPRINTK ("EXIT, returning 0\n"); | ||
1726 | return 0; | ||
1727 | } | ||
1728 | |||
1729 | |||
1730 | static void via_ac97_codec_wait (struct ac97_codec *codec) | ||
1731 | { | ||
1732 | assert (codec->private_data != NULL); | ||
1733 | via_ac97_wait_idle (codec->private_data); | ||
1734 | } | ||
1735 | |||
1736 | |||
1737 | static int __devinit via_ac97_init (struct via_info *card) | ||
1738 | { | ||
1739 | int rc; | ||
1740 | u16 tmp16; | ||
1741 | |||
1742 | DPRINTK ("ENTER\n"); | ||
1743 | |||
1744 | assert (card != NULL); | ||
1745 | |||
1746 | card->ac97 = ac97_alloc_codec(); | ||
1747 | if(card->ac97 == NULL) | ||
1748 | return -ENOMEM; | ||
1749 | |||
1750 | card->ac97->private_data = card; | ||
1751 | card->ac97->codec_read = via_ac97_read_reg; | ||
1752 | card->ac97->codec_write = via_ac97_write_reg; | ||
1753 | card->ac97->codec_wait = via_ac97_codec_wait; | ||
1754 | |||
1755 | card->ac97->dev_mixer = register_sound_mixer (&via_mixer_fops, -1); | ||
1756 | if (card->ac97->dev_mixer < 0) { | ||
1757 | printk (KERN_ERR PFX "unable to register AC97 mixer, aborting\n"); | ||
1758 | DPRINTK ("EXIT, returning -EIO\n"); | ||
1759 | ac97_release_codec(card->ac97); | ||
1760 | return -EIO; | ||
1761 | } | ||
1762 | |||
1763 | rc = via_ac97_reset (card); | ||
1764 | if (rc) { | ||
1765 | printk (KERN_ERR PFX "unable to reset AC97 codec, aborting\n"); | ||
1766 | goto err_out; | ||
1767 | } | ||
1768 | |||
1769 | mdelay(10); | ||
1770 | |||
1771 | if (ac97_probe_codec (card->ac97) == 0) { | ||
1772 | printk (KERN_ERR PFX "unable to probe AC97 codec, aborting\n"); | ||
1773 | rc = -EIO; | ||
1774 | goto err_out; | ||
1775 | } | ||
1776 | |||
1777 | /* enable variable rate */ | ||
1778 | tmp16 = via_ac97_read_reg (card->ac97, AC97_EXTENDED_STATUS); | ||
1779 | via_ac97_write_reg (card->ac97, AC97_EXTENDED_STATUS, tmp16 | 1); | ||
1780 | |||
1781 | /* | ||
1782 | * If we cannot enable VRA, we have a locked-rate codec. | ||
1783 | * We try again to enable VRA before assuming so, however. | ||
1784 | */ | ||
1785 | tmp16 = via_ac97_read_reg (card->ac97, AC97_EXTENDED_STATUS); | ||
1786 | if ((tmp16 & 1) == 0) { | ||
1787 | via_ac97_write_reg (card->ac97, AC97_EXTENDED_STATUS, tmp16 | 1); | ||
1788 | tmp16 = via_ac97_read_reg (card->ac97, AC97_EXTENDED_STATUS); | ||
1789 | if ((tmp16 & 1) == 0) { | ||
1790 | card->locked_rate = 1; | ||
1791 | printk (KERN_WARNING PFX "Codec rate locked at 48Khz\n"); | ||
1792 | } | ||
1793 | } | ||
1794 | |||
1795 | DPRINTK ("EXIT, returning 0\n"); | ||
1796 | return 0; | ||
1797 | |||
1798 | err_out: | ||
1799 | unregister_sound_mixer (card->ac97->dev_mixer); | ||
1800 | DPRINTK ("EXIT, returning %d\n", rc); | ||
1801 | ac97_release_codec(card->ac97); | ||
1802 | return rc; | ||
1803 | } | ||
1804 | |||
1805 | |||
1806 | static void via_ac97_cleanup (struct via_info *card) | ||
1807 | { | ||
1808 | DPRINTK ("ENTER\n"); | ||
1809 | |||
1810 | assert (card != NULL); | ||
1811 | assert (card->ac97->dev_mixer >= 0); | ||
1812 | |||
1813 | unregister_sound_mixer (card->ac97->dev_mixer); | ||
1814 | ac97_release_codec(card->ac97); | ||
1815 | |||
1816 | DPRINTK ("EXIT\n"); | ||
1817 | } | ||
1818 | |||
1819 | |||
1820 | |||
1821 | /**************************************************************** | ||
1822 | * | ||
1823 | * Interrupt-related code | ||
1824 | * | ||
1825 | */ | ||
1826 | |||
1827 | /** | ||
1828 | * via_intr_channel - handle an interrupt for a single channel | ||
1829 | * @card: unused | ||
1830 | * @chan: handle interrupt for this channel | ||
1831 | * | ||
1832 | * This is the "meat" of the interrupt handler, | ||
1833 | * containing the actions taken each time an interrupt | ||
1834 | * occurs. All communication and coordination with | ||
1835 | * userspace takes place here. | ||
1836 | * | ||
1837 | * Locking: inside card->lock | ||
1838 | */ | ||
1839 | |||
1840 | static void via_intr_channel (struct via_info *card, struct via_channel *chan) | ||
1841 | { | ||
1842 | u8 status; | ||
1843 | int n; | ||
1844 | |||
1845 | /* check pertinent bits of status register for action bits */ | ||
1846 | status = inb (chan->iobase) & (VIA_SGD_FLAG | VIA_SGD_EOL | VIA_SGD_STOPPED); | ||
1847 | if (!status) | ||
1848 | return; | ||
1849 | |||
1850 | /* acknowledge any flagged bits ASAP */ | ||
1851 | outb (status, chan->iobase); | ||
1852 | |||
1853 | if (!chan->sgtable) /* XXX: temporary solution */ | ||
1854 | return; | ||
1855 | |||
1856 | /* grab current h/w ptr value */ | ||
1857 | n = atomic_read (&chan->hw_ptr); | ||
1858 | |||
1859 | /* sanity check: make sure our h/w ptr doesn't have a weird value */ | ||
1860 | assert (n >= 0); | ||
1861 | assert (n < chan->frag_number); | ||
1862 | |||
1863 | |||
1864 | /* reset SGD data structure in memory to reflect a full buffer, | ||
1865 | * and advance the h/w ptr, wrapping around to zero if needed | ||
1866 | */ | ||
1867 | if (n == (chan->frag_number - 1)) { | ||
1868 | chan->sgtable[n].count = cpu_to_le32(chan->frag_size | VIA_EOL); | ||
1869 | atomic_set (&chan->hw_ptr, 0); | ||
1870 | } else { | ||
1871 | chan->sgtable[n].count = cpu_to_le32(chan->frag_size | VIA_FLAG); | ||
1872 | atomic_inc (&chan->hw_ptr); | ||
1873 | } | ||
1874 | |||
1875 | /* accounting crap for SNDCTL_DSP_GETxPTR */ | ||
1876 | chan->n_irqs++; | ||
1877 | chan->bytes += chan->frag_size; | ||
1878 | /* FIXME - signed overflow is undefined */ | ||
1879 | if (chan->bytes < 0) /* handle overflow of 31-bit value */ | ||
1880 | chan->bytes = chan->frag_size; | ||
1881 | /* all following checks only occur when not in mmap(2) mode */ | ||
1882 | if (!chan->is_mapped) | ||
1883 | { | ||
1884 | /* If we are recording, then n_frags represents the number | ||
1885 | * of fragments waiting to be handled by userspace. | ||
1886 | * If we are playback, then n_frags represents the number | ||
1887 | * of fragments remaining to be filled by userspace. | ||
1888 | * We increment here. If we reach max number of fragments, | ||
1889 | * this indicates an underrun/overrun. For this case under OSS, | ||
1890 | * we stop the record/playback process. | ||
1891 | */ | ||
1892 | if (atomic_read (&chan->n_frags) < chan->frag_number) | ||
1893 | atomic_inc (&chan->n_frags); | ||
1894 | assert (atomic_read (&chan->n_frags) <= chan->frag_number); | ||
1895 | if (atomic_read (&chan->n_frags) == chan->frag_number) { | ||
1896 | chan->is_active = 0; | ||
1897 | via_chan_stop (chan->iobase); | ||
1898 | } | ||
1899 | } | ||
1900 | /* wake up anyone listening to see when interrupts occur */ | ||
1901 | wake_up_all (&chan->wait); | ||
1902 | |||
1903 | DPRINTK ("%s intr, status=0x%02X, hwptr=0x%lX, chan->hw_ptr=%d\n", | ||
1904 | chan->name, status, (long) inl (chan->iobase + 0x04), | ||
1905 | atomic_read (&chan->hw_ptr)); | ||
1906 | |||
1907 | DPRINTK ("%s intr, channel n_frags == %d, missed %d\n", chan->name, | ||
1908 | atomic_read (&chan->n_frags), missed); | ||
1909 | } | ||
1910 | |||
1911 | |||
1912 | static irqreturn_t via_interrupt(int irq, void *dev_id, struct pt_regs *regs) | ||
1913 | { | ||
1914 | struct via_info *card = dev_id; | ||
1915 | u32 status32; | ||
1916 | |||
1917 | /* to minimize interrupt sharing costs, we use the SGD status | ||
1918 | * shadow register to check the status of all inputs and | ||
1919 | * outputs with a single 32-bit bus read. If no interrupt | ||
1920 | * conditions are flagged, we exit immediately | ||
1921 | */ | ||
1922 | status32 = inl (card->baseaddr + VIA_BASE0_SGD_STATUS_SHADOW); | ||
1923 | if (!(status32 & VIA_INTR_MASK)) | ||
1924 | { | ||
1925 | #ifdef CONFIG_MIDI_VIA82CXXX | ||
1926 | if (card->midi_devc) | ||
1927 | uart401intr(irq, card->midi_devc, regs); | ||
1928 | #endif | ||
1929 | return IRQ_HANDLED; | ||
1930 | } | ||
1931 | DPRINTK ("intr, status32 == 0x%08X\n", status32); | ||
1932 | |||
1933 | /* synchronize interrupt handling under SMP. this spinlock | ||
1934 | * goes away completely on UP | ||
1935 | */ | ||
1936 | spin_lock (&card->lock); | ||
1937 | |||
1938 | if (status32 & VIA_INTR_OUT) | ||
1939 | via_intr_channel (card, &card->ch_out); | ||
1940 | if (status32 & VIA_INTR_IN) | ||
1941 | via_intr_channel (card, &card->ch_in); | ||
1942 | if (status32 & VIA_INTR_FM) | ||
1943 | via_intr_channel (card, &card->ch_fm); | ||
1944 | |||
1945 | spin_unlock (&card->lock); | ||
1946 | |||
1947 | return IRQ_HANDLED; | ||
1948 | } | ||
1949 | |||
1950 | static irqreturn_t via_new_interrupt(int irq, void *dev_id, struct pt_regs *regs) | ||
1951 | { | ||
1952 | struct via_info *card = dev_id; | ||
1953 | u32 status32; | ||
1954 | |||
1955 | /* to minimize interrupt sharing costs, we use the SGD status | ||
1956 | * shadow register to check the status of all inputs and | ||
1957 | * outputs with a single 32-bit bus read. If no interrupt | ||
1958 | * conditions are flagged, we exit immediately | ||
1959 | */ | ||
1960 | status32 = inl (card->baseaddr + VIA_BASE0_SGD_STATUS_SHADOW); | ||
1961 | if (!(status32 & VIA_NEW_INTR_MASK)) | ||
1962 | return IRQ_NONE; | ||
1963 | /* | ||
1964 | * goes away completely on UP | ||
1965 | */ | ||
1966 | spin_lock (&card->lock); | ||
1967 | |||
1968 | via_intr_channel (card, &card->ch_out); | ||
1969 | via_intr_channel (card, &card->ch_in); | ||
1970 | via_intr_channel (card, &card->ch_fm); | ||
1971 | |||
1972 | spin_unlock (&card->lock); | ||
1973 | return IRQ_HANDLED; | ||
1974 | } | ||
1975 | |||
1976 | |||
1977 | /** | ||
1978 | * via_interrupt_init - Initialize interrupt handling | ||
1979 | * @card: Private info for specified board | ||
1980 | * | ||
1981 | * Obtain and reserve IRQ for using in handling audio events. | ||
1982 | * Also, disable any IRQ-generating resources, to make sure | ||
1983 | * we don't get interrupts before we want them. | ||
1984 | */ | ||
1985 | |||
1986 | static int via_interrupt_init (struct via_info *card) | ||
1987 | { | ||
1988 | u8 tmp8; | ||
1989 | |||
1990 | DPRINTK ("ENTER\n"); | ||
1991 | |||
1992 | assert (card != NULL); | ||
1993 | assert (card->pdev != NULL); | ||
1994 | |||
1995 | /* check for sane IRQ number. can this ever happen? */ | ||
1996 | if (card->pdev->irq < 2) { | ||
1997 | printk (KERN_ERR PFX "insane IRQ %d, aborting\n", | ||
1998 | card->pdev->irq); | ||
1999 | DPRINTK ("EXIT, returning -EIO\n"); | ||
2000 | return -EIO; | ||
2001 | } | ||
2002 | |||
2003 | /* VIA requires this is done */ | ||
2004 | pci_write_config_byte(card->pdev, PCI_INTERRUPT_LINE, card->pdev->irq); | ||
2005 | |||
2006 | if(card->legacy) | ||
2007 | { | ||
2008 | /* make sure FM irq is not routed to us */ | ||
2009 | pci_read_config_byte (card->pdev, VIA_FM_NMI_CTRL, &tmp8); | ||
2010 | if ((tmp8 & VIA_CR48_FM_TRAP_TO_NMI) == 0) { | ||
2011 | tmp8 |= VIA_CR48_FM_TRAP_TO_NMI; | ||
2012 | pci_write_config_byte (card->pdev, VIA_FM_NMI_CTRL, tmp8); | ||
2013 | } | ||
2014 | if (request_irq (card->pdev->irq, via_interrupt, SA_SHIRQ, VIA_MODULE_NAME, card)) { | ||
2015 | printk (KERN_ERR PFX "unable to obtain IRQ %d, aborting\n", | ||
2016 | card->pdev->irq); | ||
2017 | DPRINTK ("EXIT, returning -EBUSY\n"); | ||
2018 | return -EBUSY; | ||
2019 | } | ||
2020 | } | ||
2021 | else | ||
2022 | { | ||
2023 | if (request_irq (card->pdev->irq, via_new_interrupt, SA_SHIRQ, VIA_MODULE_NAME, card)) { | ||
2024 | printk (KERN_ERR PFX "unable to obtain IRQ %d, aborting\n", | ||
2025 | card->pdev->irq); | ||
2026 | DPRINTK ("EXIT, returning -EBUSY\n"); | ||
2027 | return -EBUSY; | ||
2028 | } | ||
2029 | } | ||
2030 | |||
2031 | DPRINTK ("EXIT, returning 0\n"); | ||
2032 | return 0; | ||
2033 | } | ||
2034 | |||
2035 | |||
2036 | /**************************************************************** | ||
2037 | * | ||
2038 | * OSS DSP device | ||
2039 | * | ||
2040 | */ | ||
2041 | |||
2042 | static struct file_operations via_dsp_fops = { | ||
2043 | .owner = THIS_MODULE, | ||
2044 | .open = via_dsp_open, | ||
2045 | .release = via_dsp_release, | ||
2046 | .read = via_dsp_read, | ||
2047 | .write = via_dsp_write, | ||
2048 | .poll = via_dsp_poll, | ||
2049 | .llseek = no_llseek, | ||
2050 | .ioctl = via_dsp_ioctl, | ||
2051 | .mmap = via_dsp_mmap, | ||
2052 | }; | ||
2053 | |||
2054 | |||
2055 | static int __devinit via_dsp_init (struct via_info *card) | ||
2056 | { | ||
2057 | u8 tmp8; | ||
2058 | |||
2059 | DPRINTK ("ENTER\n"); | ||
2060 | |||
2061 | assert (card != NULL); | ||
2062 | |||
2063 | if(card->legacy) | ||
2064 | { | ||
2065 | /* turn off legacy features, if not already */ | ||
2066 | pci_read_config_byte (card->pdev, VIA_FUNC_ENABLE, &tmp8); | ||
2067 | if (tmp8 & (VIA_CR42_SB_ENABLE | VIA_CR42_FM_ENABLE)) { | ||
2068 | tmp8 &= ~(VIA_CR42_SB_ENABLE | VIA_CR42_FM_ENABLE); | ||
2069 | pci_write_config_byte (card->pdev, VIA_FUNC_ENABLE, tmp8); | ||
2070 | } | ||
2071 | } | ||
2072 | |||
2073 | via_stop_everything (card); | ||
2074 | |||
2075 | card->dev_dsp = register_sound_dsp (&via_dsp_fops, -1); | ||
2076 | if (card->dev_dsp < 0) { | ||
2077 | DPRINTK ("EXIT, returning -ENODEV\n"); | ||
2078 | return -ENODEV; | ||
2079 | } | ||
2080 | DPRINTK ("EXIT, returning 0\n"); | ||
2081 | return 0; | ||
2082 | } | ||
2083 | |||
2084 | |||
2085 | static void via_dsp_cleanup (struct via_info *card) | ||
2086 | { | ||
2087 | DPRINTK ("ENTER\n"); | ||
2088 | |||
2089 | assert (card != NULL); | ||
2090 | assert (card->dev_dsp >= 0); | ||
2091 | |||
2092 | via_stop_everything (card); | ||
2093 | |||
2094 | unregister_sound_dsp (card->dev_dsp); | ||
2095 | |||
2096 | DPRINTK ("EXIT\n"); | ||
2097 | } | ||
2098 | |||
2099 | |||
2100 | static struct page * via_mm_nopage (struct vm_area_struct * vma, | ||
2101 | unsigned long address, int *type) | ||
2102 | { | ||
2103 | struct via_info *card = vma->vm_private_data; | ||
2104 | struct via_channel *chan = &card->ch_out; | ||
2105 | struct page *dmapage; | ||
2106 | unsigned long pgoff; | ||
2107 | int rd, wr; | ||
2108 | |||
2109 | DPRINTK ("ENTER, start %lXh, ofs %lXh, pgoff %ld, addr %lXh\n", | ||
2110 | vma->vm_start, | ||
2111 | address - vma->vm_start, | ||
2112 | (address - vma->vm_start) >> PAGE_SHIFT, | ||
2113 | address); | ||
2114 | |||
2115 | if (address > vma->vm_end) { | ||
2116 | DPRINTK ("EXIT, returning NOPAGE_SIGBUS\n"); | ||
2117 | return NOPAGE_SIGBUS; /* Disallow mremap */ | ||
2118 | } | ||
2119 | if (!card) { | ||
2120 | DPRINTK ("EXIT, returning NOPAGE_OOM\n"); | ||
2121 | return NOPAGE_OOM; /* Nothing allocated */ | ||
2122 | } | ||
2123 | |||
2124 | pgoff = vma->vm_pgoff + ((address - vma->vm_start) >> PAGE_SHIFT); | ||
2125 | rd = card->ch_in.is_mapped; | ||
2126 | wr = card->ch_out.is_mapped; | ||
2127 | |||
2128 | #ifndef VIA_NDEBUG | ||
2129 | { | ||
2130 | unsigned long max_bufs = chan->frag_number; | ||
2131 | if (rd && wr) max_bufs *= 2; | ||
2132 | /* via_dsp_mmap() should ensure this */ | ||
2133 | assert (pgoff < max_bufs); | ||
2134 | } | ||
2135 | #endif | ||
2136 | |||
2137 | /* if full-duplex (read+write) and we have two sets of bufs, | ||
2138 | * then the playback buffers come first, sez soundcard.c */ | ||
2139 | if (pgoff >= chan->page_number) { | ||
2140 | pgoff -= chan->page_number; | ||
2141 | chan = &card->ch_in; | ||
2142 | } else if (!wr) | ||
2143 | chan = &card->ch_in; | ||
2144 | |||
2145 | assert ((((unsigned long)chan->pgtbl[pgoff].cpuaddr) % PAGE_SIZE) == 0); | ||
2146 | |||
2147 | dmapage = virt_to_page (chan->pgtbl[pgoff].cpuaddr); | ||
2148 | DPRINTK ("EXIT, returning page %p for cpuaddr %lXh\n", | ||
2149 | dmapage, (unsigned long) chan->pgtbl[pgoff].cpuaddr); | ||
2150 | get_page (dmapage); | ||
2151 | if (type) | ||
2152 | *type = VM_FAULT_MINOR; | ||
2153 | return dmapage; | ||
2154 | } | ||
2155 | |||
2156 | |||
2157 | #ifndef VM_RESERVED | ||
2158 | static int via_mm_swapout (struct page *page, struct file *filp) | ||
2159 | { | ||
2160 | return 0; | ||
2161 | } | ||
2162 | #endif /* VM_RESERVED */ | ||
2163 | |||
2164 | |||
2165 | static struct vm_operations_struct via_mm_ops = { | ||
2166 | .nopage = via_mm_nopage, | ||
2167 | |||
2168 | #ifndef VM_RESERVED | ||
2169 | .swapout = via_mm_swapout, | ||
2170 | #endif | ||
2171 | }; | ||
2172 | |||
2173 | |||
2174 | static int via_dsp_mmap(struct file *file, struct vm_area_struct *vma) | ||
2175 | { | ||
2176 | struct via_info *card; | ||
2177 | int nonblock = (file->f_flags & O_NONBLOCK); | ||
2178 | int rc = -EINVAL, rd=0, wr=0; | ||
2179 | unsigned long max_size, size, start, offset; | ||
2180 | |||
2181 | assert (file != NULL); | ||
2182 | assert (vma != NULL); | ||
2183 | card = file->private_data; | ||
2184 | assert (card != NULL); | ||
2185 | |||
2186 | DPRINTK ("ENTER, start %lXh, size %ld, pgoff %ld\n", | ||
2187 | vma->vm_start, | ||
2188 | vma->vm_end - vma->vm_start, | ||
2189 | vma->vm_pgoff); | ||
2190 | |||
2191 | max_size = 0; | ||
2192 | if (vma->vm_flags & VM_READ) { | ||
2193 | rd = 1; | ||
2194 | via_chan_set_buffering(card, &card->ch_in, -1); | ||
2195 | via_chan_buffer_init (card, &card->ch_in); | ||
2196 | max_size += card->ch_in.page_number << PAGE_SHIFT; | ||
2197 | } | ||
2198 | if (vma->vm_flags & VM_WRITE) { | ||
2199 | wr = 1; | ||
2200 | via_chan_set_buffering(card, &card->ch_out, -1); | ||
2201 | via_chan_buffer_init (card, &card->ch_out); | ||
2202 | max_size += card->ch_out.page_number << PAGE_SHIFT; | ||
2203 | } | ||
2204 | |||
2205 | start = vma->vm_start; | ||
2206 | offset = (vma->vm_pgoff << PAGE_SHIFT); | ||
2207 | size = vma->vm_end - vma->vm_start; | ||
2208 | |||
2209 | /* some basic size/offset sanity checks */ | ||
2210 | if (size > max_size) | ||
2211 | goto out; | ||
2212 | if (offset > max_size - size) | ||
2213 | goto out; | ||
2214 | |||
2215 | rc = via_syscall_down (card, nonblock); | ||
2216 | if (rc) goto out; | ||
2217 | |||
2218 | vma->vm_ops = &via_mm_ops; | ||
2219 | vma->vm_private_data = card; | ||
2220 | |||
2221 | #ifdef VM_RESERVED | ||
2222 | vma->vm_flags |= VM_RESERVED; | ||
2223 | #endif | ||
2224 | |||
2225 | if (rd) | ||
2226 | card->ch_in.is_mapped = 1; | ||
2227 | if (wr) | ||
2228 | card->ch_out.is_mapped = 1; | ||
2229 | |||
2230 | up (&card->syscall_sem); | ||
2231 | rc = 0; | ||
2232 | |||
2233 | out: | ||
2234 | DPRINTK ("EXIT, returning %d\n", rc); | ||
2235 | return rc; | ||
2236 | } | ||
2237 | |||
2238 | |||
2239 | static ssize_t via_dsp_do_read (struct via_info *card, | ||
2240 | char __user *userbuf, size_t count, | ||
2241 | int nonblock) | ||
2242 | { | ||
2243 | DECLARE_WAITQUEUE(wait, current); | ||
2244 | const char __user *orig_userbuf = userbuf; | ||
2245 | struct via_channel *chan = &card->ch_in; | ||
2246 | size_t size; | ||
2247 | int n, tmp; | ||
2248 | ssize_t ret = 0; | ||
2249 | |||
2250 | /* if SGD has not yet been started, start it */ | ||
2251 | via_chan_maybe_start (chan); | ||
2252 | |||
2253 | handle_one_block: | ||
2254 | /* just to be a nice neighbor */ | ||
2255 | /* Thomas Sailer: | ||
2256 | * But also to ourselves, release semaphore if we do so */ | ||
2257 | if (need_resched()) { | ||
2258 | up(&card->syscall_sem); | ||
2259 | schedule (); | ||
2260 | ret = via_syscall_down (card, nonblock); | ||
2261 | if (ret) | ||
2262 | goto out; | ||
2263 | } | ||
2264 | |||
2265 | /* grab current channel software pointer. In the case of | ||
2266 | * recording, this is pointing to the next buffer that | ||
2267 | * will receive data from the audio hardware. | ||
2268 | */ | ||
2269 | n = chan->sw_ptr; | ||
2270 | |||
2271 | /* n_frags represents the number of fragments waiting | ||
2272 | * to be copied to userland. sleep until at least | ||
2273 | * one buffer has been read from the audio hardware. | ||
2274 | */ | ||
2275 | add_wait_queue(&chan->wait, &wait); | ||
2276 | for (;;) { | ||
2277 | __set_current_state(TASK_INTERRUPTIBLE); | ||
2278 | tmp = atomic_read (&chan->n_frags); | ||
2279 | assert (tmp >= 0); | ||
2280 | assert (tmp <= chan->frag_number); | ||
2281 | if (tmp) | ||
2282 | break; | ||
2283 | if (nonblock || !chan->is_active) { | ||
2284 | ret = -EAGAIN; | ||
2285 | break; | ||
2286 | } | ||
2287 | |||
2288 | up(&card->syscall_sem); | ||
2289 | |||
2290 | DPRINTK ("Sleeping on block %d\n", n); | ||
2291 | schedule(); | ||
2292 | |||
2293 | ret = via_syscall_down (card, nonblock); | ||
2294 | if (ret) | ||
2295 | break; | ||
2296 | |||
2297 | if (signal_pending (current)) { | ||
2298 | ret = -ERESTARTSYS; | ||
2299 | break; | ||
2300 | } | ||
2301 | } | ||
2302 | set_current_state(TASK_RUNNING); | ||
2303 | remove_wait_queue(&chan->wait, &wait); | ||
2304 | if (ret) | ||
2305 | goto out; | ||
2306 | |||
2307 | /* Now that we have a buffer we can read from, send | ||
2308 | * as much as sample data possible to userspace. | ||
2309 | */ | ||
2310 | while ((count > 0) && (chan->slop_len < chan->frag_size)) { | ||
2311 | size_t slop_left = chan->frag_size - chan->slop_len; | ||
2312 | void *base = chan->pgtbl[n / (PAGE_SIZE / chan->frag_size)].cpuaddr; | ||
2313 | unsigned ofs = (n % (PAGE_SIZE / chan->frag_size)) * chan->frag_size; | ||
2314 | |||
2315 | size = (count < slop_left) ? count : slop_left; | ||
2316 | if (copy_to_user (userbuf, | ||
2317 | base + ofs + chan->slop_len, | ||
2318 | size)) { | ||
2319 | ret = -EFAULT; | ||
2320 | goto out; | ||
2321 | } | ||
2322 | |||
2323 | count -= size; | ||
2324 | chan->slop_len += size; | ||
2325 | userbuf += size; | ||
2326 | } | ||
2327 | |||
2328 | /* If we didn't copy the buffer completely to userspace, | ||
2329 | * stop now. | ||
2330 | */ | ||
2331 | if (chan->slop_len < chan->frag_size) | ||
2332 | goto out; | ||
2333 | |||
2334 | /* | ||
2335 | * If we get to this point, we copied one buffer completely | ||
2336 | * to userspace, give the buffer back to the hardware. | ||
2337 | */ | ||
2338 | |||
2339 | /* advance channel software pointer to point to | ||
2340 | * the next buffer from which we will copy | ||
2341 | */ | ||
2342 | if (chan->sw_ptr == (chan->frag_number - 1)) | ||
2343 | chan->sw_ptr = 0; | ||
2344 | else | ||
2345 | chan->sw_ptr++; | ||
2346 | |||
2347 | /* mark one less buffer waiting to be processed */ | ||
2348 | assert (atomic_read (&chan->n_frags) > 0); | ||
2349 | atomic_dec (&chan->n_frags); | ||
2350 | |||
2351 | /* we are at a block boundary, there is no fragment data */ | ||
2352 | chan->slop_len = 0; | ||
2353 | |||
2354 | DPRINTK ("Flushed block %u, sw_ptr now %u, n_frags now %d\n", | ||
2355 | n, chan->sw_ptr, atomic_read (&chan->n_frags)); | ||
2356 | |||
2357 | DPRINTK ("regs==%02X %02X %02X %08X %08X %08X %08X\n", | ||
2358 | inb (card->baseaddr + 0x00), | ||
2359 | inb (card->baseaddr + 0x01), | ||
2360 | inb (card->baseaddr + 0x02), | ||
2361 | inl (card->baseaddr + 0x04), | ||
2362 | inl (card->baseaddr + 0x0C), | ||
2363 | inl (card->baseaddr + 0x80), | ||
2364 | inl (card->baseaddr + 0x84)); | ||
2365 | |||
2366 | if (count > 0) | ||
2367 | goto handle_one_block; | ||
2368 | |||
2369 | out: | ||
2370 | return (userbuf != orig_userbuf) ? (userbuf - orig_userbuf) : ret; | ||
2371 | } | ||
2372 | |||
2373 | |||
2374 | static ssize_t via_dsp_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos) | ||
2375 | { | ||
2376 | struct via_info *card; | ||
2377 | int nonblock = (file->f_flags & O_NONBLOCK); | ||
2378 | int rc; | ||
2379 | |||
2380 | DPRINTK ("ENTER, file=%p, buffer=%p, count=%u, ppos=%lu\n", | ||
2381 | file, buffer, count, ppos ? ((unsigned long)*ppos) : 0); | ||
2382 | |||
2383 | assert (file != NULL); | ||
2384 | card = file->private_data; | ||
2385 | assert (card != NULL); | ||
2386 | |||
2387 | rc = via_syscall_down (card, nonblock); | ||
2388 | if (rc) goto out; | ||
2389 | |||
2390 | if (card->ch_in.is_mapped) { | ||
2391 | rc = -ENXIO; | ||
2392 | goto out_up; | ||
2393 | } | ||
2394 | |||
2395 | via_chan_set_buffering(card, &card->ch_in, -1); | ||
2396 | rc = via_chan_buffer_init (card, &card->ch_in); | ||
2397 | |||
2398 | if (rc) | ||
2399 | goto out_up; | ||
2400 | |||
2401 | rc = via_dsp_do_read (card, buffer, count, nonblock); | ||
2402 | |||
2403 | out_up: | ||
2404 | up (&card->syscall_sem); | ||
2405 | out: | ||
2406 | DPRINTK ("EXIT, returning %ld\n",(long) rc); | ||
2407 | return rc; | ||
2408 | } | ||
2409 | |||
2410 | |||
2411 | static ssize_t via_dsp_do_write (struct via_info *card, | ||
2412 | const char __user *userbuf, size_t count, | ||
2413 | int nonblock) | ||
2414 | { | ||
2415 | DECLARE_WAITQUEUE(wait, current); | ||
2416 | const char __user *orig_userbuf = userbuf; | ||
2417 | struct via_channel *chan = &card->ch_out; | ||
2418 | volatile struct via_sgd_table *sgtable = chan->sgtable; | ||
2419 | size_t size; | ||
2420 | int n, tmp; | ||
2421 | ssize_t ret = 0; | ||
2422 | |||
2423 | handle_one_block: | ||
2424 | /* just to be a nice neighbor */ | ||
2425 | /* Thomas Sailer: | ||
2426 | * But also to ourselves, release semaphore if we do so */ | ||
2427 | if (need_resched()) { | ||
2428 | up(&card->syscall_sem); | ||
2429 | schedule (); | ||
2430 | ret = via_syscall_down (card, nonblock); | ||
2431 | if (ret) | ||
2432 | goto out; | ||
2433 | } | ||
2434 | |||
2435 | /* grab current channel fragment pointer. In the case of | ||
2436 | * playback, this is pointing to the next fragment that | ||
2437 | * should receive data from userland. | ||
2438 | */ | ||
2439 | n = chan->sw_ptr; | ||
2440 | |||
2441 | /* n_frags represents the number of fragments remaining | ||
2442 | * to be filled by userspace. Sleep until | ||
2443 | * at least one fragment is available for our use. | ||
2444 | */ | ||
2445 | add_wait_queue(&chan->wait, &wait); | ||
2446 | for (;;) { | ||
2447 | __set_current_state(TASK_INTERRUPTIBLE); | ||
2448 | tmp = atomic_read (&chan->n_frags); | ||
2449 | assert (tmp >= 0); | ||
2450 | assert (tmp <= chan->frag_number); | ||
2451 | if (tmp) | ||
2452 | break; | ||
2453 | if (nonblock || !chan->is_active) { | ||
2454 | ret = -EAGAIN; | ||
2455 | break; | ||
2456 | } | ||
2457 | |||
2458 | up(&card->syscall_sem); | ||
2459 | |||
2460 | DPRINTK ("Sleeping on page %d, tmp==%d, ir==%d\n", n, tmp, chan->is_record); | ||
2461 | schedule(); | ||
2462 | |||
2463 | ret = via_syscall_down (card, nonblock); | ||
2464 | if (ret) | ||
2465 | break; | ||
2466 | |||
2467 | if (signal_pending (current)) { | ||
2468 | ret = -ERESTARTSYS; | ||
2469 | break; | ||
2470 | } | ||
2471 | } | ||
2472 | set_current_state(TASK_RUNNING); | ||
2473 | remove_wait_queue(&chan->wait, &wait); | ||
2474 | if (ret) | ||
2475 | goto out; | ||
2476 | |||
2477 | /* Now that we have at least one fragment we can write to, fill the buffer | ||
2478 | * as much as possible with data from userspace. | ||
2479 | */ | ||
2480 | while ((count > 0) && (chan->slop_len < chan->frag_size)) { | ||
2481 | size_t slop_left = chan->frag_size - chan->slop_len; | ||
2482 | |||
2483 | size = (count < slop_left) ? count : slop_left; | ||
2484 | if (copy_from_user (chan->pgtbl[n / (PAGE_SIZE / chan->frag_size)].cpuaddr + (n % (PAGE_SIZE / chan->frag_size)) * chan->frag_size + chan->slop_len, | ||
2485 | userbuf, size)) { | ||
2486 | ret = -EFAULT; | ||
2487 | goto out; | ||
2488 | } | ||
2489 | |||
2490 | count -= size; | ||
2491 | chan->slop_len += size; | ||
2492 | userbuf += size; | ||
2493 | } | ||
2494 | |||
2495 | /* If we didn't fill up the buffer with data, stop now. | ||
2496 | * Put a 'stop' marker in the DMA table too, to tell the | ||
2497 | * audio hardware to stop if it gets here. | ||
2498 | */ | ||
2499 | if (chan->slop_len < chan->frag_size) { | ||
2500 | sgtable[n].count = cpu_to_le32 (chan->slop_len | VIA_EOL | VIA_STOP); | ||
2501 | goto out; | ||
2502 | } | ||
2503 | |||
2504 | /* | ||
2505 | * If we get to this point, we have filled a buffer with | ||
2506 | * audio data, flush the buffer to audio hardware. | ||
2507 | */ | ||
2508 | |||
2509 | /* Record the true size for the audio hardware to notice */ | ||
2510 | if (n == (chan->frag_number - 1)) | ||
2511 | sgtable[n].count = cpu_to_le32 (chan->frag_size | VIA_EOL); | ||
2512 | else | ||
2513 | sgtable[n].count = cpu_to_le32 (chan->frag_size | VIA_FLAG); | ||
2514 | |||
2515 | /* advance channel software pointer to point to | ||
2516 | * the next buffer we will fill with data | ||
2517 | */ | ||
2518 | if (chan->sw_ptr == (chan->frag_number - 1)) | ||
2519 | chan->sw_ptr = 0; | ||
2520 | else | ||
2521 | chan->sw_ptr++; | ||
2522 | |||
2523 | /* mark one less buffer as being available for userspace consumption */ | ||
2524 | assert (atomic_read (&chan->n_frags) > 0); | ||
2525 | atomic_dec (&chan->n_frags); | ||
2526 | |||
2527 | /* we are at a block boundary, there is no fragment data */ | ||
2528 | chan->slop_len = 0; | ||
2529 | |||
2530 | /* if SGD has not yet been started, start it */ | ||
2531 | via_chan_maybe_start (chan); | ||
2532 | |||
2533 | DPRINTK ("Flushed block %u, sw_ptr now %u, n_frags now %d\n", | ||
2534 | n, chan->sw_ptr, atomic_read (&chan->n_frags)); | ||
2535 | |||
2536 | DPRINTK ("regs==S=%02X C=%02X TP=%02X BP=%08X RT=%08X SG=%08X CC=%08X SS=%08X\n", | ||
2537 | inb (card->baseaddr + 0x00), | ||
2538 | inb (card->baseaddr + 0x01), | ||
2539 | inb (card->baseaddr + 0x02), | ||
2540 | inl (card->baseaddr + 0x04), | ||
2541 | inl (card->baseaddr + 0x08), | ||
2542 | inl (card->baseaddr + 0x0C), | ||
2543 | inl (card->baseaddr + 0x80), | ||
2544 | inl (card->baseaddr + 0x84)); | ||
2545 | |||
2546 | if (count > 0) | ||
2547 | goto handle_one_block; | ||
2548 | |||
2549 | out: | ||
2550 | if (userbuf - orig_userbuf) | ||
2551 | return userbuf - orig_userbuf; | ||
2552 | else | ||
2553 | return ret; | ||
2554 | } | ||
2555 | |||
2556 | |||
2557 | static ssize_t via_dsp_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos) | ||
2558 | { | ||
2559 | struct via_info *card; | ||
2560 | ssize_t rc; | ||
2561 | int nonblock = (file->f_flags & O_NONBLOCK); | ||
2562 | |||
2563 | DPRINTK ("ENTER, file=%p, buffer=%p, count=%u, ppos=%lu\n", | ||
2564 | file, buffer, count, ppos ? ((unsigned long)*ppos) : 0); | ||
2565 | |||
2566 | assert (file != NULL); | ||
2567 | card = file->private_data; | ||
2568 | assert (card != NULL); | ||
2569 | |||
2570 | rc = via_syscall_down (card, nonblock); | ||
2571 | if (rc) goto out; | ||
2572 | |||
2573 | if (card->ch_out.is_mapped) { | ||
2574 | rc = -ENXIO; | ||
2575 | goto out_up; | ||
2576 | } | ||
2577 | |||
2578 | via_chan_set_buffering(card, &card->ch_out, -1); | ||
2579 | rc = via_chan_buffer_init (card, &card->ch_out); | ||
2580 | |||
2581 | if (rc) | ||
2582 | goto out_up; | ||
2583 | |||
2584 | rc = via_dsp_do_write (card, buffer, count, nonblock); | ||
2585 | |||
2586 | out_up: | ||
2587 | up (&card->syscall_sem); | ||
2588 | out: | ||
2589 | DPRINTK ("EXIT, returning %ld\n",(long) rc); | ||
2590 | return rc; | ||
2591 | } | ||
2592 | |||
2593 | |||
2594 | static unsigned int via_dsp_poll(struct file *file, struct poll_table_struct *wait) | ||
2595 | { | ||
2596 | struct via_info *card; | ||
2597 | struct via_channel *chan; | ||
2598 | unsigned int mask = 0; | ||
2599 | |||
2600 | DPRINTK ("ENTER\n"); | ||
2601 | |||
2602 | assert (file != NULL); | ||
2603 | card = file->private_data; | ||
2604 | assert (card != NULL); | ||
2605 | |||
2606 | if (file->f_mode & FMODE_READ) { | ||
2607 | chan = &card->ch_in; | ||
2608 | if (sg_active (chan->iobase)) | ||
2609 | poll_wait(file, &chan->wait, wait); | ||
2610 | if (atomic_read (&chan->n_frags) > 0) | ||
2611 | mask |= POLLIN | POLLRDNORM; | ||
2612 | } | ||
2613 | |||
2614 | if (file->f_mode & FMODE_WRITE) { | ||
2615 | chan = &card->ch_out; | ||
2616 | if (sg_active (chan->iobase)) | ||
2617 | poll_wait(file, &chan->wait, wait); | ||
2618 | if (atomic_read (&chan->n_frags) > 0) | ||
2619 | mask |= POLLOUT | POLLWRNORM; | ||
2620 | } | ||
2621 | |||
2622 | DPRINTK ("EXIT, returning %u\n", mask); | ||
2623 | return mask; | ||
2624 | } | ||
2625 | |||
2626 | |||
2627 | /** | ||
2628 | * via_dsp_drain_playback - sleep until all playback samples are flushed | ||
2629 | * @card: Private info for specified board | ||
2630 | * @chan: Channel to drain | ||
2631 | * @nonblock: boolean, non-zero if O_NONBLOCK is set | ||
2632 | * | ||
2633 | * Sleeps until all playback has been flushed to the audio | ||
2634 | * hardware. | ||
2635 | * | ||
2636 | * Locking: inside card->syscall_sem | ||
2637 | */ | ||
2638 | |||
2639 | static int via_dsp_drain_playback (struct via_info *card, | ||
2640 | struct via_channel *chan, int nonblock) | ||
2641 | { | ||
2642 | DECLARE_WAITQUEUE(wait, current); | ||
2643 | int ret = 0; | ||
2644 | |||
2645 | DPRINTK ("ENTER, nonblock = %d\n", nonblock); | ||
2646 | |||
2647 | if (chan->slop_len > 0) | ||
2648 | via_chan_flush_frag (chan); | ||
2649 | |||
2650 | if (atomic_read (&chan->n_frags) == chan->frag_number) | ||
2651 | goto out; | ||
2652 | |||
2653 | via_chan_maybe_start (chan); | ||
2654 | |||
2655 | add_wait_queue(&chan->wait, &wait); | ||
2656 | for (;;) { | ||
2657 | DPRINTK ("FRAGS %d FRAGNUM %d\n", atomic_read(&chan->n_frags), chan->frag_number); | ||
2658 | __set_current_state(TASK_INTERRUPTIBLE); | ||
2659 | if (atomic_read (&chan->n_frags) >= chan->frag_number) | ||
2660 | break; | ||
2661 | |||
2662 | if (nonblock) { | ||
2663 | DPRINTK ("EXIT, returning -EAGAIN\n"); | ||
2664 | ret = -EAGAIN; | ||
2665 | break; | ||
2666 | } | ||
2667 | |||
2668 | #ifdef VIA_DEBUG | ||
2669 | { | ||
2670 | u8 r40,r41,r42,r43,r44,r48; | ||
2671 | pci_read_config_byte (card->pdev, 0x40, &r40); | ||
2672 | pci_read_config_byte (card->pdev, 0x41, &r41); | ||
2673 | pci_read_config_byte (card->pdev, 0x42, &r42); | ||
2674 | pci_read_config_byte (card->pdev, 0x43, &r43); | ||
2675 | pci_read_config_byte (card->pdev, 0x44, &r44); | ||
2676 | pci_read_config_byte (card->pdev, 0x48, &r48); | ||
2677 | DPRINTK ("PCI config: %02X %02X %02X %02X %02X %02X\n", | ||
2678 | r40,r41,r42,r43,r44,r48); | ||
2679 | |||
2680 | DPRINTK ("regs==%02X %02X %02X %08X %08X %08X %08X\n", | ||
2681 | inb (card->baseaddr + 0x00), | ||
2682 | inb (card->baseaddr + 0x01), | ||
2683 | inb (card->baseaddr + 0x02), | ||
2684 | inl (card->baseaddr + 0x04), | ||
2685 | inl (card->baseaddr + 0x0C), | ||
2686 | inl (card->baseaddr + 0x80), | ||
2687 | inl (card->baseaddr + 0x84)); | ||
2688 | } | ||
2689 | |||
2690 | if (!chan->is_active) | ||
2691 | printk (KERN_ERR "sleeping but not active\n"); | ||
2692 | #endif | ||
2693 | |||
2694 | up(&card->syscall_sem); | ||
2695 | |||
2696 | DPRINTK ("sleeping, nbufs=%d\n", atomic_read (&chan->n_frags)); | ||
2697 | schedule(); | ||
2698 | |||
2699 | if ((ret = via_syscall_down (card, nonblock))) | ||
2700 | break; | ||
2701 | |||
2702 | if (signal_pending (current)) { | ||
2703 | DPRINTK ("EXIT, returning -ERESTARTSYS\n"); | ||
2704 | ret = -ERESTARTSYS; | ||
2705 | break; | ||
2706 | } | ||
2707 | } | ||
2708 | set_current_state(TASK_RUNNING); | ||
2709 | remove_wait_queue(&chan->wait, &wait); | ||
2710 | |||
2711 | #ifdef VIA_DEBUG | ||
2712 | { | ||
2713 | u8 r40,r41,r42,r43,r44,r48; | ||
2714 | pci_read_config_byte (card->pdev, 0x40, &r40); | ||
2715 | pci_read_config_byte (card->pdev, 0x41, &r41); | ||
2716 | pci_read_config_byte (card->pdev, 0x42, &r42); | ||
2717 | pci_read_config_byte (card->pdev, 0x43, &r43); | ||
2718 | pci_read_config_byte (card->pdev, 0x44, &r44); | ||
2719 | pci_read_config_byte (card->pdev, 0x48, &r48); | ||
2720 | DPRINTK ("PCI config: %02X %02X %02X %02X %02X %02X\n", | ||
2721 | r40,r41,r42,r43,r44,r48); | ||
2722 | |||
2723 | DPRINTK ("regs==%02X %02X %02X %08X %08X %08X %08X\n", | ||
2724 | inb (card->baseaddr + 0x00), | ||
2725 | inb (card->baseaddr + 0x01), | ||
2726 | inb (card->baseaddr + 0x02), | ||
2727 | inl (card->baseaddr + 0x04), | ||
2728 | inl (card->baseaddr + 0x0C), | ||
2729 | inl (card->baseaddr + 0x80), | ||
2730 | inl (card->baseaddr + 0x84)); | ||
2731 | |||
2732 | DPRINTK ("final nbufs=%d\n", atomic_read (&chan->n_frags)); | ||
2733 | } | ||
2734 | #endif | ||
2735 | |||
2736 | out: | ||
2737 | DPRINTK ("EXIT, returning %d\n", ret); | ||
2738 | return ret; | ||
2739 | } | ||
2740 | |||
2741 | |||
2742 | /** | ||
2743 | * via_dsp_ioctl_space - get information about channel buffering | ||
2744 | * @card: Private info for specified board | ||
2745 | * @chan: pointer to channel-specific info | ||
2746 | * @arg: user buffer for returned information | ||
2747 | * | ||
2748 | * Handles SNDCTL_DSP_GETISPACE and SNDCTL_DSP_GETOSPACE. | ||
2749 | * | ||
2750 | * Locking: inside card->syscall_sem | ||
2751 | */ | ||
2752 | |||
2753 | static int via_dsp_ioctl_space (struct via_info *card, | ||
2754 | struct via_channel *chan, | ||
2755 | void __user *arg) | ||
2756 | { | ||
2757 | audio_buf_info info; | ||
2758 | |||
2759 | via_chan_set_buffering(card, chan, -1); | ||
2760 | |||
2761 | info.fragstotal = chan->frag_number; | ||
2762 | info.fragsize = chan->frag_size; | ||
2763 | |||
2764 | /* number of full fragments we can read/write without blocking */ | ||
2765 | info.fragments = atomic_read (&chan->n_frags); | ||
2766 | |||
2767 | if ((chan->slop_len % chan->frag_size > 0) && (info.fragments > 0)) | ||
2768 | info.fragments--; | ||
2769 | |||
2770 | /* number of bytes that can be read or written immediately | ||
2771 | * without blocking. | ||
2772 | */ | ||
2773 | info.bytes = (info.fragments * chan->frag_size); | ||
2774 | if (chan->slop_len % chan->frag_size > 0) | ||
2775 | info.bytes += chan->frag_size - (chan->slop_len % chan->frag_size); | ||
2776 | |||
2777 | DPRINTK ("EXIT, returning fragstotal=%d, fragsize=%d, fragments=%d, bytes=%d\n", | ||
2778 | info.fragstotal, | ||
2779 | info.fragsize, | ||
2780 | info.fragments, | ||
2781 | info.bytes); | ||
2782 | |||
2783 | return copy_to_user (arg, &info, sizeof (info))?-EFAULT:0; | ||
2784 | } | ||
2785 | |||
2786 | |||
2787 | /** | ||
2788 | * via_dsp_ioctl_ptr - get information about hardware buffer ptr | ||
2789 | * @card: Private info for specified board | ||
2790 | * @chan: pointer to channel-specific info | ||
2791 | * @arg: user buffer for returned information | ||
2792 | * | ||
2793 | * Handles SNDCTL_DSP_GETIPTR and SNDCTL_DSP_GETOPTR. | ||
2794 | * | ||
2795 | * Locking: inside card->syscall_sem | ||
2796 | */ | ||
2797 | |||
2798 | static int via_dsp_ioctl_ptr (struct via_info *card, | ||
2799 | struct via_channel *chan, | ||
2800 | void __user *arg) | ||
2801 | { | ||
2802 | count_info info; | ||
2803 | |||
2804 | spin_lock_irq (&card->lock); | ||
2805 | |||
2806 | info.bytes = chan->bytes; | ||
2807 | info.blocks = chan->n_irqs; | ||
2808 | chan->n_irqs = 0; | ||
2809 | |||
2810 | spin_unlock_irq (&card->lock); | ||
2811 | |||
2812 | if (chan->is_active) { | ||
2813 | unsigned long extra; | ||
2814 | info.ptr = atomic_read (&chan->hw_ptr) * chan->frag_size; | ||
2815 | extra = chan->frag_size - via_sg_offset(chan); | ||
2816 | info.ptr += extra; | ||
2817 | info.bytes += extra; | ||
2818 | } else { | ||
2819 | info.ptr = 0; | ||
2820 | } | ||
2821 | |||
2822 | DPRINTK ("EXIT, returning bytes=%d, blocks=%d, ptr=%d\n", | ||
2823 | info.bytes, | ||
2824 | info.blocks, | ||
2825 | info.ptr); | ||
2826 | |||
2827 | return copy_to_user (arg, &info, sizeof (info))?-EFAULT:0; | ||
2828 | } | ||
2829 | |||
2830 | |||
2831 | static int via_dsp_ioctl_trigger (struct via_channel *chan, int val) | ||
2832 | { | ||
2833 | int enable, do_something; | ||
2834 | |||
2835 | if (chan->is_record) | ||
2836 | enable = (val & PCM_ENABLE_INPUT); | ||
2837 | else | ||
2838 | enable = (val & PCM_ENABLE_OUTPUT); | ||
2839 | |||
2840 | if (!chan->is_enabled && enable) { | ||
2841 | do_something = 1; | ||
2842 | } else if (chan->is_enabled && !enable) { | ||
2843 | do_something = -1; | ||
2844 | } else { | ||
2845 | do_something = 0; | ||
2846 | } | ||
2847 | |||
2848 | DPRINTK ("enable=%d, do_something=%d\n", | ||
2849 | enable, do_something); | ||
2850 | |||
2851 | if (chan->is_active && do_something) | ||
2852 | return -EINVAL; | ||
2853 | |||
2854 | if (do_something == 1) { | ||
2855 | chan->is_enabled = 1; | ||
2856 | via_chan_maybe_start (chan); | ||
2857 | DPRINTK ("Triggering input\n"); | ||
2858 | } | ||
2859 | |||
2860 | else if (do_something == -1) { | ||
2861 | chan->is_enabled = 0; | ||
2862 | DPRINTK ("Setup input trigger\n"); | ||
2863 | } | ||
2864 | |||
2865 | return 0; | ||
2866 | } | ||
2867 | |||
2868 | |||
2869 | static int via_dsp_ioctl (struct inode *inode, struct file *file, | ||
2870 | unsigned int cmd, unsigned long arg) | ||
2871 | { | ||
2872 | int rc, rd=0, wr=0, val=0; | ||
2873 | struct via_info *card; | ||
2874 | struct via_channel *chan; | ||
2875 | int nonblock = (file->f_flags & O_NONBLOCK); | ||
2876 | int __user *ip = (int __user *)arg; | ||
2877 | void __user *p = (void __user *)arg; | ||
2878 | |||
2879 | assert (file != NULL); | ||
2880 | card = file->private_data; | ||
2881 | assert (card != NULL); | ||
2882 | |||
2883 | if (file->f_mode & FMODE_WRITE) | ||
2884 | wr = 1; | ||
2885 | if (file->f_mode & FMODE_READ) | ||
2886 | rd = 1; | ||
2887 | |||
2888 | rc = via_syscall_down (card, nonblock); | ||
2889 | if (rc) | ||
2890 | return rc; | ||
2891 | rc = -EINVAL; | ||
2892 | |||
2893 | switch (cmd) { | ||
2894 | |||
2895 | /* OSS API version. XXX unverified */ | ||
2896 | case OSS_GETVERSION: | ||
2897 | DPRINTK ("ioctl OSS_GETVERSION, EXIT, returning SOUND_VERSION\n"); | ||
2898 | rc = put_user (SOUND_VERSION, ip); | ||
2899 | break; | ||
2900 | |||
2901 | /* list of supported PCM data formats */ | ||
2902 | case SNDCTL_DSP_GETFMTS: | ||
2903 | DPRINTK ("DSP_GETFMTS, EXIT, returning AFMT U8|S16_LE\n"); | ||
2904 | rc = put_user (AFMT_U8 | AFMT_S16_LE, ip); | ||
2905 | break; | ||
2906 | |||
2907 | /* query or set current channel's PCM data format */ | ||
2908 | case SNDCTL_DSP_SETFMT: | ||
2909 | if (get_user(val, ip)) { | ||
2910 | rc = -EFAULT; | ||
2911 | break; | ||
2912 | } | ||
2913 | DPRINTK ("DSP_SETFMT, val==%d\n", val); | ||
2914 | if (val != AFMT_QUERY) { | ||
2915 | rc = 0; | ||
2916 | |||
2917 | if (rd) | ||
2918 | rc = via_chan_set_fmt (card, &card->ch_in, val); | ||
2919 | |||
2920 | if (rc >= 0 && wr) | ||
2921 | rc = via_chan_set_fmt (card, &card->ch_out, val); | ||
2922 | |||
2923 | if (rc < 0) | ||
2924 | break; | ||
2925 | |||
2926 | val = rc; | ||
2927 | } else { | ||
2928 | if ((rd && (card->ch_in.pcm_fmt & VIA_PCM_FMT_16BIT)) || | ||
2929 | (wr && (card->ch_out.pcm_fmt & VIA_PCM_FMT_16BIT))) | ||
2930 | val = AFMT_S16_LE; | ||
2931 | else | ||
2932 | val = AFMT_U8; | ||
2933 | } | ||
2934 | DPRINTK ("SETFMT EXIT, returning %d\n", val); | ||
2935 | rc = put_user (val, ip); | ||
2936 | break; | ||
2937 | |||
2938 | /* query or set number of channels (1=mono, 2=stereo, 4/6 for multichannel) */ | ||
2939 | case SNDCTL_DSP_CHANNELS: | ||
2940 | if (get_user(val, ip)) { | ||
2941 | rc = -EFAULT; | ||
2942 | break; | ||
2943 | } | ||
2944 | DPRINTK ("DSP_CHANNELS, val==%d\n", val); | ||
2945 | if (val != 0) { | ||
2946 | rc = 0; | ||
2947 | |||
2948 | if (rd) | ||
2949 | rc = via_chan_set_stereo (card, &card->ch_in, val); | ||
2950 | |||
2951 | if (rc >= 0 && wr) | ||
2952 | rc = via_chan_set_stereo (card, &card->ch_out, val); | ||
2953 | |||
2954 | if (rc < 0) | ||
2955 | break; | ||
2956 | |||
2957 | val = rc; | ||
2958 | } else { | ||
2959 | if (rd) | ||
2960 | val = card->ch_in.channels; | ||
2961 | else | ||
2962 | val = card->ch_out.channels; | ||
2963 | } | ||
2964 | DPRINTK ("CHANNELS EXIT, returning %d\n", val); | ||
2965 | rc = put_user (val, ip); | ||
2966 | break; | ||
2967 | |||
2968 | /* enable (val is not zero) or disable (val == 0) stereo */ | ||
2969 | case SNDCTL_DSP_STEREO: | ||
2970 | if (get_user(val, ip)) { | ||
2971 | rc = -EFAULT; | ||
2972 | break; | ||
2973 | } | ||
2974 | DPRINTK ("DSP_STEREO, val==%d\n", val); | ||
2975 | rc = 0; | ||
2976 | |||
2977 | if (rd) | ||
2978 | rc = via_chan_set_stereo (card, &card->ch_in, val ? 2 : 1); | ||
2979 | if (rc >= 0 && wr) | ||
2980 | rc = via_chan_set_stereo (card, &card->ch_out, val ? 2 : 1); | ||
2981 | |||
2982 | if (rc < 0) | ||
2983 | break; | ||
2984 | |||
2985 | val = rc - 1; | ||
2986 | |||
2987 | DPRINTK ("STEREO EXIT, returning %d\n", val); | ||
2988 | rc = put_user(val, ip); | ||
2989 | break; | ||
2990 | |||
2991 | /* query or set sampling rate */ | ||
2992 | case SNDCTL_DSP_SPEED: | ||
2993 | if (get_user(val, ip)) { | ||
2994 | rc = -EFAULT; | ||
2995 | break; | ||
2996 | } | ||
2997 | DPRINTK ("DSP_SPEED, val==%d\n", val); | ||
2998 | if (val < 0) { | ||
2999 | rc = -EINVAL; | ||
3000 | break; | ||
3001 | } | ||
3002 | if (val > 0) { | ||
3003 | rc = 0; | ||
3004 | |||
3005 | if (rd) | ||
3006 | rc = via_chan_set_speed (card, &card->ch_in, val); | ||
3007 | if (rc >= 0 && wr) | ||
3008 | rc = via_chan_set_speed (card, &card->ch_out, val); | ||
3009 | |||
3010 | if (rc < 0) | ||
3011 | break; | ||
3012 | |||
3013 | val = rc; | ||
3014 | } else { | ||
3015 | if (rd) | ||
3016 | val = card->ch_in.rate; | ||
3017 | else if (wr) | ||
3018 | val = card->ch_out.rate; | ||
3019 | else | ||
3020 | val = 0; | ||
3021 | } | ||
3022 | DPRINTK ("SPEED EXIT, returning %d\n", val); | ||
3023 | rc = put_user (val, ip); | ||
3024 | break; | ||
3025 | |||
3026 | /* wait until all buffers have been played, and then stop device */ | ||
3027 | case SNDCTL_DSP_SYNC: | ||
3028 | DPRINTK ("DSP_SYNC\n"); | ||
3029 | rc = 0; | ||
3030 | if (wr) { | ||
3031 | DPRINTK ("SYNC EXIT (after calling via_dsp_drain_playback)\n"); | ||
3032 | rc = via_dsp_drain_playback (card, &card->ch_out, nonblock); | ||
3033 | } | ||
3034 | break; | ||
3035 | |||
3036 | /* stop recording/playback immediately */ | ||
3037 | case SNDCTL_DSP_RESET: | ||
3038 | DPRINTK ("DSP_RESET\n"); | ||
3039 | if (rd) { | ||
3040 | via_chan_clear (card, &card->ch_in); | ||
3041 | card->ch_in.frag_number = 0; | ||
3042 | card->ch_in.frag_size = 0; | ||
3043 | atomic_set(&card->ch_in.n_frags, 0); | ||
3044 | } | ||
3045 | |||
3046 | if (wr) { | ||
3047 | via_chan_clear (card, &card->ch_out); | ||
3048 | card->ch_out.frag_number = 0; | ||
3049 | card->ch_out.frag_size = 0; | ||
3050 | atomic_set(&card->ch_out.n_frags, 0); | ||
3051 | } | ||
3052 | |||
3053 | rc = 0; | ||
3054 | break; | ||
3055 | |||
3056 | case SNDCTL_DSP_NONBLOCK: | ||
3057 | file->f_flags |= O_NONBLOCK; | ||
3058 | rc = 0; | ||
3059 | break; | ||
3060 | |||
3061 | /* obtain bitmask of device capabilities, such as mmap, full duplex, etc. */ | ||
3062 | case SNDCTL_DSP_GETCAPS: | ||
3063 | DPRINTK ("DSP_GETCAPS\n"); | ||
3064 | rc = put_user(VIA_DSP_CAP, ip); | ||
3065 | break; | ||
3066 | |||
3067 | /* obtain buffer fragment size */ | ||
3068 | case SNDCTL_DSP_GETBLKSIZE: | ||
3069 | DPRINTK ("DSP_GETBLKSIZE\n"); | ||
3070 | |||
3071 | if (rd) { | ||
3072 | via_chan_set_buffering(card, &card->ch_in, -1); | ||
3073 | rc = put_user(card->ch_in.frag_size, ip); | ||
3074 | } else if (wr) { | ||
3075 | via_chan_set_buffering(card, &card->ch_out, -1); | ||
3076 | rc = put_user(card->ch_out.frag_size, ip); | ||
3077 | } | ||
3078 | break; | ||
3079 | |||
3080 | /* obtain information about input buffering */ | ||
3081 | case SNDCTL_DSP_GETISPACE: | ||
3082 | DPRINTK ("DSP_GETISPACE\n"); | ||
3083 | if (rd) | ||
3084 | rc = via_dsp_ioctl_space (card, &card->ch_in, p); | ||
3085 | break; | ||
3086 | |||
3087 | /* obtain information about output buffering */ | ||
3088 | case SNDCTL_DSP_GETOSPACE: | ||
3089 | DPRINTK ("DSP_GETOSPACE\n"); | ||
3090 | if (wr) | ||
3091 | rc = via_dsp_ioctl_space (card, &card->ch_out, p); | ||
3092 | break; | ||
3093 | |||
3094 | /* obtain information about input hardware pointer */ | ||
3095 | case SNDCTL_DSP_GETIPTR: | ||
3096 | DPRINTK ("DSP_GETIPTR\n"); | ||
3097 | if (rd) | ||
3098 | rc = via_dsp_ioctl_ptr (card, &card->ch_in, p); | ||
3099 | break; | ||
3100 | |||
3101 | /* obtain information about output hardware pointer */ | ||
3102 | case SNDCTL_DSP_GETOPTR: | ||
3103 | DPRINTK ("DSP_GETOPTR\n"); | ||
3104 | if (wr) | ||
3105 | rc = via_dsp_ioctl_ptr (card, &card->ch_out, p); | ||
3106 | break; | ||
3107 | |||
3108 | /* return number of bytes remaining to be played by DMA engine */ | ||
3109 | case SNDCTL_DSP_GETODELAY: | ||
3110 | { | ||
3111 | DPRINTK ("DSP_GETODELAY\n"); | ||
3112 | |||
3113 | chan = &card->ch_out; | ||
3114 | |||
3115 | if (!wr) | ||
3116 | break; | ||
3117 | |||
3118 | if (chan->is_active) { | ||
3119 | |||
3120 | val = chan->frag_number - atomic_read (&chan->n_frags); | ||
3121 | |||
3122 | assert(val >= 0); | ||
3123 | |||
3124 | if (val > 0) { | ||
3125 | val *= chan->frag_size; | ||
3126 | val -= chan->frag_size - via_sg_offset(chan); | ||
3127 | } | ||
3128 | val += chan->slop_len % chan->frag_size; | ||
3129 | } else | ||
3130 | val = 0; | ||
3131 | |||
3132 | assert (val <= (chan->frag_size * chan->frag_number)); | ||
3133 | |||
3134 | DPRINTK ("GETODELAY EXIT, val = %d bytes\n", val); | ||
3135 | rc = put_user (val, ip); | ||
3136 | break; | ||
3137 | } | ||
3138 | |||
3139 | /* handle the quick-start of a channel, | ||
3140 | * or the notification that a quick-start will | ||
3141 | * occur in the future | ||
3142 | */ | ||
3143 | case SNDCTL_DSP_SETTRIGGER: | ||
3144 | if (get_user(val, ip)) { | ||
3145 | rc = -EFAULT; | ||
3146 | break; | ||
3147 | } | ||
3148 | DPRINTK ("DSP_SETTRIGGER, rd=%d, wr=%d, act=%d/%d, en=%d/%d\n", | ||
3149 | rd, wr, card->ch_in.is_active, card->ch_out.is_active, | ||
3150 | card->ch_in.is_enabled, card->ch_out.is_enabled); | ||
3151 | |||
3152 | rc = 0; | ||
3153 | |||
3154 | if (rd) | ||
3155 | rc = via_dsp_ioctl_trigger (&card->ch_in, val); | ||
3156 | |||
3157 | if (!rc && wr) | ||
3158 | rc = via_dsp_ioctl_trigger (&card->ch_out, val); | ||
3159 | |||
3160 | break; | ||
3161 | |||
3162 | case SNDCTL_DSP_GETTRIGGER: | ||
3163 | val = 0; | ||
3164 | if ((file->f_mode & FMODE_READ) && card->ch_in.is_enabled) | ||
3165 | val |= PCM_ENABLE_INPUT; | ||
3166 | if ((file->f_mode & FMODE_WRITE) && card->ch_out.is_enabled) | ||
3167 | val |= PCM_ENABLE_OUTPUT; | ||
3168 | rc = put_user(val, ip); | ||
3169 | break; | ||
3170 | |||
3171 | /* Enable full duplex. Since we do this as soon as we are opened | ||
3172 | * with O_RDWR, this is mainly a no-op that always returns success. | ||
3173 | */ | ||
3174 | case SNDCTL_DSP_SETDUPLEX: | ||
3175 | DPRINTK ("DSP_SETDUPLEX\n"); | ||
3176 | if (!rd || !wr) | ||
3177 | break; | ||
3178 | rc = 0; | ||
3179 | break; | ||
3180 | |||
3181 | /* set fragment size. implemented as a successful no-op for now */ | ||
3182 | case SNDCTL_DSP_SETFRAGMENT: | ||
3183 | if (get_user(val, ip)) { | ||
3184 | rc = -EFAULT; | ||
3185 | break; | ||
3186 | } | ||
3187 | DPRINTK ("DSP_SETFRAGMENT, val==%d\n", val); | ||
3188 | |||
3189 | if (rd) | ||
3190 | rc = via_chan_set_buffering(card, &card->ch_in, val); | ||
3191 | |||
3192 | if (wr) | ||
3193 | rc = via_chan_set_buffering(card, &card->ch_out, val); | ||
3194 | |||
3195 | DPRINTK ("SNDCTL_DSP_SETFRAGMENT (fragshift==0x%04X (%d), maxfrags==0x%04X (%d))\n", | ||
3196 | val & 0xFFFF, | ||
3197 | val & 0xFFFF, | ||
3198 | (val >> 16) & 0xFFFF, | ||
3199 | (val >> 16) & 0xFFFF); | ||
3200 | |||
3201 | rc = 0; | ||
3202 | break; | ||
3203 | |||
3204 | /* inform device of an upcoming pause in input (or output). */ | ||
3205 | case SNDCTL_DSP_POST: | ||
3206 | DPRINTK ("DSP_POST\n"); | ||
3207 | if (wr) { | ||
3208 | if (card->ch_out.slop_len > 0) | ||
3209 | via_chan_flush_frag (&card->ch_out); | ||
3210 | via_chan_maybe_start (&card->ch_out); | ||
3211 | } | ||
3212 | |||
3213 | rc = 0; | ||
3214 | break; | ||
3215 | |||
3216 | /* not implemented */ | ||
3217 | default: | ||
3218 | DPRINTK ("unhandled ioctl, cmd==%u, arg==%p\n", | ||
3219 | cmd, p); | ||
3220 | break; | ||
3221 | } | ||
3222 | |||
3223 | up (&card->syscall_sem); | ||
3224 | DPRINTK ("EXIT, returning %d\n", rc); | ||
3225 | return rc; | ||
3226 | } | ||
3227 | |||
3228 | |||
3229 | static int via_dsp_open (struct inode *inode, struct file *file) | ||
3230 | { | ||
3231 | int minor = iminor(inode); | ||
3232 | struct via_info *card; | ||
3233 | struct pci_dev *pdev = NULL; | ||
3234 | struct via_channel *chan; | ||
3235 | struct pci_driver *drvr; | ||
3236 | int nonblock = (file->f_flags & O_NONBLOCK); | ||
3237 | |||
3238 | DPRINTK ("ENTER, minor=%d, file->f_mode=0x%x\n", minor, file->f_mode); | ||
3239 | |||
3240 | if (!(file->f_mode & (FMODE_READ | FMODE_WRITE))) { | ||
3241 | DPRINTK ("EXIT, returning -EINVAL\n"); | ||
3242 | return -EINVAL; | ||
3243 | } | ||
3244 | |||
3245 | card = NULL; | ||
3246 | while ((pdev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, pdev)) != NULL) { | ||
3247 | drvr = pci_dev_driver (pdev); | ||
3248 | if (drvr == &via_driver) { | ||
3249 | assert (pci_get_drvdata (pdev) != NULL); | ||
3250 | |||
3251 | card = pci_get_drvdata (pdev); | ||
3252 | DPRINTK ("dev_dsp = %d, minor = %d, assn = %d\n", | ||
3253 | card->dev_dsp, minor, | ||
3254 | (card->dev_dsp ^ minor) & ~0xf); | ||
3255 | |||
3256 | if (((card->dev_dsp ^ minor) & ~0xf) == 0) | ||
3257 | goto match; | ||
3258 | } | ||
3259 | } | ||
3260 | |||
3261 | DPRINTK ("no matching %s found\n", card ? "minor" : "driver"); | ||
3262 | return -ENODEV; | ||
3263 | |||
3264 | match: | ||
3265 | if (nonblock) { | ||
3266 | if (down_trylock (&card->open_sem)) { | ||
3267 | DPRINTK ("EXIT, returning -EAGAIN\n"); | ||
3268 | return -EAGAIN; | ||
3269 | } | ||
3270 | } else { | ||
3271 | if (down_interruptible (&card->open_sem)) { | ||
3272 | DPRINTK ("EXIT, returning -ERESTARTSYS\n"); | ||
3273 | return -ERESTARTSYS; | ||
3274 | } | ||
3275 | } | ||
3276 | |||
3277 | file->private_data = card; | ||
3278 | DPRINTK ("file->f_mode == 0x%x\n", file->f_mode); | ||
3279 | |||
3280 | /* handle input from analog source */ | ||
3281 | if (file->f_mode & FMODE_READ) { | ||
3282 | chan = &card->ch_in; | ||
3283 | |||
3284 | via_chan_init (card, chan); | ||
3285 | |||
3286 | /* why is this forced to 16-bit stereo in all drivers? */ | ||
3287 | chan->pcm_fmt = VIA_PCM_FMT_16BIT | VIA_PCM_FMT_STEREO; | ||
3288 | chan->channels = 2; | ||
3289 | |||
3290 | // TO DO - use FIFO: via_capture_fifo(card, 1); | ||
3291 | via_chan_pcm_fmt (chan, 0); | ||
3292 | via_set_rate (card->ac97, chan, 44100); | ||
3293 | } | ||
3294 | |||
3295 | /* handle output to analog source */ | ||
3296 | if (file->f_mode & FMODE_WRITE) { | ||
3297 | chan = &card->ch_out; | ||
3298 | |||
3299 | via_chan_init (card, chan); | ||
3300 | |||
3301 | if (file->f_mode & FMODE_READ) { | ||
3302 | /* if in duplex mode make the recording and playback channels | ||
3303 | have the same settings */ | ||
3304 | chan->pcm_fmt = VIA_PCM_FMT_16BIT | VIA_PCM_FMT_STEREO; | ||
3305 | chan->channels = 2; | ||
3306 | via_chan_pcm_fmt (chan, 0); | ||
3307 | via_set_rate (card->ac97, chan, 44100); | ||
3308 | } else { | ||
3309 | if ((minor & 0xf) == SND_DEV_DSP16) { | ||
3310 | chan->pcm_fmt = VIA_PCM_FMT_16BIT; | ||
3311 | via_chan_pcm_fmt (chan, 0); | ||
3312 | via_set_rate (card->ac97, chan, 44100); | ||
3313 | } else { | ||
3314 | via_chan_pcm_fmt (chan, 1); | ||
3315 | via_set_rate (card->ac97, chan, 8000); | ||
3316 | } | ||
3317 | } | ||
3318 | } | ||
3319 | |||
3320 | DPRINTK ("EXIT, returning 0\n"); | ||
3321 | return nonseekable_open(inode, file); | ||
3322 | } | ||
3323 | |||
3324 | |||
3325 | static int via_dsp_release(struct inode *inode, struct file *file) | ||
3326 | { | ||
3327 | struct via_info *card; | ||
3328 | int nonblock = (file->f_flags & O_NONBLOCK); | ||
3329 | int rc; | ||
3330 | |||
3331 | DPRINTK ("ENTER\n"); | ||
3332 | |||
3333 | assert (file != NULL); | ||
3334 | card = file->private_data; | ||
3335 | assert (card != NULL); | ||
3336 | |||
3337 | rc = via_syscall_down (card, nonblock); | ||
3338 | if (rc) { | ||
3339 | DPRINTK ("EXIT (syscall_down error), rc=%d\n", rc); | ||
3340 | return rc; | ||
3341 | } | ||
3342 | |||
3343 | if (file->f_mode & FMODE_WRITE) { | ||
3344 | rc = via_dsp_drain_playback (card, &card->ch_out, nonblock); | ||
3345 | if (rc && rc != -ERESTARTSYS) /* Nobody needs to know about ^C */ | ||
3346 | printk (KERN_DEBUG "via_audio: ignoring drain playback error %d\n", rc); | ||
3347 | |||
3348 | via_chan_free (card, &card->ch_out); | ||
3349 | via_chan_buffer_free(card, &card->ch_out); | ||
3350 | } | ||
3351 | |||
3352 | if (file->f_mode & FMODE_READ) { | ||
3353 | via_chan_free (card, &card->ch_in); | ||
3354 | via_chan_buffer_free (card, &card->ch_in); | ||
3355 | } | ||
3356 | |||
3357 | up (&card->syscall_sem); | ||
3358 | up (&card->open_sem); | ||
3359 | |||
3360 | DPRINTK ("EXIT, returning 0\n"); | ||
3361 | return 0; | ||
3362 | } | ||
3363 | |||
3364 | |||
3365 | /**************************************************************** | ||
3366 | * | ||
3367 | * Chip setup and kernel registration | ||
3368 | * | ||
3369 | * | ||
3370 | */ | ||
3371 | |||
3372 | static int __devinit via_init_one (struct pci_dev *pdev, const struct pci_device_id *id) | ||
3373 | { | ||
3374 | #ifdef CONFIG_MIDI_VIA82CXXX | ||
3375 | u8 r42; | ||
3376 | #endif | ||
3377 | int rc; | ||
3378 | struct via_info *card; | ||
3379 | static int printed_version; | ||
3380 | |||
3381 | DPRINTK ("ENTER\n"); | ||
3382 | |||
3383 | if (printed_version++ == 0) | ||
3384 | printk (KERN_INFO "Via 686a/8233/8235 audio driver " VIA_VERSION "\n"); | ||
3385 | |||
3386 | rc = pci_enable_device (pdev); | ||
3387 | if (rc) | ||
3388 | goto err_out; | ||
3389 | |||
3390 | rc = pci_request_regions (pdev, "via82cxxx_audio"); | ||
3391 | if (rc) | ||
3392 | goto err_out_disable; | ||
3393 | |||
3394 | rc = pci_set_dma_mask(pdev, 0xffffffffULL); | ||
3395 | if (rc) | ||
3396 | goto err_out_res; | ||
3397 | rc = pci_set_consistent_dma_mask(pdev, 0xffffffffULL); | ||
3398 | if (rc) | ||
3399 | goto err_out_res; | ||
3400 | |||
3401 | card = kmalloc (sizeof (*card), GFP_KERNEL); | ||
3402 | if (!card) { | ||
3403 | printk (KERN_ERR PFX "out of memory, aborting\n"); | ||
3404 | rc = -ENOMEM; | ||
3405 | goto err_out_res; | ||
3406 | } | ||
3407 | |||
3408 | pci_set_drvdata (pdev, card); | ||
3409 | |||
3410 | memset (card, 0, sizeof (*card)); | ||
3411 | card->pdev = pdev; | ||
3412 | card->baseaddr = pci_resource_start (pdev, 0); | ||
3413 | card->card_num = via_num_cards++; | ||
3414 | spin_lock_init (&card->lock); | ||
3415 | spin_lock_init (&card->ac97_lock); | ||
3416 | init_MUTEX (&card->syscall_sem); | ||
3417 | init_MUTEX (&card->open_sem); | ||
3418 | |||
3419 | /* we must init these now, in case the intr handler needs them */ | ||
3420 | via_chan_init_defaults (card, &card->ch_out); | ||
3421 | via_chan_init_defaults (card, &card->ch_in); | ||
3422 | via_chan_init_defaults (card, &card->ch_fm); | ||
3423 | |||
3424 | /* if BAR 2 is present, chip is Rev H or later, | ||
3425 | * which means it has a few extra features */ | ||
3426 | if (pci_resource_start (pdev, 2) > 0) | ||
3427 | card->rev_h = 1; | ||
3428 | |||
3429 | /* Overkill for now, but more flexible done right */ | ||
3430 | |||
3431 | card->intmask = id->driver_data; | ||
3432 | card->legacy = !card->intmask; | ||
3433 | card->sixchannel = id->driver_data; | ||
3434 | |||
3435 | if(card->sixchannel) | ||
3436 | printk(KERN_INFO PFX "Six channel audio available\n"); | ||
3437 | if (pdev->irq < 1) { | ||
3438 | printk (KERN_ERR PFX "invalid PCI IRQ %d, aborting\n", pdev->irq); | ||
3439 | rc = -ENODEV; | ||
3440 | goto err_out_kfree; | ||
3441 | } | ||
3442 | |||
3443 | if (!(pci_resource_flags (pdev, 0) & IORESOURCE_IO)) { | ||
3444 | printk (KERN_ERR PFX "unable to locate I/O resources, aborting\n"); | ||
3445 | rc = -ENODEV; | ||
3446 | goto err_out_kfree; | ||
3447 | } | ||
3448 | |||
3449 | pci_set_master(pdev); | ||
3450 | |||
3451 | /* | ||
3452 | * init AC97 mixer and codec | ||
3453 | */ | ||
3454 | rc = via_ac97_init (card); | ||
3455 | if (rc) { | ||
3456 | printk (KERN_ERR PFX "AC97 init failed, aborting\n"); | ||
3457 | goto err_out_kfree; | ||
3458 | } | ||
3459 | |||
3460 | /* | ||
3461 | * init DSP device | ||
3462 | */ | ||
3463 | rc = via_dsp_init (card); | ||
3464 | if (rc) { | ||
3465 | printk (KERN_ERR PFX "DSP device init failed, aborting\n"); | ||
3466 | goto err_out_have_mixer; | ||
3467 | } | ||
3468 | |||
3469 | /* | ||
3470 | * init and turn on interrupts, as the last thing we do | ||
3471 | */ | ||
3472 | rc = via_interrupt_init (card); | ||
3473 | if (rc) { | ||
3474 | printk (KERN_ERR PFX "interrupt init failed, aborting\n"); | ||
3475 | goto err_out_have_dsp; | ||
3476 | } | ||
3477 | |||
3478 | printk (KERN_INFO PFX "board #%d at 0x%04lX, IRQ %d\n", | ||
3479 | card->card_num + 1, card->baseaddr, pdev->irq); | ||
3480 | |||
3481 | #ifdef CONFIG_MIDI_VIA82CXXX | ||
3482 | /* Disable by default */ | ||
3483 | card->midi_info.io_base = 0; | ||
3484 | |||
3485 | if(card->legacy) | ||
3486 | { | ||
3487 | pci_read_config_byte (pdev, 0x42, &r42); | ||
3488 | /* Disable MIDI interrupt */ | ||
3489 | pci_write_config_byte (pdev, 0x42, r42 | VIA_CR42_MIDI_IRQMASK); | ||
3490 | if (r42 & VIA_CR42_MIDI_ENABLE) | ||
3491 | { | ||
3492 | if (r42 & VIA_CR42_MIDI_PNP) /* Address selected by iobase 2 - not tested */ | ||
3493 | card->midi_info.io_base = pci_resource_start (pdev, 2); | ||
3494 | else /* Address selected by byte 0x43 */ | ||
3495 | { | ||
3496 | u8 r43; | ||
3497 | pci_read_config_byte (pdev, 0x43, &r43); | ||
3498 | card->midi_info.io_base = 0x300 + ((r43 & 0x0c) << 2); | ||
3499 | } | ||
3500 | |||
3501 | card->midi_info.irq = -pdev->irq; | ||
3502 | if (probe_uart401(& card->midi_info, THIS_MODULE)) | ||
3503 | { | ||
3504 | card->midi_devc=midi_devs[card->midi_info.slots[4]]->devc; | ||
3505 | pci_write_config_byte(pdev, 0x42, r42 & ~VIA_CR42_MIDI_IRQMASK); | ||
3506 | printk("Enabled Via MIDI\n"); | ||
3507 | } | ||
3508 | } | ||
3509 | } | ||
3510 | #endif | ||
3511 | |||
3512 | DPRINTK ("EXIT, returning 0\n"); | ||
3513 | return 0; | ||
3514 | |||
3515 | err_out_have_dsp: | ||
3516 | via_dsp_cleanup (card); | ||
3517 | |||
3518 | err_out_have_mixer: | ||
3519 | via_ac97_cleanup (card); | ||
3520 | |||
3521 | err_out_kfree: | ||
3522 | #ifndef VIA_NDEBUG | ||
3523 | memset (card, 0xAB, sizeof (*card)); /* poison memory */ | ||
3524 | #endif | ||
3525 | kfree (card); | ||
3526 | |||
3527 | err_out_res: | ||
3528 | pci_release_regions (pdev); | ||
3529 | |||
3530 | err_out_disable: | ||
3531 | pci_disable_device (pdev); | ||
3532 | |||
3533 | err_out: | ||
3534 | pci_set_drvdata (pdev, NULL); | ||
3535 | DPRINTK ("EXIT - returning %d\n", rc); | ||
3536 | return rc; | ||
3537 | } | ||
3538 | |||
3539 | |||
3540 | static void __devexit via_remove_one (struct pci_dev *pdev) | ||
3541 | { | ||
3542 | struct via_info *card; | ||
3543 | |||
3544 | DPRINTK ("ENTER\n"); | ||
3545 | |||
3546 | assert (pdev != NULL); | ||
3547 | card = pci_get_drvdata (pdev); | ||
3548 | assert (card != NULL); | ||
3549 | |||
3550 | #ifdef CONFIG_MIDI_VIA82CXXX | ||
3551 | if (card->midi_info.io_base) | ||
3552 | unload_uart401(&card->midi_info); | ||
3553 | #endif | ||
3554 | |||
3555 | free_irq (card->pdev->irq, card); | ||
3556 | via_dsp_cleanup (card); | ||
3557 | via_ac97_cleanup (card); | ||
3558 | |||
3559 | #ifndef VIA_NDEBUG | ||
3560 | memset (card, 0xAB, sizeof (*card)); /* poison memory */ | ||
3561 | #endif | ||
3562 | kfree (card); | ||
3563 | |||
3564 | pci_set_drvdata (pdev, NULL); | ||
3565 | |||
3566 | pci_release_regions (pdev); | ||
3567 | pci_disable_device (pdev); | ||
3568 | pci_set_power_state (pdev, 3); /* ...zzzzzz */ | ||
3569 | |||
3570 | DPRINTK ("EXIT\n"); | ||
3571 | return; | ||
3572 | } | ||
3573 | |||
3574 | |||
3575 | /**************************************************************** | ||
3576 | * | ||
3577 | * Driver initialization and cleanup | ||
3578 | * | ||
3579 | * | ||
3580 | */ | ||
3581 | |||
3582 | static int __init init_via82cxxx_audio(void) | ||
3583 | { | ||
3584 | int rc; | ||
3585 | |||
3586 | DPRINTK ("ENTER\n"); | ||
3587 | |||
3588 | rc = pci_register_driver (&via_driver); | ||
3589 | if (rc) { | ||
3590 | DPRINTK ("EXIT, returning %d\n", rc); | ||
3591 | return rc; | ||
3592 | } | ||
3593 | |||
3594 | DPRINTK ("EXIT, returning 0\n"); | ||
3595 | return 0; | ||
3596 | } | ||
3597 | |||
3598 | |||
3599 | static void __exit cleanup_via82cxxx_audio(void) | ||
3600 | { | ||
3601 | DPRINTK ("ENTER\n"); | ||
3602 | |||
3603 | pci_unregister_driver (&via_driver); | ||
3604 | |||
3605 | DPRINTK ("EXIT\n"); | ||
3606 | } | ||
3607 | |||
3608 | |||
3609 | module_init(init_via82cxxx_audio); | ||
3610 | module_exit(cleanup_via82cxxx_audio); | ||
3611 | |||
3612 | MODULE_AUTHOR("Jeff Garzik"); | ||
3613 | MODULE_DESCRIPTION("DSP audio and mixer driver for Via 82Cxxx audio devices"); | ||
3614 | MODULE_LICENSE("GPL"); | ||
3615 | |||