Linux-2.6.12-rc2
[linux-flexiantxendom0-natty.git] / sound / pci / via82xx_modem.c
1 /*
2  *   ALSA modem driver for VIA VT82xx (South Bridge)
3  *
4  *   VT82C686A/B/C, VT8233A/C, VT8235
5  *
6  *      Copyright (c) 2000 Jaroslav Kysela <perex@suse.cz>
7  *                         Tjeerd.Mulder <Tjeerd.Mulder@fujitsu-siemens.com>
8  *                    2002 Takashi Iwai <tiwai@suse.de>
9  *
10  *   This program is free software; you can redistribute it and/or modify
11  *   it under the terms of the GNU General Public License as published by
12  *   the Free Software Foundation; either version 2 of the License, or
13  *   (at your option) any later version.
14  *
15  *   This program is distributed in the hope that it will be useful,
16  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
17  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  *   GNU General Public License for more details.
19  *
20  *   You should have received a copy of the GNU General Public License
21  *   along with this program; if not, write to the Free Software
22  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
23  *
24  */
25
26 /*
27  * Changes:
28  *
29  * Sep. 2,  2004  Sasha Khapyorsky <sashak@smlink.com>
30  *      Modified from original audio driver 'via82xx.c' to support AC97
31  *      modems.
32  */
33
34 #include <sound/driver.h>
35 #include <asm/io.h>
36 #include <linux/delay.h>
37 #include <linux/interrupt.h>
38 #include <linux/init.h>
39 #include <linux/pci.h>
40 #include <linux/slab.h>
41 #include <linux/moduleparam.h>
42 #include <sound/core.h>
43 #include <sound/pcm.h>
44 #include <sound/pcm_params.h>
45 #include <sound/info.h>
46 #include <sound/ac97_codec.h>
47 #include <sound/initval.h>
48
49 #if 0
50 #define POINTER_DEBUG
51 #endif
52
53 MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>");
54 MODULE_DESCRIPTION("VIA VT82xx modem");
55 MODULE_LICENSE("GPL");
56 MODULE_SUPPORTED_DEVICE("{{VIA,VT82C686A/B/C modem,pci}}");
57
58 static int index[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = -2}; /* Exclude the first card */
59 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;       /* ID for this card */
60 static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;      /* Enable this card */
61 static int ac97_clock[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 48000};
62
63 module_param_array(index, int, NULL, 0444);
64 MODULE_PARM_DESC(index, "Index value for VIA 82xx bridge.");
65 module_param_array(id, charp, NULL, 0444);
66 MODULE_PARM_DESC(id, "ID string for VIA 82xx bridge.");
67 module_param_array(enable, bool, NULL, 0444);
68 MODULE_PARM_DESC(enable, "Enable modem part of VIA 82xx bridge.");
69 module_param_array(ac97_clock, int, NULL, 0444);
70 MODULE_PARM_DESC(ac97_clock, "AC'97 codec clock (default 48000Hz).");
71
72
73 /*
74  *  Direct registers
75  */
76
77 #define VIAREG(via, x) ((via)->port + VIA_REG_##x)
78 #define VIADEV_REG(viadev, x) ((viadev)->port + VIA_REG_##x)
79
80 /* common offsets */
81 #define VIA_REG_OFFSET_STATUS           0x00    /* byte - channel status */
82 #define   VIA_REG_STAT_ACTIVE           0x80    /* RO */
83 #define   VIA_REG_STAT_PAUSED           0x40    /* RO */
84 #define   VIA_REG_STAT_TRIGGER_QUEUED   0x08    /* RO */
85 #define   VIA_REG_STAT_STOPPED          0x04    /* RWC */
86 #define   VIA_REG_STAT_EOL              0x02    /* RWC */
87 #define   VIA_REG_STAT_FLAG             0x01    /* RWC */
88 #define VIA_REG_OFFSET_CONTROL          0x01    /* byte - channel control */
89 #define   VIA_REG_CTRL_START            0x80    /* WO */
90 #define   VIA_REG_CTRL_TERMINATE        0x40    /* WO */
91 #define   VIA_REG_CTRL_AUTOSTART        0x20
92 #define   VIA_REG_CTRL_PAUSE            0x08    /* RW */
93 #define   VIA_REG_CTRL_INT_STOP         0x04            
94 #define   VIA_REG_CTRL_INT_EOL          0x02
95 #define   VIA_REG_CTRL_INT_FLAG         0x01
96 #define   VIA_REG_CTRL_RESET            0x01    /* RW - probably reset? undocumented */
97 #define   VIA_REG_CTRL_INT (VIA_REG_CTRL_INT_FLAG | VIA_REG_CTRL_INT_EOL | VIA_REG_CTRL_AUTOSTART)
98 #define VIA_REG_OFFSET_TYPE             0x02    /* byte - channel type (686 only) */
99 #define   VIA_REG_TYPE_AUTOSTART        0x80    /* RW - autostart at EOL */
100 #define   VIA_REG_TYPE_16BIT            0x20    /* RW */
101 #define   VIA_REG_TYPE_STEREO           0x10    /* RW */
102 #define   VIA_REG_TYPE_INT_LLINE        0x00
103 #define   VIA_REG_TYPE_INT_LSAMPLE      0x04
104 #define   VIA_REG_TYPE_INT_LESSONE      0x08
105 #define   VIA_REG_TYPE_INT_MASK         0x0c
106 #define   VIA_REG_TYPE_INT_EOL          0x02
107 #define   VIA_REG_TYPE_INT_FLAG         0x01
108 #define VIA_REG_OFFSET_TABLE_PTR        0x04    /* dword - channel table pointer */
109 #define VIA_REG_OFFSET_CURR_PTR         0x04    /* dword - channel current pointer */
110 #define VIA_REG_OFFSET_STOP_IDX         0x08    /* dword - stop index, channel type, sample rate */
111 #define VIA_REG_OFFSET_CURR_COUNT       0x0c    /* dword - channel current count (24 bit) */
112 #define VIA_REG_OFFSET_CURR_INDEX       0x0f    /* byte - channel current index (for via8233 only) */
113
114 #define DEFINE_VIA_REGSET(name,val) \
115 enum {\
116         VIA_REG_##name##_STATUS         = (val),\
117         VIA_REG_##name##_CONTROL        = (val) + 0x01,\
118         VIA_REG_##name##_TYPE           = (val) + 0x02,\
119         VIA_REG_##name##_TABLE_PTR      = (val) + 0x04,\
120         VIA_REG_##name##_CURR_PTR       = (val) + 0x04,\
121         VIA_REG_##name##_STOP_IDX       = (val) + 0x08,\
122         VIA_REG_##name##_CURR_COUNT     = (val) + 0x0c,\
123 }
124
125 /* modem block */
126 DEFINE_VIA_REGSET(MO, 0x40);
127 DEFINE_VIA_REGSET(MI, 0x50);
128
129 /* AC'97 */
130 #define VIA_REG_AC97                    0x80    /* dword */
131 #define   VIA_REG_AC97_CODEC_ID_MASK    (3<<30)
132 #define   VIA_REG_AC97_CODEC_ID_SHIFT   30
133 #define   VIA_REG_AC97_CODEC_ID_PRIMARY 0x00
134 #define   VIA_REG_AC97_CODEC_ID_SECONDARY 0x01
135 #define   VIA_REG_AC97_SECONDARY_VALID  (1<<27)
136 #define   VIA_REG_AC97_PRIMARY_VALID    (1<<25)
137 #define   VIA_REG_AC97_BUSY             (1<<24)
138 #define   VIA_REG_AC97_READ             (1<<23)
139 #define   VIA_REG_AC97_CMD_SHIFT        16
140 #define   VIA_REG_AC97_CMD_MASK         0x7e
141 #define   VIA_REG_AC97_DATA_SHIFT       0
142 #define   VIA_REG_AC97_DATA_MASK        0xffff
143
144 #define VIA_REG_SGD_SHADOW              0x84    /* dword */
145 #define   VIA_REG_SGD_STAT_PB_FLAG      (1<<0)
146 #define   VIA_REG_SGD_STAT_CP_FLAG      (1<<1)
147 #define   VIA_REG_SGD_STAT_FM_FLAG      (1<<2)
148 #define   VIA_REG_SGD_STAT_PB_EOL       (1<<4)
149 #define   VIA_REG_SGD_STAT_CP_EOL       (1<<5)
150 #define   VIA_REG_SGD_STAT_FM_EOL       (1<<6)
151 #define   VIA_REG_SGD_STAT_PB_STOP      (1<<8)
152 #define   VIA_REG_SGD_STAT_CP_STOP      (1<<9)
153 #define   VIA_REG_SGD_STAT_FM_STOP      (1<<10)
154 #define   VIA_REG_SGD_STAT_PB_ACTIVE    (1<<12)
155 #define   VIA_REG_SGD_STAT_CP_ACTIVE    (1<<13)
156 #define   VIA_REG_SGD_STAT_FM_ACTIVE    (1<<14)
157 #define   VIA_REG_SGD_STAT_MR_FLAG      (1<<16)
158 #define   VIA_REG_SGD_STAT_MW_FLAG      (1<<17)
159 #define   VIA_REG_SGD_STAT_MR_EOL       (1<<20)
160 #define   VIA_REG_SGD_STAT_MW_EOL       (1<<21)
161 #define   VIA_REG_SGD_STAT_MR_STOP      (1<<24)
162 #define   VIA_REG_SGD_STAT_MW_STOP      (1<<25)
163 #define   VIA_REG_SGD_STAT_MR_ACTIVE    (1<<28)
164 #define   VIA_REG_SGD_STAT_MW_ACTIVE    (1<<29)
165
166 #define VIA_REG_GPI_STATUS              0x88
167 #define VIA_REG_GPI_INTR                0x8c
168
169 #define VIA_TBL_BIT_FLAG        0x40000000
170 #define VIA_TBL_BIT_EOL         0x80000000
171
172 /* pci space */
173 #define VIA_ACLINK_STAT         0x40
174 #define  VIA_ACLINK_C11_READY   0x20
175 #define  VIA_ACLINK_C10_READY   0x10
176 #define  VIA_ACLINK_C01_READY   0x04 /* secondary codec ready */
177 #define  VIA_ACLINK_LOWPOWER    0x02 /* low-power state */
178 #define  VIA_ACLINK_C00_READY   0x01 /* primary codec ready */
179 #define VIA_ACLINK_CTRL         0x41
180 #define  VIA_ACLINK_CTRL_ENABLE 0x80 /* 0: disable, 1: enable */
181 #define  VIA_ACLINK_CTRL_RESET  0x40 /* 0: assert, 1: de-assert */
182 #define  VIA_ACLINK_CTRL_SYNC   0x20 /* 0: release SYNC, 1: force SYNC hi */
183 #define  VIA_ACLINK_CTRL_SDO    0x10 /* 0: release SDO, 1: force SDO hi */
184 #define  VIA_ACLINK_CTRL_VRA    0x08 /* 0: disable VRA, 1: enable VRA */
185 #define  VIA_ACLINK_CTRL_PCM    0x04 /* 0: disable PCM, 1: enable PCM */
186 #define  VIA_ACLINK_CTRL_FM     0x02 /* via686 only */
187 #define  VIA_ACLINK_CTRL_SB     0x01 /* via686 only */
188 #define  VIA_ACLINK_CTRL_INIT   (VIA_ACLINK_CTRL_ENABLE|\
189                                  VIA_ACLINK_CTRL_RESET|\
190                                  VIA_ACLINK_CTRL_PCM)
191 #define VIA_FUNC_ENABLE         0x42
192 #define  VIA_FUNC_MIDI_PNP      0x80 /* FIXME: it's 0x40 in the datasheet! */
193 #define  VIA_FUNC_MIDI_IRQMASK  0x40 /* FIXME: not documented! */
194 #define  VIA_FUNC_RX2C_WRITE    0x20
195 #define  VIA_FUNC_SB_FIFO_EMPTY 0x10
196 #define  VIA_FUNC_ENABLE_GAME   0x08
197 #define  VIA_FUNC_ENABLE_FM     0x04
198 #define  VIA_FUNC_ENABLE_MIDI   0x02
199 #define  VIA_FUNC_ENABLE_SB     0x01
200 #define VIA_PNP_CONTROL         0x43
201 #define VIA_MC97_CTRL           0x44
202 #define  VIA_MC97_CTRL_ENABLE   0x80
203 #define  VIA_MC97_CTRL_SECONDARY 0x40
204 #define  VIA_MC97_CTRL_INIT     (VIA_MC97_CTRL_ENABLE|\
205                                  VIA_MC97_CTRL_SECONDARY)
206
207
208 typedef struct _snd_via82xx_modem via82xx_t;
209 typedef struct via_dev viadev_t;
210
211 /*
212  * pcm stream
213  */
214
215 struct snd_via_sg_table {
216         unsigned int offset;
217         unsigned int size;
218 } ;
219
220 #define VIA_TABLE_SIZE  255
221
222 struct via_dev {
223         unsigned int reg_offset;
224         unsigned long port;
225         int direction;  /* playback = 0, capture = 1 */
226         snd_pcm_substream_t *substream;
227         int running;
228         unsigned int tbl_entries; /* # descriptors */
229         struct snd_dma_buffer table;
230         struct snd_via_sg_table *idx_table;
231         /* for recovery from the unexpected pointer */
232         unsigned int lastpos;
233         unsigned int bufsize;
234         unsigned int bufsize2;
235 };
236
237 enum { TYPE_CARD_VIA82XX_MODEM = 1 };
238
239 #define VIA_MAX_MODEM_DEVS      2
240
241 struct _snd_via82xx_modem {
242         int irq;
243
244         unsigned long port;
245
246         unsigned int intr_mask; /* SGD_SHADOW mask to check interrupts */
247
248         struct pci_dev *pci;
249         snd_card_t *card;
250
251         unsigned int num_devs;
252         unsigned int playback_devno, capture_devno;
253         viadev_t devs[VIA_MAX_MODEM_DEVS];
254
255         snd_pcm_t *pcms[2];
256
257         ac97_bus_t *ac97_bus;
258         ac97_t *ac97;
259         unsigned int ac97_clock;
260         unsigned int ac97_secondary;    /* secondary AC'97 codec is present */
261
262         spinlock_t reg_lock;
263         snd_info_entry_t *proc_entry;
264 };
265
266 static struct pci_device_id snd_via82xx_modem_ids[] = {
267         { 0x1106, 0x3068, PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPE_CARD_VIA82XX_MODEM, },
268         { 0, }
269 };
270
271 MODULE_DEVICE_TABLE(pci, snd_via82xx_modem_ids);
272
273 /*
274  */
275
276 /*
277  * allocate and initialize the descriptor buffers
278  * periods = number of periods
279  * fragsize = period size in bytes
280  */
281 static int build_via_table(viadev_t *dev, snd_pcm_substream_t *substream,
282                            struct pci_dev *pci,
283                            unsigned int periods, unsigned int fragsize)
284 {
285         unsigned int i, idx, ofs, rest;
286         via82xx_t *chip = snd_pcm_substream_chip(substream);
287         struct snd_sg_buf *sgbuf = snd_pcm_substream_sgbuf(substream);
288
289         if (dev->table.area == NULL) {
290                 /* the start of each lists must be aligned to 8 bytes,
291                  * but the kernel pages are much bigger, so we don't care
292                  */
293                 if (snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, snd_dma_pci_data(chip->pci),
294                                         PAGE_ALIGN(VIA_TABLE_SIZE * 2 * 8),
295                                         &dev->table) < 0)
296                         return -ENOMEM;
297         }
298         if (! dev->idx_table) {
299                 dev->idx_table = kmalloc(sizeof(*dev->idx_table) * VIA_TABLE_SIZE, GFP_KERNEL);
300                 if (! dev->idx_table)
301                         return -ENOMEM;
302         }
303
304         /* fill the entries */
305         idx = 0;
306         ofs = 0;
307         for (i = 0; i < periods; i++) {
308                 rest = fragsize;
309                 /* fill descriptors for a period.
310                  * a period can be split to several descriptors if it's
311                  * over page boundary.
312                  */
313                 do {
314                         unsigned int r;
315                         unsigned int flag;
316
317                         if (idx >= VIA_TABLE_SIZE) {
318                                 snd_printk(KERN_ERR "via82xx: too much table size!\n");
319                                 return -EINVAL;
320                         }
321                         ((u32 *)dev->table.area)[idx << 1] = cpu_to_le32((u32)snd_pcm_sgbuf_get_addr(sgbuf, ofs));
322                         r = PAGE_SIZE - (ofs % PAGE_SIZE);
323                         if (rest < r)
324                                 r = rest;
325                         rest -= r;
326                         if (! rest) {
327                                 if (i == periods - 1)
328                                         flag = VIA_TBL_BIT_EOL; /* buffer boundary */
329                                 else
330                                         flag = VIA_TBL_BIT_FLAG; /* period boundary */
331                         } else
332                                 flag = 0; /* period continues to the next */
333                         // printk("via: tbl %d: at %d  size %d (rest %d)\n", idx, ofs, r, rest);
334                         ((u32 *)dev->table.area)[(idx<<1) + 1] = cpu_to_le32(r | flag);
335                         dev->idx_table[idx].offset = ofs;
336                         dev->idx_table[idx].size = r;
337                         ofs += r;
338                         idx++;
339                 } while (rest > 0);
340         }
341         dev->tbl_entries = idx;
342         dev->bufsize = periods * fragsize;
343         dev->bufsize2 = dev->bufsize / 2;
344         return 0;
345 }
346
347
348 static int clean_via_table(viadev_t *dev, snd_pcm_substream_t *substream,
349                            struct pci_dev *pci)
350 {
351         if (dev->table.area) {
352                 snd_dma_free_pages(&dev->table);
353                 dev->table.area = NULL;
354         }
355         if (dev->idx_table) {
356                 kfree(dev->idx_table);
357                 dev->idx_table = NULL;
358         }
359         return 0;
360 }
361
362 /*
363  *  Basic I/O
364  */
365
366 static inline unsigned int snd_via82xx_codec_xread(via82xx_t *chip)
367 {
368         return inl(VIAREG(chip, AC97));
369 }
370  
371 static inline void snd_via82xx_codec_xwrite(via82xx_t *chip, unsigned int val)
372 {
373         outl(val, VIAREG(chip, AC97));
374 }
375  
376 static int snd_via82xx_codec_ready(via82xx_t *chip, int secondary)
377 {
378         unsigned int timeout = 1000;    /* 1ms */
379         unsigned int val;
380         
381         while (timeout-- > 0) {
382                 udelay(1);
383                 if (!((val = snd_via82xx_codec_xread(chip)) & VIA_REG_AC97_BUSY))
384                         return val & 0xffff;
385         }
386         snd_printk(KERN_ERR "codec_ready: codec %i is not ready [0x%x]\n", secondary, snd_via82xx_codec_xread(chip));
387         return -EIO;
388 }
389  
390 static int snd_via82xx_codec_valid(via82xx_t *chip, int secondary)
391 {
392         unsigned int timeout = 1000;    /* 1ms */
393         unsigned int val, val1;
394         unsigned int stat = !secondary ? VIA_REG_AC97_PRIMARY_VALID :
395                                          VIA_REG_AC97_SECONDARY_VALID;
396         
397         while (timeout-- > 0) {
398                 val = snd_via82xx_codec_xread(chip);
399                 val1 = val & (VIA_REG_AC97_BUSY | stat);
400                 if (val1 == stat)
401                         return val & 0xffff;
402                 udelay(1);
403         }
404         return -EIO;
405 }
406  
407 static void snd_via82xx_codec_wait(ac97_t *ac97)
408 {
409         via82xx_t *chip = ac97->private_data;
410         int err;
411         err = snd_via82xx_codec_ready(chip, ac97->num);
412         /* here we need to wait fairly for long time.. */
413         set_current_state(TASK_UNINTERRUPTIBLE);
414         schedule_timeout(HZ/2);
415 }
416
417 static void snd_via82xx_codec_write(ac97_t *ac97,
418                                     unsigned short reg,
419                                     unsigned short val)
420 {
421         via82xx_t *chip = ac97->private_data;
422         unsigned int xval;
423         
424         xval = !ac97->num ? VIA_REG_AC97_CODEC_ID_PRIMARY : VIA_REG_AC97_CODEC_ID_SECONDARY;
425         xval <<= VIA_REG_AC97_CODEC_ID_SHIFT;
426         xval |= reg << VIA_REG_AC97_CMD_SHIFT;
427         xval |= val << VIA_REG_AC97_DATA_SHIFT;
428         snd_via82xx_codec_xwrite(chip, xval);
429         snd_via82xx_codec_ready(chip, ac97->num);
430 }
431
432 static unsigned short snd_via82xx_codec_read(ac97_t *ac97, unsigned short reg)
433 {
434         via82xx_t *chip = ac97->private_data;
435         unsigned int xval, val = 0xffff;
436         int again = 0;
437
438         xval = ac97->num << VIA_REG_AC97_CODEC_ID_SHIFT;
439         xval |= ac97->num ? VIA_REG_AC97_SECONDARY_VALID : VIA_REG_AC97_PRIMARY_VALID;
440         xval |= VIA_REG_AC97_READ;
441         xval |= (reg & 0x7f) << VIA_REG_AC97_CMD_SHIFT;
442         while (1) {
443                 if (again++ > 3) {
444                         snd_printk(KERN_ERR "codec_read: codec %i is not valid [0x%x]\n", ac97->num, snd_via82xx_codec_xread(chip));
445                         return 0xffff;
446                 }
447                 snd_via82xx_codec_xwrite(chip, xval);
448                 udelay (20);
449                 if (snd_via82xx_codec_valid(chip, ac97->num) >= 0) {
450                         udelay(25);
451                         val = snd_via82xx_codec_xread(chip);
452                         break;
453                 }
454         }
455         return val & 0xffff;
456 }
457
458 static void snd_via82xx_channel_reset(via82xx_t *chip, viadev_t *viadev)
459 {
460         outb(VIA_REG_CTRL_PAUSE | VIA_REG_CTRL_TERMINATE | VIA_REG_CTRL_RESET,
461              VIADEV_REG(viadev, OFFSET_CONTROL));
462         inb(VIADEV_REG(viadev, OFFSET_CONTROL));
463         udelay(50);
464         /* disable interrupts */
465         outb(0x00, VIADEV_REG(viadev, OFFSET_CONTROL));
466         /* clear interrupts */
467         outb(0x03, VIADEV_REG(viadev, OFFSET_STATUS));
468         outb(0x00, VIADEV_REG(viadev, OFFSET_TYPE)); /* for via686 */
469         // outl(0, VIADEV_REG(viadev, OFFSET_CURR_PTR));
470         viadev->lastpos = 0;
471 }
472
473
474 /*
475  *  Interrupt handler
476  */
477
478 static irqreturn_t snd_via82xx_interrupt(int irq, void *dev_id, struct pt_regs *regs)
479 {
480         via82xx_t *chip = dev_id;
481         unsigned int status;
482         unsigned int i;
483
484         status = inl(VIAREG(chip, SGD_SHADOW));
485         if (! (status & chip->intr_mask)) {
486                 return IRQ_NONE;
487         }
488 // _skip_sgd:
489
490         /* check status for each stream */
491         spin_lock(&chip->reg_lock);
492         for (i = 0; i < chip->num_devs; i++) {
493                 viadev_t *viadev = &chip->devs[i];
494                 unsigned char c_status = inb(VIADEV_REG(viadev, OFFSET_STATUS));
495                 c_status &= (VIA_REG_STAT_EOL|VIA_REG_STAT_FLAG|VIA_REG_STAT_STOPPED);
496                 if (! c_status)
497                         continue;
498                 if (viadev->substream && viadev->running) {
499                         spin_unlock(&chip->reg_lock);
500                         snd_pcm_period_elapsed(viadev->substream);
501                         spin_lock(&chip->reg_lock);
502                 }
503                 outb(c_status, VIADEV_REG(viadev, OFFSET_STATUS)); /* ack */
504         }
505         spin_unlock(&chip->reg_lock);
506         return IRQ_HANDLED;
507 }
508
509 /*
510  *  PCM callbacks
511  */
512
513 /*
514  * trigger callback
515  */
516 static int snd_via82xx_pcm_trigger(snd_pcm_substream_t * substream, int cmd)
517 {
518         via82xx_t *chip = snd_pcm_substream_chip(substream);
519         viadev_t *viadev = (viadev_t *)substream->runtime->private_data;
520         unsigned char val = 0;
521
522         switch (cmd) {
523         case SNDRV_PCM_TRIGGER_START:
524                 val |= VIA_REG_CTRL_START;
525                 viadev->running = 1;
526                 break;
527         case SNDRV_PCM_TRIGGER_STOP:
528                 val = VIA_REG_CTRL_TERMINATE;
529                 viadev->running = 0;
530                 break;
531         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
532                 val |= VIA_REG_CTRL_PAUSE;
533                 viadev->running = 0;
534                 break;
535         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
536                 viadev->running = 1;
537                 break;
538         default:
539                 return -EINVAL;
540         }
541         outb(val, VIADEV_REG(viadev, OFFSET_CONTROL));
542         if (cmd == SNDRV_PCM_TRIGGER_STOP)
543                 snd_via82xx_channel_reset(chip, viadev);
544         return 0;
545 }
546
547 static int snd_via82xx_modem_pcm_trigger(snd_pcm_substream_t * substream, int cmd)
548 {
549         via82xx_t *chip = snd_pcm_substream_chip(substream);
550         unsigned int val = 0;
551         switch (cmd) {
552         case SNDRV_PCM_TRIGGER_START:
553                 val = snd_ac97_read(chip->ac97, AC97_GPIO_STATUS);
554                 outl(val|AC97_GPIO_LINE1_OH, VIAREG(chip, GPI_STATUS));
555                 break;
556         case SNDRV_PCM_TRIGGER_STOP:
557                 val = snd_ac97_read(chip->ac97, AC97_GPIO_STATUS);
558                 outl(val&~AC97_GPIO_LINE1_OH, VIAREG(chip, GPI_STATUS));
559                 break;
560         default:
561                 break;
562         }
563         return snd_via82xx_pcm_trigger(substream, cmd);
564 }
565
566 /*
567  * pointer callbacks
568  */
569
570 /*
571  * calculate the linear position at the given sg-buffer index and the rest count
572  */
573
574 #define check_invalid_pos(viadev,pos) \
575         ((pos) < viadev->lastpos && ((pos) >= viadev->bufsize2 || viadev->lastpos < viadev->bufsize2))
576
577 static inline unsigned int calc_linear_pos(viadev_t *viadev, unsigned int idx, unsigned int count)
578 {
579         unsigned int size, res;
580
581         size = viadev->idx_table[idx].size;
582         res = viadev->idx_table[idx].offset + size - count;
583
584         /* check the validity of the calculated position */
585         if (size < count) {
586                 snd_printd(KERN_ERR "invalid via82xx_cur_ptr (size = %d, count = %d)\n", (int)size, (int)count);
587                 res = viadev->lastpos;
588         } else if (check_invalid_pos(viadev, res)) {
589 #ifdef POINTER_DEBUG
590                 printk("fail: idx = %i/%i, lastpos = 0x%x, bufsize2 = 0x%x, offsize = 0x%x, size = 0x%x, count = 0x%x\n", idx, viadev->tbl_entries, viadev->lastpos, viadev->bufsize2, viadev->idx_table[idx].offset, viadev->idx_table[idx].size, count);
591 #endif
592                 if (count && size < count) {
593                         snd_printd(KERN_ERR "invalid via82xx_cur_ptr, using last valid pointer\n");
594                         res = viadev->lastpos;
595                 } else {
596                         if (! count)
597                                 /* bogus count 0 on the DMA boundary? */
598                                 res = viadev->idx_table[idx].offset;
599                         else
600                                 /* count register returns full size when end of buffer is reached */
601                                 res = viadev->idx_table[idx].offset + size;
602                         if (check_invalid_pos(viadev, res)) {
603                                 snd_printd(KERN_ERR "invalid via82xx_cur_ptr (2), using last valid pointer\n");
604                                 res = viadev->lastpos;
605                         }
606                 }
607         }
608         viadev->lastpos = res; /* remember the last position */
609         if (res >= viadev->bufsize)
610                 res -= viadev->bufsize;
611         return res;
612 }
613
614 /*
615  * get the current pointer on via686
616  */
617 static snd_pcm_uframes_t snd_via686_pcm_pointer(snd_pcm_substream_t *substream)
618 {
619         via82xx_t *chip = snd_pcm_substream_chip(substream);
620         viadev_t *viadev = (viadev_t *)substream->runtime->private_data;
621         unsigned int idx, ptr, count, res;
622
623         snd_assert(viadev->tbl_entries, return 0);
624         if (!(inb(VIADEV_REG(viadev, OFFSET_STATUS)) & VIA_REG_STAT_ACTIVE))
625                 return 0;
626
627         spin_lock(&chip->reg_lock);
628         count = inl(VIADEV_REG(viadev, OFFSET_CURR_COUNT)) & 0xffffff;
629         /* The via686a does not have the current index register,
630          * so we need to calculate the index from CURR_PTR.
631          */
632         ptr = inl(VIADEV_REG(viadev, OFFSET_CURR_PTR));
633         if (ptr <= (unsigned int)viadev->table.addr)
634                 idx = 0;
635         else /* CURR_PTR holds the address + 8 */
636                 idx = ((ptr - (unsigned int)viadev->table.addr) / 8 - 1) % viadev->tbl_entries;
637         res = calc_linear_pos(viadev, idx, count);
638         spin_unlock(&chip->reg_lock);
639
640         return bytes_to_frames(substream->runtime, res);
641 }
642
643 /*
644  * hw_params callback:
645  * allocate the buffer and build up the buffer description table
646  */
647 static int snd_via82xx_hw_params(snd_pcm_substream_t * substream,
648                                  snd_pcm_hw_params_t * hw_params)
649 {
650         via82xx_t *chip = snd_pcm_substream_chip(substream);
651         viadev_t *viadev = (viadev_t *)substream->runtime->private_data;
652         int err;
653
654         err = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(hw_params));
655         if (err < 0)
656                 return err;
657         err = build_via_table(viadev, substream, chip->pci,
658                               params_periods(hw_params),
659                               params_period_bytes(hw_params));
660         if (err < 0)
661                 return err;
662
663         snd_ac97_write(chip->ac97, AC97_LINE1_RATE, params_rate(hw_params));
664         snd_ac97_write(chip->ac97, AC97_LINE1_LEVEL, 0);
665
666         return 0;
667 }
668
669 /*
670  * hw_free callback:
671  * clean up the buffer description table and release the buffer
672  */
673 static int snd_via82xx_hw_free(snd_pcm_substream_t * substream)
674 {
675         via82xx_t *chip = snd_pcm_substream_chip(substream);
676         viadev_t *viadev = (viadev_t *)substream->runtime->private_data;
677
678         clean_via_table(viadev, substream, chip->pci);
679         snd_pcm_lib_free_pages(substream);
680         return 0;
681 }
682
683
684 /*
685  * set up the table pointer
686  */
687 static void snd_via82xx_set_table_ptr(via82xx_t *chip, viadev_t *viadev)
688 {
689         snd_via82xx_codec_ready(chip, chip->ac97_secondary);
690         outl((u32)viadev->table.addr, VIADEV_REG(viadev, OFFSET_TABLE_PTR));
691         udelay(20);
692         snd_via82xx_codec_ready(chip, chip->ac97_secondary);
693 }
694
695 /*
696  * prepare callback for playback and capture
697  */
698 static int snd_via82xx_pcm_prepare(snd_pcm_substream_t *substream)
699 {
700         via82xx_t *chip = snd_pcm_substream_chip(substream);
701         viadev_t *viadev = (viadev_t *)substream->runtime->private_data;
702
703         snd_via82xx_channel_reset(chip, viadev);
704         /* this must be set after channel_reset */
705         snd_via82xx_set_table_ptr(chip, viadev);
706         outb(VIA_REG_TYPE_AUTOSTART|VIA_REG_TYPE_INT_EOL|VIA_REG_TYPE_INT_FLAG,
707              VIADEV_REG(viadev, OFFSET_TYPE));
708         return 0;
709 }
710
711 /*
712  * pcm hardware definition, identical for both playback and capture
713  */
714 static snd_pcm_hardware_t snd_via82xx_hw =
715 {
716         .info =                 (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
717                                  SNDRV_PCM_INFO_BLOCK_TRANSFER |
718                                  SNDRV_PCM_INFO_MMAP_VALID |
719                                  SNDRV_PCM_INFO_RESUME |
720                                  SNDRV_PCM_INFO_PAUSE),
721         .formats =              SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE,
722         .rates =                SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_KNOT,
723         .rate_min =             8000,
724         .rate_max =             16000,
725         .channels_min =         1,
726         .channels_max =         1,
727         .buffer_bytes_max =     128 * 1024,
728         .period_bytes_min =     32,
729         .period_bytes_max =     128 * 1024,
730         .periods_min =          2,
731         .periods_max =          VIA_TABLE_SIZE / 2,
732         .fifo_size =            0,
733 };
734
735
736 /*
737  * open callback skeleton
738  */
739 static int snd_via82xx_modem_pcm_open(via82xx_t *chip, viadev_t *viadev, snd_pcm_substream_t * substream)
740 {
741         snd_pcm_runtime_t *runtime = substream->runtime;
742         int err;
743         static unsigned int rates[] = { 8000,  9600, 12000, 16000 };
744         static snd_pcm_hw_constraint_list_t hw_constraints_rates = {
745                 .count = ARRAY_SIZE(rates),
746                 .list = rates,
747                 .mask = 0,
748         };
749
750         runtime->hw = snd_via82xx_hw;
751         
752         if ((err = snd_pcm_hw_constraint_list(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, &hw_constraints_rates)) < 0)
753                 return err;
754
755         /* we may remove following constaint when we modify table entries
756            in interrupt */
757         if ((err = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS)) < 0)
758                 return err;
759
760         runtime->private_data = viadev;
761         viadev->substream = substream;
762
763         return 0;
764 }
765
766
767 /*
768  * open callback for playback
769  */
770 static int snd_via82xx_playback_open(snd_pcm_substream_t * substream)
771 {
772         via82xx_t *chip = snd_pcm_substream_chip(substream);
773         viadev_t *viadev = &chip->devs[chip->playback_devno + substream->number];
774
775         return snd_via82xx_modem_pcm_open(chip, viadev, substream);
776 }
777
778 /*
779  * open callback for capture
780  */
781 static int snd_via82xx_capture_open(snd_pcm_substream_t * substream)
782 {
783         via82xx_t *chip = snd_pcm_substream_chip(substream);
784         viadev_t *viadev = &chip->devs[chip->capture_devno + substream->pcm->device];
785
786         return snd_via82xx_modem_pcm_open(chip, viadev, substream);
787 }
788
789 /*
790  * close callback
791  */
792 static int snd_via82xx_pcm_close(snd_pcm_substream_t * substream)
793 {
794         viadev_t *viadev = (viadev_t *)substream->runtime->private_data;
795
796         viadev->substream = NULL;
797         return 0;
798 }
799
800
801 /* via686 playback callbacks */
802 static snd_pcm_ops_t snd_via686_playback_ops = {
803         .open =         snd_via82xx_playback_open,
804         .close =        snd_via82xx_pcm_close,
805         .ioctl =        snd_pcm_lib_ioctl,
806         .hw_params =    snd_via82xx_hw_params,
807         .hw_free =      snd_via82xx_hw_free,
808         .prepare =      snd_via82xx_pcm_prepare,
809         .trigger =      snd_via82xx_modem_pcm_trigger,
810         .pointer =      snd_via686_pcm_pointer,
811         .page =         snd_pcm_sgbuf_ops_page,
812 };
813
814 /* via686 capture callbacks */
815 static snd_pcm_ops_t snd_via686_capture_ops = {
816         .open =         snd_via82xx_capture_open,
817         .close =        snd_via82xx_pcm_close,
818         .ioctl =        snd_pcm_lib_ioctl,
819         .hw_params =    snd_via82xx_hw_params,
820         .hw_free =      snd_via82xx_hw_free,
821         .prepare =      snd_via82xx_pcm_prepare,
822         .trigger =      snd_via82xx_modem_pcm_trigger,
823         .pointer =      snd_via686_pcm_pointer,
824         .page =         snd_pcm_sgbuf_ops_page,
825 };
826
827
828 static void init_viadev(via82xx_t *chip, int idx, unsigned int reg_offset, int direction)
829 {
830         chip->devs[idx].reg_offset = reg_offset;
831         chip->devs[idx].direction = direction;
832         chip->devs[idx].port = chip->port + reg_offset;
833 }
834
835 /*
836  * create a pcm instance for via686a/b
837  */
838 static int __devinit snd_via686_pcm_new(via82xx_t *chip)
839 {
840         snd_pcm_t *pcm;
841         int err;
842
843         chip->playback_devno = 0;
844         chip->capture_devno = 1;
845         chip->num_devs = 2;
846         chip->intr_mask = 0x330000; /* FLAGS | EOL for MR, MW */
847
848         err = snd_pcm_new(chip->card, chip->card->shortname, 0, 1, 1, &pcm);
849         if (err < 0)
850                 return err;
851         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_via686_playback_ops);
852         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_via686_capture_ops);
853         pcm->private_data = chip;
854         strcpy(pcm->name, chip->card->shortname);
855         chip->pcms[0] = pcm;
856         init_viadev(chip, 0, VIA_REG_MO_STATUS, 0);
857         init_viadev(chip, 1, VIA_REG_MI_STATUS, 1);
858
859         if ((err = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV_SG,
860                                                          snd_dma_pci_data(chip->pci), 64*1024, 128*1024)) < 0)
861                 return err;
862
863         return 0;
864 }
865
866
867 /*
868  *  Mixer part
869  */
870
871
872 static void snd_via82xx_mixer_free_ac97_bus(ac97_bus_t *bus)
873 {
874         via82xx_t *chip = bus->private_data;
875         chip->ac97_bus = NULL;
876 }
877
878 static void snd_via82xx_mixer_free_ac97(ac97_t *ac97)
879 {
880         via82xx_t *chip = ac97->private_data;
881         chip->ac97 = NULL;
882 }
883
884
885 static int __devinit snd_via82xx_mixer_new(via82xx_t *chip)
886 {
887         ac97_template_t ac97;
888         int err;
889         static ac97_bus_ops_t ops = {
890                 .write = snd_via82xx_codec_write,
891                 .read = snd_via82xx_codec_read,
892                 .wait = snd_via82xx_codec_wait,
893         };
894
895         if ((err = snd_ac97_bus(chip->card, 0, &ops, chip, &chip->ac97_bus)) < 0)
896                 return err;
897         chip->ac97_bus->private_free = snd_via82xx_mixer_free_ac97_bus;
898         chip->ac97_bus->clock = chip->ac97_clock;
899         chip->ac97_bus->shared_type = AC97_SHARED_TYPE_VIA;
900
901         memset(&ac97, 0, sizeof(ac97));
902         ac97.private_data = chip;
903         ac97.private_free = snd_via82xx_mixer_free_ac97;
904         ac97.pci = chip->pci;
905         ac97.scaps = AC97_SCAP_SKIP_AUDIO;
906         ac97.num = chip->ac97_secondary;
907
908         if ((err = snd_ac97_mixer(chip->ac97_bus, &ac97, &chip->ac97)) < 0)
909                 return err;
910
911         return 0;
912 }
913
914
915 /*
916  * proc interface
917  */
918 static void snd_via82xx_proc_read(snd_info_entry_t *entry, snd_info_buffer_t *buffer)
919 {
920         via82xx_t *chip = entry->private_data;
921         int i;
922         
923         snd_iprintf(buffer, "%s\n\n", chip->card->longname);
924         for (i = 0; i < 0xa0; i += 4) {
925                 snd_iprintf(buffer, "%02x: %08x\n", i, inl(chip->port + i));
926         }
927 }
928
929 static void __devinit snd_via82xx_proc_init(via82xx_t *chip)
930 {
931         snd_info_entry_t *entry;
932
933         if (! snd_card_proc_new(chip->card, "via82xx", &entry))
934                 snd_info_set_text_ops(entry, chip, 1024, snd_via82xx_proc_read);
935 }
936
937 /*
938  *
939  */
940
941 static int __devinit snd_via82xx_chip_init(via82xx_t *chip)
942 {
943         unsigned int val;
944         int max_count;
945         unsigned char pval;
946
947         pci_read_config_byte(chip->pci, VIA_MC97_CTRL, &pval);
948         if((pval & VIA_MC97_CTRL_INIT) != VIA_MC97_CTRL_INIT) {
949                 pci_write_config_byte(chip->pci, 0x44, pval|VIA_MC97_CTRL_INIT);
950                 udelay(100);
951         }
952
953         pci_read_config_byte(chip->pci, VIA_ACLINK_STAT, &pval);
954         if (! (pval & VIA_ACLINK_C00_READY)) { /* codec not ready? */
955                 /* deassert ACLink reset, force SYNC */
956                 pci_write_config_byte(chip->pci, VIA_ACLINK_CTRL,
957                                       VIA_ACLINK_CTRL_ENABLE |
958                                       VIA_ACLINK_CTRL_RESET |
959                                       VIA_ACLINK_CTRL_SYNC);
960                 udelay(100);
961 #if 1 /* FIXME: should we do full reset here for all chip models? */
962                 pci_write_config_byte(chip->pci, VIA_ACLINK_CTRL, 0x00);
963                 udelay(100);
964 #else
965                 /* deassert ACLink reset, force SYNC (warm AC'97 reset) */
966                 pci_write_config_byte(chip->pci, VIA_ACLINK_CTRL,
967                                       VIA_ACLINK_CTRL_RESET|VIA_ACLINK_CTRL_SYNC);
968                 udelay(2);
969 #endif
970                 /* ACLink on, deassert ACLink reset, VSR, SGD data out */
971                 pci_write_config_byte(chip->pci, VIA_ACLINK_CTRL, VIA_ACLINK_CTRL_INIT);
972                 udelay(100);
973         }
974         
975         pci_read_config_byte(chip->pci, VIA_ACLINK_CTRL, &pval);
976         if ((pval & VIA_ACLINK_CTRL_INIT) != VIA_ACLINK_CTRL_INIT) {
977                 /* ACLink on, deassert ACLink reset, VSR, SGD data out */
978                 pci_write_config_byte(chip->pci, VIA_ACLINK_CTRL, VIA_ACLINK_CTRL_INIT);
979                 udelay(100);
980         }
981
982         /* wait until codec ready */
983         max_count = ((3 * HZ) / 4) + 1;
984         do {
985                 pci_read_config_byte(chip->pci, VIA_ACLINK_STAT, &pval);
986                 if (pval & VIA_ACLINK_C00_READY) /* primary codec ready */
987                         break;
988                 set_current_state(TASK_UNINTERRUPTIBLE);
989                 schedule_timeout(1);
990         } while (--max_count > 0);
991
992         if ((val = snd_via82xx_codec_xread(chip)) & VIA_REG_AC97_BUSY)
993                 snd_printk("AC'97 codec is not ready [0x%x]\n", val);
994
995         snd_via82xx_codec_xwrite(chip, VIA_REG_AC97_READ |
996                                  VIA_REG_AC97_SECONDARY_VALID |
997                                  (VIA_REG_AC97_CODEC_ID_SECONDARY << VIA_REG_AC97_CODEC_ID_SHIFT));
998         max_count = ((3 * HZ) / 4) + 1;
999         snd_via82xx_codec_xwrite(chip, VIA_REG_AC97_READ |
1000                                  VIA_REG_AC97_SECONDARY_VALID |
1001                                  (VIA_REG_AC97_CODEC_ID_SECONDARY << VIA_REG_AC97_CODEC_ID_SHIFT));
1002         do {
1003                 if ((val = snd_via82xx_codec_xread(chip)) & VIA_REG_AC97_SECONDARY_VALID) {
1004                         chip->ac97_secondary = 1;
1005                         goto __ac97_ok2;
1006                 }
1007                 set_current_state(TASK_INTERRUPTIBLE);
1008                 schedule_timeout(1);
1009         } while (--max_count > 0);
1010         /* This is ok, the most of motherboards have only one codec */
1011
1012       __ac97_ok2:
1013
1014         /* route FM trap to IRQ, disable FM trap */
1015         // pci_write_config_byte(chip->pci, VIA_FM_NMI_CTRL, 0);
1016         /* disable all GPI interrupts */
1017         outl(0, VIAREG(chip, GPI_INTR));
1018
1019         return 0;
1020 }
1021
1022 #ifdef CONFIG_PM
1023 /*
1024  * power management
1025  */
1026 static int snd_via82xx_suspend(snd_card_t *card, pm_message_t state)
1027 {
1028         via82xx_t *chip = card->pm_private_data;
1029         int i;
1030
1031         for (i = 0; i < 2; i++)
1032                 if (chip->pcms[i])
1033                         snd_pcm_suspend_all(chip->pcms[i]);
1034         for (i = 0; i < chip->num_devs; i++)
1035                 snd_via82xx_channel_reset(chip, &chip->devs[i]);
1036         synchronize_irq(chip->irq);
1037         snd_ac97_suspend(chip->ac97);
1038         pci_set_power_state(chip->pci, 3);
1039         pci_disable_device(chip->pci);
1040         return 0;
1041 }
1042
1043 static int snd_via82xx_resume(snd_card_t *card)
1044 {
1045         via82xx_t *chip = card->pm_private_data;
1046         int i;
1047
1048         pci_enable_device(chip->pci);
1049         pci_set_power_state(chip->pci, 0);
1050         pci_set_master(chip->pci);
1051
1052         snd_via82xx_chip_init(chip);
1053
1054         snd_ac97_resume(chip->ac97);
1055
1056         for (i = 0; i < chip->num_devs; i++)
1057                 snd_via82xx_channel_reset(chip, &chip->devs[i]);
1058
1059         return 0;
1060 }
1061 #endif /* CONFIG_PM */
1062
1063 static int snd_via82xx_free(via82xx_t *chip)
1064 {
1065         unsigned int i;
1066
1067         if (chip->irq < 0)
1068                 goto __end_hw;
1069         /* disable interrupts */
1070         for (i = 0; i < chip->num_devs; i++)
1071                 snd_via82xx_channel_reset(chip, &chip->devs[i]);
1072         synchronize_irq(chip->irq);
1073       __end_hw:
1074         if (chip->irq >= 0)
1075                 free_irq(chip->irq, (void *)chip);
1076         pci_release_regions(chip->pci);
1077         pci_disable_device(chip->pci);
1078         kfree(chip);
1079         return 0;
1080 }
1081
1082 static int snd_via82xx_dev_free(snd_device_t *device)
1083 {
1084         via82xx_t *chip = device->device_data;
1085         return snd_via82xx_free(chip);
1086 }
1087
1088 static int __devinit snd_via82xx_create(snd_card_t * card,
1089                                         struct pci_dev *pci,
1090                                         int chip_type,
1091                                         int revision,
1092                                         unsigned int ac97_clock,
1093                                         via82xx_t ** r_via)
1094 {
1095         via82xx_t *chip;
1096         int err;
1097         static snd_device_ops_t ops = {
1098                 .dev_free =     snd_via82xx_dev_free,
1099         };
1100
1101         if ((err = pci_enable_device(pci)) < 0)
1102                 return err;
1103
1104         if ((chip = kcalloc(1, sizeof(*chip), GFP_KERNEL)) == NULL) {
1105                 pci_disable_device(pci);
1106                 return -ENOMEM;
1107         }
1108
1109         spin_lock_init(&chip->reg_lock);
1110         chip->card = card;
1111         chip->pci = pci;
1112         chip->irq = -1;
1113
1114         if ((err = pci_request_regions(pci, card->driver)) < 0) {
1115                 kfree(chip);
1116                 pci_disable_device(pci);
1117                 return err;
1118         }
1119         chip->port = pci_resource_start(pci, 0);
1120         if (request_irq(pci->irq, snd_via82xx_interrupt, SA_INTERRUPT|SA_SHIRQ,
1121                         card->driver, (void *)chip)) {
1122                 snd_printk("unable to grab IRQ %d\n", pci->irq);
1123                 snd_via82xx_free(chip);
1124                 return -EBUSY;
1125         }
1126         chip->irq = pci->irq;
1127         if (ac97_clock >= 8000 && ac97_clock <= 48000)
1128                 chip->ac97_clock = ac97_clock;
1129         synchronize_irq(chip->irq);
1130
1131         if ((err = snd_via82xx_chip_init(chip)) < 0) {
1132                 snd_via82xx_free(chip);
1133                 return err;
1134         }
1135
1136         if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops)) < 0) {
1137                 snd_via82xx_free(chip);
1138                 return err;
1139         }
1140
1141         /* The 8233 ac97 controller does not implement the master bit
1142          * in the pci command register. IMHO this is a violation of the PCI spec.
1143          * We call pci_set_master here because it does not hurt. */
1144         pci_set_master(pci);
1145
1146         snd_card_set_dev(card, &pci->dev);
1147
1148         *r_via = chip;
1149         return 0;
1150 }
1151
1152
1153 static int __devinit snd_via82xx_probe(struct pci_dev *pci,
1154                                        const struct pci_device_id *pci_id)
1155 {
1156         static int dev;
1157         snd_card_t *card;
1158         via82xx_t *chip;
1159         unsigned char revision;
1160         int chip_type = 0, card_type;
1161         unsigned int i;
1162         int err;
1163
1164         if (dev >= SNDRV_CARDS)
1165                 return -ENODEV;
1166         if (!enable[dev]) {
1167                 dev++;
1168                 return -ENOENT;
1169         }
1170
1171         card = snd_card_new(index[dev], id[dev], THIS_MODULE, 0);
1172         if (card == NULL)
1173                 return -ENOMEM;
1174
1175         card_type = pci_id->driver_data;
1176         pci_read_config_byte(pci, PCI_REVISION_ID, &revision);
1177         switch (card_type) {
1178         case TYPE_CARD_VIA82XX_MODEM:
1179                 strcpy(card->driver, "VIA82XX-MODEM");
1180                 sprintf(card->shortname, "VIA 82XX modem");
1181                 break;
1182         default:
1183                 snd_printk(KERN_ERR "invalid card type %d\n", card_type);
1184                 err = -EINVAL;
1185                 goto __error;
1186         }
1187                 
1188         if ((err = snd_via82xx_create(card, pci, chip_type, revision, ac97_clock[dev], &chip)) < 0)
1189                 goto __error;
1190         if ((err = snd_via82xx_mixer_new(chip)) < 0)
1191                 goto __error;
1192
1193         if ((err = snd_via686_pcm_new(chip)) < 0 )
1194                 goto __error;
1195
1196         snd_card_set_pm_callback(card, snd_via82xx_suspend, snd_via82xx_resume, chip);
1197
1198         /* disable interrupts */
1199         for (i = 0; i < chip->num_devs; i++)
1200                 snd_via82xx_channel_reset(chip, &chip->devs[i]);
1201
1202         sprintf(card->longname, "%s at 0x%lx, irq %d",
1203                 card->shortname, chip->port, chip->irq);
1204
1205         snd_via82xx_proc_init(chip);
1206
1207         if ((err = snd_card_register(card)) < 0) {
1208                 snd_card_free(card);
1209                 return err;
1210         }
1211         pci_set_drvdata(pci, card);
1212         dev++;
1213         return 0;
1214
1215  __error:
1216         snd_card_free(card);
1217         return err;
1218 }
1219
1220 static void __devexit snd_via82xx_remove(struct pci_dev *pci)
1221 {
1222         snd_card_free(pci_get_drvdata(pci));
1223         pci_set_drvdata(pci, NULL);
1224 }
1225
1226 static struct pci_driver driver = {
1227         .name = "VIA 82xx Modem",
1228         .id_table = snd_via82xx_modem_ids,
1229         .probe = snd_via82xx_probe,
1230         .remove = __devexit_p(snd_via82xx_remove),
1231         SND_PCI_PM_CALLBACKS
1232 };
1233
1234 static int __init alsa_card_via82xx_init(void)
1235 {
1236         return pci_module_init(&driver);
1237 }
1238
1239 static void __exit alsa_card_via82xx_exit(void)
1240 {
1241         pci_unregister_driver(&driver);
1242 }
1243
1244 module_init(alsa_card_via82xx_init)
1245 module_exit(alsa_card_via82xx_exit)