Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | { |
Takashi Iwai | 01d25d4 | 2005-04-11 16:58:24 +0200 | [diff] [blame^] | 1236 | return pci_register_driver(&driver); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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) |