1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39#include <linux/delay.h>
40#include <linux/module.h>
41#include <linux/pci.h>
42#include <linux/slab.h>
43#include <sound/core.h>
44#include <sound/sb.h>
45#include <sound/initval.h>
46
47MODULE_AUTHOR("Ash Willis");
48MODULE_DESCRIPTION("CS5530 Audio");
49MODULE_LICENSE("GPL");
50
51static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
52static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
53static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
54
55module_param_array(index, int, NULL, 0444);
56MODULE_PARM_DESC(index, "Index value for CS5530 Audio driver.");
57module_param_array(id, charp, NULL, 0444);
58MODULE_PARM_DESC(id, "ID string for CS5530 Audio driver.");
59module_param_array(enable, bool, NULL, 0444);
60MODULE_PARM_DESC(enable, "Enable CS5530 Audio driver.");
61
62struct snd_cs5530 {
63 struct snd_card *card;
64 struct pci_dev *pci;
65 struct snd_sb *sb;
66 unsigned long pci_base;
67};
68
69static DEFINE_PCI_DEVICE_TABLE(snd_cs5530_ids) = {
70 {PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5530_AUDIO, PCI_ANY_ID,
71 PCI_ANY_ID, 0, 0},
72 {0,}
73};
74
75MODULE_DEVICE_TABLE(pci, snd_cs5530_ids);
76
77static int snd_cs5530_free(struct snd_cs5530 *chip)
78{
79 pci_release_regions(chip->pci);
80 pci_disable_device(chip->pci);
81 kfree(chip);
82 return 0;
83}
84
85static int snd_cs5530_dev_free(struct snd_device *device)
86{
87 struct snd_cs5530 *chip = device->device_data;
88 return snd_cs5530_free(chip);
89}
90
91static void snd_cs5530_remove(struct pci_dev *pci)
92{
93 snd_card_free(pci_get_drvdata(pci));
94}
95
96static u8 snd_cs5530_mixer_read(unsigned long io, u8 reg)
97{
98 outb(reg, io + 4);
99 udelay(20);
100 reg = inb(io + 5);
101 udelay(20);
102 return reg;
103}
104
105static int snd_cs5530_create(struct snd_card *card,
106 struct pci_dev *pci,
107 struct snd_cs5530 **rchip)
108{
109 struct snd_cs5530 *chip;
110 unsigned long sb_base;
111 u8 irq, dma8, dma16 = 0;
112 u16 map;
113 void __iomem *mem;
114 int err;
115
116 static struct snd_device_ops ops = {
117 .dev_free = snd_cs5530_dev_free,
118 };
119 *rchip = NULL;
120
121 err = pci_enable_device(pci);
122 if (err < 0)
123 return err;
124
125 chip = kzalloc(sizeof(*chip), GFP_KERNEL);
126 if (chip == NULL) {
127 pci_disable_device(pci);
128 return -ENOMEM;
129 }
130
131 chip->card = card;
132 chip->pci = pci;
133
134 err = pci_request_regions(pci, "CS5530");
135 if (err < 0) {
136 kfree(chip);
137 pci_disable_device(pci);
138 return err;
139 }
140 chip->pci_base = pci_resource_start(pci, 0);
141
142 mem = pci_ioremap_bar(pci, 0);
143 if (mem == NULL) {
144 snd_cs5530_free(chip);
145 return -EBUSY;
146 }
147
148 map = readw(mem + 0x18);
149 iounmap(mem);
150
151
152
153
154
155
156
157
158
159
160 sb_base = 0x220 + 0x20 * (map & 3);
161
162 if (map & (1<<2))
163 printk(KERN_INFO "CS5530: XpressAudio at 0x%lx\n", sb_base);
164 else {
165 printk(KERN_ERR "Could not find XpressAudio!\n");
166 snd_cs5530_free(chip);
167 return -ENODEV;
168 }
169
170 if (map & (1<<5))
171 printk(KERN_INFO "CS5530: MPU at 0x300\n");
172 else if (map & (1<<6))
173 printk(KERN_INFO "CS5530: MPU at 0x330\n");
174
175 irq = snd_cs5530_mixer_read(sb_base, 0x80) & 0x0F;
176 dma8 = snd_cs5530_mixer_read(sb_base, 0x81);
177
178 if (dma8 & 0x20)
179 dma16 = 5;
180 else if (dma8 & 0x40)
181 dma16 = 6;
182 else if (dma8 & 0x80)
183 dma16 = 7;
184 else {
185 printk(KERN_ERR "CS5530: No 16bit DMA enabled\n");
186 snd_cs5530_free(chip);
187 return -ENODEV;
188 }
189
190 if (dma8 & 0x01)
191 dma8 = 0;
192 else if (dma8 & 02)
193 dma8 = 1;
194 else if (dma8 & 0x08)
195 dma8 = 3;
196 else {
197 printk(KERN_ERR "CS5530: No 8bit DMA enabled\n");
198 snd_cs5530_free(chip);
199 return -ENODEV;
200 }
201
202 if (irq & 1)
203 irq = 9;
204 else if (irq & 2)
205 irq = 5;
206 else if (irq & 4)
207 irq = 7;
208 else if (irq & 8)
209 irq = 10;
210 else {
211 printk(KERN_ERR "CS5530: SoundBlaster IRQ not set\n");
212 snd_cs5530_free(chip);
213 return -ENODEV;
214 }
215
216 printk(KERN_INFO "CS5530: IRQ: %d DMA8: %d DMA16: %d\n", irq, dma8,
217 dma16);
218
219 err = snd_sbdsp_create(card, sb_base, irq, snd_sb16dsp_interrupt, dma8,
220 dma16, SB_HW_CS5530, &chip->sb);
221 if (err < 0) {
222 printk(KERN_ERR "CS5530: Could not create SoundBlaster\n");
223 snd_cs5530_free(chip);
224 return err;
225 }
226
227 err = snd_sb16dsp_pcm(chip->sb, 0, &chip->sb->pcm);
228 if (err < 0) {
229 printk(KERN_ERR "CS5530: Could not create PCM\n");
230 snd_cs5530_free(chip);
231 return err;
232 }
233
234 err = snd_sbmixer_new(chip->sb);
235 if (err < 0) {
236 printk(KERN_ERR "CS5530: Could not create Mixer\n");
237 snd_cs5530_free(chip);
238 return err;
239 }
240
241 err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops);
242 if (err < 0) {
243 snd_cs5530_free(chip);
244 return err;
245 }
246
247 snd_card_set_dev(card, &pci->dev);
248 *rchip = chip;
249 return 0;
250}
251
252static int snd_cs5530_probe(struct pci_dev *pci,
253 const struct pci_device_id *pci_id)
254{
255 static int dev;
256 struct snd_card *card;
257 struct snd_cs5530 *chip = NULL;
258 int err;
259
260 if (dev >= SNDRV_CARDS)
261 return -ENODEV;
262 if (!enable[dev]) {
263 dev++;
264 return -ENOENT;
265 }
266
267 err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card);
268
269 if (err < 0)
270 return err;
271
272 err = snd_cs5530_create(card, pci, &chip);
273 if (err < 0) {
274 snd_card_free(card);
275 return err;
276 }
277
278 strcpy(card->driver, "CS5530");
279 strcpy(card->shortname, "CS5530 Audio");
280 sprintf(card->longname, "%s at 0x%lx", card->shortname, chip->pci_base);
281
282 err = snd_card_register(card);
283 if (err < 0) {
284 snd_card_free(card);
285 return err;
286 }
287 pci_set_drvdata(pci, card);
288 dev++;
289 return 0;
290}
291
292static struct pci_driver cs5530_driver = {
293 .name = KBUILD_MODNAME,
294 .id_table = snd_cs5530_ids,
295 .probe = snd_cs5530_probe,
296 .remove = snd_cs5530_remove,
297};
298
299module_pci_driver(cs5530_driver);
300