Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 1 | /* |
Jaya Kumar | 9ac2559 | 2006-04-28 14:34:49 +0200 | [diff] [blame] | 2 | * Driver for audio on multifunction CS5535/6 companion device |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 3 | * Copyright (C) Jaya Kumar |
| 4 | * |
| 5 | * Based on Jaroslav Kysela and Takashi Iwai's examples. |
| 6 | * This work was sponsored by CIS(M) Sdn Bhd. |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * the Free Software Foundation; either version 2 of the License, or |
| 11 | * (at your option) any later version. |
| 12 | * |
| 13 | * This program is distributed in the hope that it will be useful, |
| 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | * GNU General Public License for more details. |
| 17 | * |
| 18 | * You should have received a copy of the GNU General Public License |
| 19 | * along with this program; if not, write to the Free Software |
| 20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| 21 | * |
| 22 | */ |
| 23 | |
| 24 | #include <linux/delay.h> |
| 25 | #include <linux/interrupt.h> |
| 26 | #include <linux/init.h> |
| 27 | #include <linux/pci.h> |
| 28 | #include <linux/slab.h> |
| 29 | #include <linux/moduleparam.h> |
| 30 | #include <asm/io.h> |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 31 | #include <sound/core.h> |
| 32 | #include <sound/control.h> |
| 33 | #include <sound/pcm.h> |
| 34 | #include <sound/rawmidi.h> |
| 35 | #include <sound/ac97_codec.h> |
| 36 | #include <sound/initval.h> |
| 37 | #include <sound/asoundef.h> |
| 38 | #include "cs5535audio.h" |
| 39 | |
| 40 | #define DRIVER_NAME "cs5535audio" |
| 41 | |
Jaya Kumar | 9ac2559 | 2006-04-28 14:34:49 +0200 | [diff] [blame] | 42 | static char *ac97_quirk; |
| 43 | module_param(ac97_quirk, charp, 0444); |
| 44 | MODULE_PARM_DESC(ac97_quirk, "AC'97 board specific workarounds."); |
| 45 | |
| 46 | static struct ac97_quirk ac97_quirks[] __devinitdata = { |
| 47 | #if 0 /* Not yet confirmed if all 5536 boards are HP only */ |
| 48 | { |
| 49 | .subvendor = PCI_VENDOR_ID_AMD, |
| 50 | .subdevice = PCI_DEVICE_ID_AMD_CS5536_AUDIO, |
| 51 | .name = "AMD RDK", |
| 52 | .type = AC97_TUNE_HP_ONLY |
| 53 | }, |
| 54 | #endif |
| 55 | {} |
| 56 | }; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 57 | |
Takashi Iwai | 302e4c2 | 2006-05-23 13:24:30 +0200 | [diff] [blame] | 58 | static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; |
| 59 | static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; |
| 60 | static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 61 | |
Takashi Iwai | 302e4c2 | 2006-05-23 13:24:30 +0200 | [diff] [blame] | 62 | module_param_array(index, int, NULL, 0444); |
Takashi Iwai | 1dbfd8c | 2006-05-02 18:31:31 +0200 | [diff] [blame] | 63 | MODULE_PARM_DESC(index, "Index value for " DRIVER_NAME); |
Takashi Iwai | 302e4c2 | 2006-05-23 13:24:30 +0200 | [diff] [blame] | 64 | module_param_array(id, charp, NULL, 0444); |
Takashi Iwai | 1dbfd8c | 2006-05-02 18:31:31 +0200 | [diff] [blame] | 65 | MODULE_PARM_DESC(id, "ID string for " DRIVER_NAME); |
Takashi Iwai | 302e4c2 | 2006-05-23 13:24:30 +0200 | [diff] [blame] | 66 | module_param_array(enable, bool, NULL, 0444); |
| 67 | MODULE_PARM_DESC(enable, "Enable " DRIVER_NAME); |
Takashi Iwai | 1dbfd8c | 2006-05-02 18:31:31 +0200 | [diff] [blame] | 68 | |
Takashi Iwai | f40b689 | 2006-07-05 16:51:05 +0200 | [diff] [blame] | 69 | static struct pci_device_id snd_cs5535audio_ids[] = { |
Jaya Kumar | 9ac2559 | 2006-04-28 14:34:49 +0200 | [diff] [blame] | 70 | { PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_CS5535_AUDIO) }, |
| 71 | { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_CS5536_AUDIO) }, |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 72 | {} |
| 73 | }; |
| 74 | |
| 75 | MODULE_DEVICE_TABLE(pci, snd_cs5535audio_ids); |
| 76 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 77 | static void wait_till_cmd_acked(struct cs5535audio *cs5535au, unsigned long timeout) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 78 | { |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 79 | unsigned int tmp; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 80 | do { |
| 81 | tmp = cs_readl(cs5535au, ACC_CODEC_CNTL); |
| 82 | if (!(tmp & CMD_NEW)) |
| 83 | break; |
David Vrabel | 1037593 | 2006-03-03 18:01:57 +0100 | [diff] [blame] | 84 | udelay(1); |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 85 | } while (--timeout); |
| 86 | if (!timeout) |
| 87 | snd_printk(KERN_ERR "Failure writing to cs5535 codec\n"); |
| 88 | } |
| 89 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 90 | static unsigned short snd_cs5535audio_codec_read(struct cs5535audio *cs5535au, |
| 91 | unsigned short reg) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 92 | { |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 93 | unsigned int regdata; |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 94 | unsigned int timeout; |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 95 | unsigned int val; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 96 | |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 97 | regdata = ((unsigned int) reg) << 24; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 98 | regdata |= ACC_CODEC_CNTL_RD_CMD; |
| 99 | regdata |= CMD_NEW; |
| 100 | |
| 101 | cs_writel(cs5535au, ACC_CODEC_CNTL, regdata); |
David Vrabel | 1037593 | 2006-03-03 18:01:57 +0100 | [diff] [blame] | 102 | wait_till_cmd_acked(cs5535au, 50); |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 103 | |
| 104 | timeout = 50; |
| 105 | do { |
| 106 | val = cs_readl(cs5535au, ACC_CODEC_STATUS); |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 107 | if ((val & STS_NEW) && reg == (val >> 24)) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 108 | break; |
David Vrabel | 1037593 | 2006-03-03 18:01:57 +0100 | [diff] [blame] | 109 | udelay(1); |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 110 | } while (--timeout); |
| 111 | if (!timeout) |
Jaya Kumar | 40a4f7a | 2006-06-13 12:01:14 +0200 | [diff] [blame] | 112 | snd_printk(KERN_ERR "Failure reading codec reg 0x%x," |
| 113 | "Last value=0x%x\n", reg, val); |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 114 | |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 115 | return (unsigned short) val; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 116 | } |
| 117 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 118 | static void snd_cs5535audio_codec_write(struct cs5535audio *cs5535au, |
| 119 | unsigned short reg, unsigned short val) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 120 | { |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 121 | unsigned int regdata; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 122 | |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 123 | regdata = ((unsigned int) reg) << 24; |
| 124 | regdata |= val; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 125 | regdata &= CMD_MASK; |
| 126 | regdata |= CMD_NEW; |
| 127 | regdata &= ACC_CODEC_CNTL_WR_CMD; |
| 128 | |
| 129 | cs_writel(cs5535au, ACC_CODEC_CNTL, regdata); |
| 130 | wait_till_cmd_acked(cs5535au, 50); |
| 131 | } |
| 132 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 133 | static void snd_cs5535audio_ac97_codec_write(struct snd_ac97 *ac97, |
| 134 | unsigned short reg, unsigned short val) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 135 | { |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 136 | struct cs5535audio *cs5535au = ac97->private_data; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 137 | snd_cs5535audio_codec_write(cs5535au, reg, val); |
| 138 | } |
| 139 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 140 | static unsigned short snd_cs5535audio_ac97_codec_read(struct snd_ac97 *ac97, |
| 141 | unsigned short reg) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 142 | { |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 143 | struct cs5535audio *cs5535au = ac97->private_data; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 144 | return snd_cs5535audio_codec_read(cs5535au, reg); |
| 145 | } |
| 146 | |
Randy Dunlap | 5be55be | 2008-01-23 11:52:06 +0100 | [diff] [blame] | 147 | static int __devinit snd_cs5535audio_mixer(struct cs5535audio *cs5535au) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 148 | { |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 149 | struct snd_card *card = cs5535au->card; |
| 150 | struct snd_ac97_bus *pbus; |
| 151 | struct snd_ac97_template ac97; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 152 | int err; |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 153 | static struct snd_ac97_bus_ops ops = { |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 154 | .write = snd_cs5535audio_ac97_codec_write, |
| 155 | .read = snd_cs5535audio_ac97_codec_read, |
| 156 | }; |
| 157 | |
| 158 | if ((err = snd_ac97_bus(card, 0, &ops, NULL, &pbus)) < 0) |
| 159 | return err; |
| 160 | |
| 161 | memset(&ac97, 0, sizeof(ac97)); |
Jaya Kumar | b035ce0 | 2008-11-05 17:30:08 -0500 | [diff] [blame] | 162 | ac97.scaps = AC97_SCAP_AUDIO | AC97_SCAP_SKIP_MODEM |
| 163 | | AC97_SCAP_POWER_SAVE; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 164 | ac97.private_data = cs5535au; |
| 165 | ac97.pci = cs5535au->pci; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 166 | |
Andres Salomon | 3556d18 | 2008-11-06 16:44:08 -0500 | [diff] [blame] | 167 | /* set any OLPC-specific scaps */ |
| 168 | olpc_prequirks(card, &ac97); |
| 169 | |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 170 | if ((err = snd_ac97_mixer(pbus, &ac97, &cs5535au->ac97)) < 0) { |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 171 | snd_printk(KERN_ERR "mixer failed\n"); |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 172 | return err; |
| 173 | } |
| 174 | |
Jaya Kumar | 9ac2559 | 2006-04-28 14:34:49 +0200 | [diff] [blame] | 175 | snd_ac97_tune_hardware(cs5535au->ac97, ac97_quirks, ac97_quirk); |
| 176 | |
Jaya Kumar | 57d4bf6 | 2008-11-06 16:43:34 -0500 | [diff] [blame] | 177 | err = olpc_quirks(card, cs5535au->ac97); |
| 178 | if (err < 0) { |
| 179 | snd_printk(KERN_ERR "olpc quirks failed\n"); |
| 180 | return err; |
| 181 | } |
| 182 | |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 183 | return 0; |
| 184 | } |
| 185 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 186 | static void process_bm0_irq(struct cs5535audio *cs5535au) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 187 | { |
| 188 | u8 bm_stat; |
| 189 | spin_lock(&cs5535au->reg_lock); |
| 190 | bm_stat = cs_readb(cs5535au, ACC_BM0_STATUS); |
| 191 | spin_unlock(&cs5535au->reg_lock); |
| 192 | if (bm_stat & EOP) { |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 193 | struct cs5535audio_dma *dma; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 194 | dma = cs5535au->playback_substream->runtime->private_data; |
| 195 | snd_pcm_period_elapsed(cs5535au->playback_substream); |
| 196 | } else { |
| 197 | snd_printk(KERN_ERR "unexpected bm0 irq src, bm_stat=%x\n", |
| 198 | bm_stat); |
| 199 | } |
| 200 | } |
| 201 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 202 | static void process_bm1_irq(struct cs5535audio *cs5535au) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 203 | { |
| 204 | u8 bm_stat; |
| 205 | spin_lock(&cs5535au->reg_lock); |
| 206 | bm_stat = cs_readb(cs5535au, ACC_BM1_STATUS); |
| 207 | spin_unlock(&cs5535au->reg_lock); |
| 208 | if (bm_stat & EOP) { |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 209 | struct cs5535audio_dma *dma; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 210 | dma = cs5535au->capture_substream->runtime->private_data; |
| 211 | snd_pcm_period_elapsed(cs5535au->capture_substream); |
| 212 | } |
| 213 | } |
| 214 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 215 | static irqreturn_t snd_cs5535audio_interrupt(int irq, void *dev_id) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 216 | { |
| 217 | u16 acc_irq_stat; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 218 | unsigned char count; |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 219 | struct cs5535audio *cs5535au = dev_id; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 220 | |
| 221 | if (cs5535au == NULL) |
| 222 | return IRQ_NONE; |
| 223 | |
| 224 | acc_irq_stat = cs_readw(cs5535au, ACC_IRQ_STATUS); |
| 225 | |
| 226 | if (!acc_irq_stat) |
| 227 | return IRQ_NONE; |
Andres Salomon | 4ea2416 | 2007-09-03 15:43:43 +0200 | [diff] [blame] | 228 | for (count = 0; count < 4; count++) { |
Takashi Iwai | 3e87317 | 2005-11-17 10:15:37 +0100 | [diff] [blame] | 229 | if (acc_irq_stat & (1 << count)) { |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 230 | switch (count) { |
| 231 | case IRQ_STS: |
| 232 | cs_readl(cs5535au, ACC_GPIO_STATUS); |
| 233 | break; |
| 234 | case WU_IRQ_STS: |
| 235 | cs_readl(cs5535au, ACC_GPIO_STATUS); |
| 236 | break; |
| 237 | case BM0_IRQ_STS: |
| 238 | process_bm0_irq(cs5535au); |
| 239 | break; |
| 240 | case BM1_IRQ_STS: |
| 241 | process_bm1_irq(cs5535au); |
| 242 | break; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 243 | default: |
Andres Salomon | 4ea2416 | 2007-09-03 15:43:43 +0200 | [diff] [blame] | 244 | snd_printk(KERN_ERR "Unexpected irq src: " |
| 245 | "0x%x\n", acc_irq_stat); |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 246 | break; |
| 247 | } |
| 248 | } |
| 249 | } |
| 250 | return IRQ_HANDLED; |
| 251 | } |
| 252 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 253 | static int snd_cs5535audio_free(struct cs5535audio *cs5535au) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 254 | { |
| 255 | synchronize_irq(cs5535au->irq); |
| 256 | pci_set_power_state(cs5535au->pci, 3); |
| 257 | |
| 258 | if (cs5535au->irq >= 0) |
| 259 | free_irq(cs5535au->irq, cs5535au); |
| 260 | |
| 261 | pci_release_regions(cs5535au->pci); |
| 262 | pci_disable_device(cs5535au->pci); |
| 263 | kfree(cs5535au); |
| 264 | return 0; |
| 265 | } |
| 266 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 267 | static int snd_cs5535audio_dev_free(struct snd_device *device) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 268 | { |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 269 | struct cs5535audio *cs5535au = device->device_data; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 270 | return snd_cs5535audio_free(cs5535au); |
| 271 | } |
| 272 | |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 273 | static int __devinit snd_cs5535audio_create(struct snd_card *card, |
| 274 | struct pci_dev *pci, |
| 275 | struct cs5535audio **rcs5535au) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 276 | { |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 277 | struct cs5535audio *cs5535au; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 278 | |
| 279 | int err; |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 280 | static struct snd_device_ops ops = { |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 281 | .dev_free = snd_cs5535audio_dev_free, |
| 282 | }; |
| 283 | |
| 284 | *rcs5535au = NULL; |
| 285 | if ((err = pci_enable_device(pci)) < 0) |
| 286 | return err; |
| 287 | |
Yang Hongyang | 284901a | 2009-04-06 19:01:15 -0700 | [diff] [blame] | 288 | if (pci_set_dma_mask(pci, DMA_BIT_MASK(32)) < 0 || |
| 289 | pci_set_consistent_dma_mask(pci, DMA_BIT_MASK(32)) < 0) { |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 290 | printk(KERN_WARNING "unable to get 32bit dma\n"); |
| 291 | err = -ENXIO; |
| 292 | goto pcifail; |
| 293 | } |
| 294 | |
| 295 | cs5535au = kzalloc(sizeof(*cs5535au), GFP_KERNEL); |
| 296 | if (cs5535au == NULL) { |
| 297 | err = -ENOMEM; |
| 298 | goto pcifail; |
| 299 | } |
| 300 | |
| 301 | spin_lock_init(&cs5535au->reg_lock); |
| 302 | cs5535au->card = card; |
| 303 | cs5535au->pci = pci; |
| 304 | cs5535au->irq = -1; |
| 305 | |
| 306 | if ((err = pci_request_regions(pci, "CS5535 Audio")) < 0) { |
| 307 | kfree(cs5535au); |
| 308 | goto pcifail; |
| 309 | } |
| 310 | |
| 311 | cs5535au->port = pci_resource_start(pci, 0); |
| 312 | |
| 313 | if (request_irq(pci->irq, snd_cs5535audio_interrupt, |
Takashi Iwai | 437a5a4 | 2006-11-21 12:14:23 +0100 | [diff] [blame] | 314 | IRQF_SHARED, "CS5535 Audio", cs5535au)) { |
Takashi Iwai | ee41965 | 2009-02-05 16:11:31 +0100 | [diff] [blame] | 315 | snd_printk(KERN_ERR "unable to grab IRQ %d\n", pci->irq); |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 316 | err = -EBUSY; |
| 317 | goto sndfail; |
| 318 | } |
| 319 | |
| 320 | cs5535au->irq = pci->irq; |
| 321 | pci_set_master(pci); |
| 322 | |
| 323 | if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 324 | cs5535au, &ops)) < 0) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 325 | goto sndfail; |
| 326 | |
| 327 | snd_card_set_dev(card, &pci->dev); |
| 328 | |
| 329 | *rcs5535au = cs5535au; |
| 330 | return 0; |
| 331 | |
| 332 | sndfail: /* leave the device alive, just kill the snd */ |
| 333 | snd_cs5535audio_free(cs5535au); |
| 334 | return err; |
| 335 | |
| 336 | pcifail: |
| 337 | pci_disable_device(pci); |
| 338 | return err; |
| 339 | } |
| 340 | |
| 341 | static int __devinit snd_cs5535audio_probe(struct pci_dev *pci, |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 342 | const struct pci_device_id *pci_id) |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 343 | { |
| 344 | static int dev; |
Takashi Iwai | 66f8df6 | 2005-11-17 14:56:21 +0100 | [diff] [blame] | 345 | struct snd_card *card; |
| 346 | struct cs5535audio *cs5535au; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 347 | int err; |
| 348 | |
| 349 | if (dev >= SNDRV_CARDS) |
| 350 | return -ENODEV; |
Takashi Iwai | 302e4c2 | 2006-05-23 13:24:30 +0200 | [diff] [blame] | 351 | if (!enable[dev]) { |
| 352 | dev++; |
| 353 | return -ENOENT; |
| 354 | } |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 355 | |
Takashi Iwai | e58de7b | 2008-12-28 16:44:30 +0100 | [diff] [blame] | 356 | err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card); |
| 357 | if (err < 0) |
| 358 | return err; |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 359 | |
| 360 | if ((err = snd_cs5535audio_create(card, pci, &cs5535au)) < 0) |
| 361 | goto probefail_out; |
| 362 | |
Jaya Kumar | 9ac2559 | 2006-04-28 14:34:49 +0200 | [diff] [blame] | 363 | card->private_data = cs5535au; |
| 364 | |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 365 | if ((err = snd_cs5535audio_mixer(cs5535au)) < 0) |
| 366 | goto probefail_out; |
| 367 | |
| 368 | if ((err = snd_cs5535audio_pcm(cs5535au)) < 0) |
| 369 | goto probefail_out; |
| 370 | |
| 371 | strcpy(card->driver, DRIVER_NAME); |
| 372 | |
| 373 | strcpy(card->shortname, "CS5535 Audio"); |
| 374 | sprintf(card->longname, "%s %s at 0x%lx, irq %i", |
| 375 | card->shortname, card->driver, |
| 376 | cs5535au->port, cs5535au->irq); |
| 377 | |
| 378 | if ((err = snd_card_register(card)) < 0) |
| 379 | goto probefail_out; |
| 380 | |
| 381 | pci_set_drvdata(pci, card); |
| 382 | dev++; |
| 383 | return 0; |
| 384 | |
| 385 | probefail_out: |
| 386 | snd_card_free(card); |
| 387 | return err; |
| 388 | } |
| 389 | |
| 390 | static void __devexit snd_cs5535audio_remove(struct pci_dev *pci) |
| 391 | { |
| 392 | snd_card_free(pci_get_drvdata(pci)); |
| 393 | pci_set_drvdata(pci, NULL); |
| 394 | } |
| 395 | |
| 396 | static struct pci_driver driver = { |
| 397 | .name = DRIVER_NAME, |
| 398 | .id_table = snd_cs5535audio_ids, |
| 399 | .probe = snd_cs5535audio_probe, |
| 400 | .remove = __devexit_p(snd_cs5535audio_remove), |
Jaya Kumar | 9ac2559 | 2006-04-28 14:34:49 +0200 | [diff] [blame] | 401 | #ifdef CONFIG_PM |
| 402 | .suspend = snd_cs5535audio_suspend, |
| 403 | .resume = snd_cs5535audio_resume, |
| 404 | #endif |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 405 | }; |
| 406 | |
| 407 | static int __init alsa_card_cs5535audio_init(void) |
| 408 | { |
Ben Gardner | e329113 | 2006-01-09 20:51:29 -0800 | [diff] [blame] | 409 | return pci_register_driver(&driver); |
Jaya Kumar | 9b4ffa4 | 2005-11-17 10:12:23 +0100 | [diff] [blame] | 410 | } |
| 411 | |
| 412 | static void __exit alsa_card_cs5535audio_exit(void) |
| 413 | { |
| 414 | pci_unregister_driver(&driver); |
| 415 | } |
| 416 | |
| 417 | module_init(alsa_card_cs5535audio_init) |
| 418 | module_exit(alsa_card_cs5535audio_exit) |
| 419 | |
| 420 | MODULE_AUTHOR("Jaya Kumar"); |
| 421 | MODULE_LICENSE("GPL"); |
| 422 | MODULE_DESCRIPTION("CS5535 Audio"); |
| 423 | MODULE_SUPPORTED_DEVICE("CS5535 Audio"); |