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 const struct pci_device_id 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 dev_info(card->dev, "XpressAudio at 0x%lx\n", sb_base);
164 else {
165 dev_err(card->dev, "Could not find XpressAudio!\n");
166 snd_cs5530_free(chip);
167 return -ENODEV;
168 }
169
170 if (map & (1<<5))
171 dev_info(card->dev, "MPU at 0x300\n");
172 else if (map & (1<<6))
173 dev_info(card->dev, "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 dev_err(card->dev, "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 dev_err(card->dev, "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 dev_err(card->dev, "SoundBlaster IRQ not set\n");
212 snd_cs5530_free(chip);
213 return -ENODEV;
214 }
215
216 dev_info(card->dev, "IRQ: %d DMA8: %d DMA16: %d\n", irq, dma8, dma16);
217
218 err = snd_sbdsp_create(card, sb_base, irq, snd_sb16dsp_interrupt, dma8,
219 dma16, SB_HW_CS5530, &chip->sb);
220 if (err < 0) {
221 dev_err(card->dev, "Could not create SoundBlaster\n");
222 snd_cs5530_free(chip);
223 return err;
224 }
225
226 err = snd_sb16dsp_pcm(chip->sb, 0);
227 if (err < 0) {
228 dev_err(card->dev, "Could not create PCM\n");
229 snd_cs5530_free(chip);
230 return err;
231 }
232
233 err = snd_sbmixer_new(chip->sb);
234 if (err < 0) {
235 dev_err(card->dev, "Could not create Mixer\n");
236 snd_cs5530_free(chip);
237 return err;
238 }
239
240 err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops);
241 if (err < 0) {
242 snd_cs5530_free(chip);
243 return err;
244 }
245
246 *rchip = chip;
247 return 0;
248}
249
250static int snd_cs5530_probe(struct pci_dev *pci,
251 const struct pci_device_id *pci_id)
252{
253 static int dev;
254 struct snd_card *card;
255 struct snd_cs5530 *chip = NULL;
256 int err;
257
258 if (dev >= SNDRV_CARDS)
259 return -ENODEV;
260 if (!enable[dev]) {
261 dev++;
262 return -ENOENT;
263 }
264
265 err = snd_card_new(&pci->dev, index[dev], id[dev], THIS_MODULE,
266 0, &card);
267
268 if (err < 0)
269 return err;
270
271 err = snd_cs5530_create(card, pci, &chip);
272 if (err < 0) {
273 snd_card_free(card);
274 return err;
275 }
276
277 strcpy(card->driver, "CS5530");
278 strcpy(card->shortname, "CS5530 Audio");
279 sprintf(card->longname, "%s at 0x%lx", card->shortname, chip->pci_base);
280
281 err = snd_card_register(card);
282 if (err < 0) {
283 snd_card_free(card);
284 return err;
285 }
286 pci_set_drvdata(pci, card);
287 dev++;
288 return 0;
289}
290
291static struct pci_driver cs5530_driver = {
292 .name = KBUILD_MODNAME,
293 .id_table = snd_cs5530_ids,
294 .probe = snd_cs5530_probe,
295 .remove = snd_cs5530_remove,
296};
297
298module_pci_driver(cs5530_driver);
299
