?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
vmalloc: fix __GFP_HIGHMEM usage for vmalloc_32 on 32b systems
[linux/fpc-iii.git] / sound / pci / lola / lola.c
blob9ff6000849732cdb66a80fc8aaad81eb38a77327
1 /*
2 * Support for Digigram Lola PCI-e boards
3 *
4 * Copyright (c) 2011 Takashi Iwai <tiwai@suse.de>
5 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published by the Free
8 * Software Foundation; either version 2 of the License, or (at your option)
9 * any later version.
10 *
11 * This program is distributed in the hope that it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * more details.
15 *
16 * You should have received a copy of the GNU General Public License along with
17 * this program; if not, write to the Free Software Foundation, Inc., 59
18 * Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19 */
20
21 #include <linux/kernel.h>
22 #include <linux/init.h>
23 #include <linux/module.h>
24 #include <linux/dma-mapping.h>
25 #include <linux/delay.h>
26 #include <linux/interrupt.h>
27 #include <linux/slab.h>
28 #include <linux/pci.h>
29 #include <sound/core.h>
30 #include <sound/control.h>
31 #include <sound/pcm.h>
32 #include <sound/initval.h>
33 #include "lola.h"
34
35 /* Standard options */
36 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
37 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
38 static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
39
40 module_param_array(index, int, NULL, 0444);
41 MODULE_PARM_DESC(index, "Index value for Digigram Lola driver.");
42 module_param_array(id, charp, NULL, 0444);
43 MODULE_PARM_DESC(id, "ID string for Digigram Lola driver.");
44 module_param_array(enable, bool, NULL, 0444);
45 MODULE_PARM_DESC(enable, "Enable Digigram Lola driver.");
46
47 /* Lola-specific options */
48
49 /* for instance use always max granularity which is compatible
50 * with all sample rates
51 */
52 static int granularity[SNDRV_CARDS] = {
53 [0 ... (SNDRV_CARDS - 1)] = LOLA_GRANULARITY_MAX
54 };
55
56 /* below a sample_rate of 16kHz the analogue audio quality is NOT excellent */
57 static int sample_rate_min[SNDRV_CARDS] = {
58 [0 ... (SNDRV_CARDS - 1) ] = 16000
59 };
60
61 module_param_array(granularity, int, NULL, 0444);
62 MODULE_PARM_DESC(granularity, "Granularity value");
63 module_param_array(sample_rate_min, int, NULL, 0444);
64 MODULE_PARM_DESC(sample_rate_min, "Minimal sample rate");
65
66 /*
67 */
68
69 MODULE_LICENSE("GPL");
70 MODULE_SUPPORTED_DEVICE("{{Digigram, Lola}}");
71 MODULE_DESCRIPTION("Digigram Lola driver");
72 MODULE_AUTHOR("Takashi Iwai <tiwai@suse.de>");
73
74 #ifdef CONFIG_SND_DEBUG_VERBOSE
75 static int debug;
76 module_param(debug, int, 0644);
77 #define verbose_debug(fmt, args...) \
78 do { if (debug > 1) pr_debug(SFX fmt, ##args); } while (0)
79 #else
80 #define verbose_debug(fmt, args...)
81 #endif
82
83 /*
84 * pseudo-codec read/write via CORB/RIRB
85 */
86
87 static int corb_send_verb(struct lola *chip, unsigned int nid,
88 unsigned int verb, unsigned int data,
89 unsigned int extdata)
90 {
91 unsigned long flags;
92 int ret = -EIO;
93
94 chip->last_cmd_nid = nid;
95 chip->last_verb = verb;
96 chip->last_data = data;
97 chip->last_extdata = extdata;
98 data |= (nid << 20) | (verb << 8);
99
100 spin_lock_irqsave(&chip->reg_lock, flags);
101 if (chip->rirb.cmds < LOLA_CORB_ENTRIES - 1) {
102 unsigned int wp = chip->corb.wp + 1;
103 wp %= LOLA_CORB_ENTRIES;
104 chip->corb.wp = wp;
105 chip->corb.buf[wp * 2] = cpu_to_le32(data);
106 chip->corb.buf[wp * 2 + 1] = cpu_to_le32(extdata);
107 lola_writew(chip, BAR0, CORBWP, wp);
108 chip->rirb.cmds++;
109 smp_wmb();
110 ret = 0;
111 }
112 spin_unlock_irqrestore(&chip->reg_lock, flags);
113 return ret;
114 }
115
116 static void lola_queue_unsol_event(struct lola *chip, unsigned int res,
117 unsigned int res_ex)
118 {
119 lola_update_ext_clock_freq(chip, res);
120 }
121
122 /* retrieve RIRB entry - called from interrupt handler */
123 static void lola_update_rirb(struct lola *chip)
124 {
125 unsigned int rp, wp;
126 u32 res, res_ex;
127
128 wp = lola_readw(chip, BAR0, RIRBWP);
129 if (wp == chip->rirb.wp)
130 return;
131 chip->rirb.wp = wp;
132
133 while (chip->rirb.rp != wp) {
134 chip->rirb.rp++;
135 chip->rirb.rp %= LOLA_CORB_ENTRIES;
136
137 rp = chip->rirb.rp << 1; /* an RIRB entry is 8-bytes */
138 res_ex = le32_to_cpu(chip->rirb.buf[rp + 1]);
139 res = le32_to_cpu(chip->rirb.buf[rp]);
140 if (res_ex & LOLA_RIRB_EX_UNSOL_EV)
141 lola_queue_unsol_event(chip, res, res_ex);
142 else if (chip->rirb.cmds) {
143 chip->res = res;
144 chip->res_ex = res_ex;
145 smp_wmb();
146 chip->rirb.cmds--;
147 }
148 }
149 }
150
151 static int rirb_get_response(struct lola *chip, unsigned int *val,
152 unsigned int *extval)
153 {
154 unsigned long timeout;
155
156 again:
157 timeout = jiffies + msecs_to_jiffies(1000);
158 for (;;) {
159 if (chip->polling_mode) {
160 spin_lock_irq(&chip->reg_lock);
161 lola_update_rirb(chip);
162 spin_unlock_irq(&chip->reg_lock);
163 }
164 if (!chip->rirb.cmds) {
165 *val = chip->res;
166 if (extval)
167 *extval = chip->res_ex;
168 verbose_debug("get_response: %x, %x\n",
169 chip->res, chip->res_ex);
170 if (chip->res_ex & LOLA_RIRB_EX_ERROR) {
171 dev_warn(chip->card->dev, "RIRB ERROR: "
172 "NID=%x, verb=%x, data=%x, ext=%x\n",
173 chip->last_cmd_nid,
174 chip->last_verb, chip->last_data,
175 chip->last_extdata);
176 return -EIO;
177 }
178 return 0;
179 }
180 if (time_after(jiffies, timeout))
181 break;
182 udelay(20);
183 cond_resched();
184 }
185 dev_warn(chip->card->dev, "RIRB response error\n");
186 if (!chip->polling_mode) {
187 dev_warn(chip->card->dev, "switching to polling mode\n");
188 chip->polling_mode = 1;
189 goto again;
190 }
191 return -EIO;
192 }
193
194 /* aynchronous write of a codec verb with data */
195 int lola_codec_write(struct lola *chip, unsigned int nid, unsigned int verb,
196 unsigned int data, unsigned int extdata)
197 {
198 verbose_debug("codec_write NID=%x, verb=%x, data=%x, ext=%x\n",
199 nid, verb, data, extdata);
200 return corb_send_verb(chip, nid, verb, data, extdata);
201 }
202
203 /* write a codec verb with data and read the returned status */
204 int lola_codec_read(struct lola *chip, unsigned int nid, unsigned int verb,
205 unsigned int data, unsigned int extdata,
206 unsigned int *val, unsigned int *extval)
207 {
208 int err;
209
210 verbose_debug("codec_read NID=%x, verb=%x, data=%x, ext=%x\n",
211 nid, verb, data, extdata);
212 err = corb_send_verb(chip, nid, verb, data, extdata);
213 if (err < 0)
214 return err;
215 err = rirb_get_response(chip, val, extval);
216 return err;
217 }
218
219 /* flush all pending codec writes */
220 int lola_codec_flush(struct lola *chip)
221 {
222 unsigned int tmp;
223 return rirb_get_response(chip, &tmp, NULL);
224 }
225
226 /*
227 * interrupt handler
228 */
229 static irqreturn_t lola_interrupt(int irq, void *dev_id)
230 {
231 struct lola *chip = dev_id;
232 unsigned int notify_ins, notify_outs, error_ins, error_outs;
233 int handled = 0;
234 int i;
235
236 notify_ins = notify_outs = error_ins = error_outs = 0;
237 spin_lock(&chip->reg_lock);
238 for (;;) {
239 unsigned int status, in_sts, out_sts;
240 unsigned int reg;
241
242 status = lola_readl(chip, BAR1, DINTSTS);
243 if (!status || status == -1)
244 break;
245
246 in_sts = lola_readl(chip, BAR1, DIINTSTS);
247 out_sts = lola_readl(chip, BAR1, DOINTSTS);
248
249 /* clear Input Interrupts */
250 for (i = 0; in_sts && i < chip->pcm[CAPT].num_streams; i++) {
251 if (!(in_sts & (1 << i)))
252 continue;
253 in_sts &= ~(1 << i);
254 reg = lola_dsd_read(chip, i, STS);
255 if (reg & LOLA_DSD_STS_DESE) /* error */
256 error_ins |= (1 << i);
257 if (reg & LOLA_DSD_STS_BCIS) /* notify */
258 notify_ins |= (1 << i);
259 /* clear */
260 lola_dsd_write(chip, i, STS, reg);
261 }
262
263 /* clear Output Interrupts */
264 for (i = 0; out_sts && i < chip->pcm[PLAY].num_streams; i++) {
265 if (!(out_sts & (1 << i)))
266 continue;
267 out_sts &= ~(1 << i);
268 reg = lola_dsd_read(chip, i + MAX_STREAM_IN_COUNT, STS);
269 if (reg & LOLA_DSD_STS_DESE) /* error */
270 error_outs |= (1 << i);
271 if (reg & LOLA_DSD_STS_BCIS) /* notify */
272 notify_outs |= (1 << i);
273 lola_dsd_write(chip, i + MAX_STREAM_IN_COUNT, STS, reg);
274 }
275
276 if (status & LOLA_DINT_CTRL) {
277 unsigned char rbsts; /* ring status is byte access */
278 rbsts = lola_readb(chip, BAR0, RIRBSTS);
279 rbsts &= LOLA_RIRB_INT_MASK;
280 if (rbsts)
281 lola_writeb(chip, BAR0, RIRBSTS, rbsts);
282 rbsts = lola_readb(chip, BAR0, CORBSTS);
283 rbsts &= LOLA_CORB_INT_MASK;
284 if (rbsts)
285 lola_writeb(chip, BAR0, CORBSTS, rbsts);
286
287 lola_update_rirb(chip);
288 }
289
290 if (status & (LOLA_DINT_FIFOERR | LOLA_DINT_MUERR)) {
291 /* clear global fifo error interrupt */
292 lola_writel(chip, BAR1, DINTSTS,
293 (status & (LOLA_DINT_FIFOERR | LOLA_DINT_MUERR)));
294 }
295 handled = 1;
296 }
297 spin_unlock(&chip->reg_lock);
298
299 lola_pcm_update(chip, &chip->pcm[CAPT], notify_ins);
300 lola_pcm_update(chip, &chip->pcm[PLAY], notify_outs);
301
302 return IRQ_RETVAL(handled);
303 }
304
305
306 /*
307 * controller
308 */
309 static int reset_controller(struct lola *chip)
310 {
311 unsigned int gctl = lola_readl(chip, BAR0, GCTL);
312 unsigned long end_time;
313
314 if (gctl) {
315 /* to be sure */
316 lola_writel(chip, BAR1, BOARD_MODE, 0);
317 return 0;
318 }
319
320 chip->cold_reset = 1;
321 lola_writel(chip, BAR0, GCTL, LOLA_GCTL_RESET);
322 end_time = jiffies + msecs_to_jiffies(200);
323 do {
324 msleep(1);
325 gctl = lola_readl(chip, BAR0, GCTL);
326 if (gctl)
327 break;
328 } while (time_before(jiffies, end_time));
329 if (!gctl) {
330 dev_err(chip->card->dev, "cannot reset controller\n");
331 return -EIO;
332 }
333 return 0;
334 }
335
336 static void lola_irq_enable(struct lola *chip)
337 {
338 unsigned int val;
339
340 /* enalbe all I/O streams */
341 val = (1 << chip->pcm[PLAY].num_streams) - 1;
342 lola_writel(chip, BAR1, DOINTCTL, val);
343 val = (1 << chip->pcm[CAPT].num_streams) - 1;
344 lola_writel(chip, BAR1, DIINTCTL, val);
345
346 /* enable global irqs */
347 val = LOLA_DINT_GLOBAL | LOLA_DINT_CTRL | LOLA_DINT_FIFOERR |
348 LOLA_DINT_MUERR;
349 lola_writel(chip, BAR1, DINTCTL, val);
350 }
351
352 static void lola_irq_disable(struct lola *chip)
353 {
354 lola_writel(chip, BAR1, DINTCTL, 0);
355 lola_writel(chip, BAR1, DIINTCTL, 0);
356 lola_writel(chip, BAR1, DOINTCTL, 0);
357 }
358
359 static int setup_corb_rirb(struct lola *chip)
360 {
361 int err;
362 unsigned char tmp;
363 unsigned long end_time;
364
365 err = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV,
366 snd_dma_pci_data(chip->pci),
367 PAGE_SIZE, &chip->rb);
368 if (err < 0)
369 return err;
370
371 chip->corb.addr = chip->rb.addr;
372 chip->corb.buf = (u32 *)chip->rb.area;
373 chip->rirb.addr = chip->rb.addr + 2048;
374 chip->rirb.buf = (u32 *)(chip->rb.area + 2048);
375
376 /* disable ringbuffer DMAs */
377 lola_writeb(chip, BAR0, RIRBCTL, 0);
378 lola_writeb(chip, BAR0, CORBCTL, 0);
379
380 end_time = jiffies + msecs_to_jiffies(200);
381 do {
382 if (!lola_readb(chip, BAR0, RIRBCTL) &&
383 !lola_readb(chip, BAR0, CORBCTL))
384 break;
385 msleep(1);
386 } while (time_before(jiffies, end_time));
387
388 /* CORB set up */
389 lola_writel(chip, BAR0, CORBLBASE, (u32)chip->corb.addr);
390 lola_writel(chip, BAR0, CORBUBASE, upper_32_bits(chip->corb.addr));
391 /* set the corb size to 256 entries */
392 lola_writeb(chip, BAR0, CORBSIZE, 0x02);
393 /* set the corb write pointer to 0 */
394 lola_writew(chip, BAR0, CORBWP, 0);
395 /* reset the corb hw read pointer */
396 lola_writew(chip, BAR0, CORBRP, LOLA_RBRWP_CLR);
397 /* enable corb dma */
398 lola_writeb(chip, BAR0, CORBCTL, LOLA_RBCTL_DMA_EN);
399 /* clear flags if set */
400 tmp = lola_readb(chip, BAR0, CORBSTS) & LOLA_CORB_INT_MASK;
401 if (tmp)
402 lola_writeb(chip, BAR0, CORBSTS, tmp);
403 chip->corb.wp = 0;
404
405 /* RIRB set up */
406 lola_writel(chip, BAR0, RIRBLBASE, (u32)chip->rirb.addr);
407 lola_writel(chip, BAR0, RIRBUBASE, upper_32_bits(chip->rirb.addr));
408 /* set the rirb size to 256 entries */
409 lola_writeb(chip, BAR0, RIRBSIZE, 0x02);
410 /* reset the rirb hw write pointer */
411 lola_writew(chip, BAR0, RIRBWP, LOLA_RBRWP_CLR);
412 /* set N=1, get RIRB response interrupt for new entry */
413 lola_writew(chip, BAR0, RINTCNT, 1);
414 /* enable rirb dma and response irq */
415 lola_writeb(chip, BAR0, RIRBCTL, LOLA_RBCTL_DMA_EN | LOLA_RBCTL_IRQ_EN);
416 /* clear flags if set */
417 tmp = lola_readb(chip, BAR0, RIRBSTS) & LOLA_RIRB_INT_MASK;
418 if (tmp)
419 lola_writeb(chip, BAR0, RIRBSTS, tmp);
420 chip->rirb.rp = chip->rirb.cmds = 0;
421
422 return 0;
423 }
424
425 static void stop_corb_rirb(struct lola *chip)
426 {
427 /* disable ringbuffer DMAs */
428 lola_writeb(chip, BAR0, RIRBCTL, 0);
429 lola_writeb(chip, BAR0, CORBCTL, 0);
430 }
431
432 static void lola_reset_setups(struct lola *chip)
433 {
434 /* update the granularity */
435 lola_set_granularity(chip, chip->granularity, true);
436 /* update the sample clock */
437 lola_set_clock_index(chip, chip->clock.cur_index);
438 /* enable unsolicited events of the clock widget */
439 lola_enable_clock_events(chip);
440 /* update the analog gains */
441 lola_setup_all_analog_gains(chip, CAPT, false); /* input, update */
442 /* update SRC configuration if applicable */
443 lola_set_src_config(chip, chip->input_src_mask, false);
444 /* update the analog outputs */
445 lola_setup_all_analog_gains(chip, PLAY, false); /* output, update */
446 }
447
448 static int lola_parse_tree(struct lola *chip)
449 {
450 unsigned int val;
451 int nid, err;
452
453 err = lola_read_param(chip, 0, LOLA_PAR_VENDOR_ID, &val);
454 if (err < 0) {
455 dev_err(chip->card->dev, "Can't read VENDOR_ID\n");
456 return err;
457 }
458 val >>= 16;
459 if (val != 0x1369) {
460 dev_err(chip->card->dev, "Unknown codec vendor 0x%x\n", val);
461 return -EINVAL;
462 }
463
464 err = lola_read_param(chip, 1, LOLA_PAR_FUNCTION_TYPE, &val);
465 if (err < 0) {
466 dev_err(chip->card->dev, "Can't read FUNCTION_TYPE\n");
467 return err;
468 }
469 if (val != 1) {
470 dev_err(chip->card->dev, "Unknown function type %d\n", val);
471 return -EINVAL;
472 }
473
474 err = lola_read_param(chip, 1, LOLA_PAR_SPECIFIC_CAPS, &val);
475 if (err < 0) {
476 dev_err(chip->card->dev, "Can't read SPECCAPS\n");
477 return err;
478 }
479 chip->lola_caps = val;
480 chip->pin[CAPT].num_pins = LOLA_AFG_INPUT_PIN_COUNT(chip->lola_caps);
481 chip->pin[PLAY].num_pins = LOLA_AFG_OUTPUT_PIN_COUNT(chip->lola_caps);
482 dev_dbg(chip->card->dev, "speccaps=0x%x, pins in=%d, out=%d\n",
483 chip->lola_caps,
484 chip->pin[CAPT].num_pins, chip->pin[PLAY].num_pins);
485
486 if (chip->pin[CAPT].num_pins > MAX_AUDIO_INOUT_COUNT ||
487 chip->pin[PLAY].num_pins > MAX_AUDIO_INOUT_COUNT) {
488 dev_err(chip->card->dev, "Invalid Lola-spec caps 0x%x\n", val);
489 return -EINVAL;
490 }
491
492 nid = 0x02;
493 err = lola_init_pcm(chip, CAPT, &nid);
494 if (err < 0)
495 return err;
496 err = lola_init_pcm(chip, PLAY, &nid);
497 if (err < 0)
498 return err;
499
500 err = lola_init_pins(chip, CAPT, &nid);
501 if (err < 0)
502 return err;
503 err = lola_init_pins(chip, PLAY, &nid);
504 if (err < 0)
505 return err;
506
507 if (LOLA_AFG_CLOCK_WIDGET_PRESENT(chip->lola_caps)) {
508 err = lola_init_clock_widget(chip, nid);
509 if (err < 0)
510 return err;
511 nid++;
512 }
513 if (LOLA_AFG_MIXER_WIDGET_PRESENT(chip->lola_caps)) {
514 err = lola_init_mixer_widget(chip, nid);
515 if (err < 0)
516 return err;
517 nid++;
518 }
519
520 /* enable unsolicited events of the clock widget */
521 err = lola_enable_clock_events(chip);
522 if (err < 0)
523 return err;
524
525 /* if last ResetController was not a ColdReset, we don't know
526 * the state of the card; initialize here again
527 */
528 if (!chip->cold_reset) {
529 lola_reset_setups(chip);
530 chip->cold_reset = 1;
531 } else {
532 /* set the granularity if it is not the default */
533 if (chip->granularity != LOLA_GRANULARITY_MIN)
534 lola_set_granularity(chip, chip->granularity, true);
535 }
536
537 return 0;
538 }
539
540 static void lola_stop_hw(struct lola *chip)
541 {
542 stop_corb_rirb(chip);
543 lola_irq_disable(chip);
544 }
545
546 static void lola_free(struct lola *chip)
547 {
548 if (chip->initialized)
549 lola_stop_hw(chip);
550 lola_free_pcm(chip);
551 lola_free_mixer(chip);
552 if (chip->irq >= 0)
553 free_irq(chip->irq, (void *)chip);
554 iounmap(chip->bar[0].remap_addr);
555 iounmap(chip->bar[1].remap_addr);
556 if (chip->rb.area)
557 snd_dma_free_pages(&chip->rb);
558 pci_release_regions(chip->pci);
559 pci_disable_device(chip->pci);
560 kfree(chip);
561 }
562
563 static int lola_dev_free(struct snd_device *device)
564 {
565 lola_free(device->device_data);
566 return 0;
567 }
568
569 static int lola_create(struct snd_card *card, struct pci_dev *pci,
570 int dev, struct lola **rchip)
571 {
572 struct lola *chip;
573 int err;
574 unsigned int dever;
575 static struct snd_device_ops ops = {
576 .dev_free = lola_dev_free,
577 };
578
579 *rchip = NULL;
580
581 err = pci_enable_device(pci);
582 if (err < 0)
583 return err;
584
585 chip = kzalloc(sizeof(*chip), GFP_KERNEL);
586 if (!chip) {
587 pci_disable_device(pci);
588 return -ENOMEM;
589 }
590
591 spin_lock_init(&chip->reg_lock);
592 mutex_init(&chip->open_mutex);
593 chip->card = card;
594 chip->pci = pci;
595 chip->irq = -1;
596
597 chip->granularity = granularity[dev];
598 switch (chip->granularity) {
599 case 8:
600 chip->sample_rate_max = 48000;
601 break;
602 case 16:
603 chip->sample_rate_max = 96000;
604 break;
605 case 32:
606 chip->sample_rate_max = 192000;
607 break;
608 default:
609 dev_warn(chip->card->dev,
610 "Invalid granularity %d, reset to %d\n",
611 chip->granularity, LOLA_GRANULARITY_MAX);
612 chip->granularity = LOLA_GRANULARITY_MAX;
613 chip->sample_rate_max = 192000;
614 break;
615 }
616 chip->sample_rate_min = sample_rate_min[dev];
617 if (chip->sample_rate_min > chip->sample_rate_max) {
618 dev_warn(chip->card->dev,
619 "Invalid sample_rate_min %d, reset to 16000\n",
620 chip->sample_rate_min);
621 chip->sample_rate_min = 16000;
622 }
623
624 err = pci_request_regions(pci, DRVNAME);
625 if (err < 0) {
626 kfree(chip);
627 pci_disable_device(pci);
628 return err;
629 }
630
631 chip->bar[0].addr = pci_resource_start(pci, 0);
632 chip->bar[0].remap_addr = pci_ioremap_bar(pci, 0);
633 chip->bar[1].addr = pci_resource_start(pci, 2);
634 chip->bar[1].remap_addr = pci_ioremap_bar(pci, 2);
635 if (!chip->bar[0].remap_addr || !chip->bar[1].remap_addr) {
636 dev_err(chip->card->dev, "ioremap error\n");
637 err = -ENXIO;
638 goto errout;
639 }
640
641 pci_set_master(pci);
642
643 err = reset_controller(chip);
644 if (err < 0)
645 goto errout;
646
647 if (request_irq(pci->irq, lola_interrupt, IRQF_SHARED,
648 KBUILD_MODNAME, chip)) {
649 dev_err(chip->card->dev, "unable to grab IRQ %d\n", pci->irq);
650 err = -EBUSY;
651 goto errout;
652 }
653 chip->irq = pci->irq;
654 synchronize_irq(chip->irq);
655
656 dever = lola_readl(chip, BAR1, DEVER);
657 chip->pcm[CAPT].num_streams = (dever >> 0) & 0x3ff;
658 chip->pcm[PLAY].num_streams = (dever >> 10) & 0x3ff;
659 chip->version = (dever >> 24) & 0xff;
660 dev_dbg(chip->card->dev, "streams in=%d, out=%d, version=0x%x\n",
661 chip->pcm[CAPT].num_streams, chip->pcm[PLAY].num_streams,
662 chip->version);
663
664 /* Test LOLA_BAR1_DEVER */
665 if (chip->pcm[CAPT].num_streams > MAX_STREAM_IN_COUNT ||
666 chip->pcm[PLAY].num_streams > MAX_STREAM_OUT_COUNT ||
667 (!chip->pcm[CAPT].num_streams &&
668 !chip->pcm[PLAY].num_streams)) {
669 dev_err(chip->card->dev, "invalid DEVER = %x\n", dever);
670 err = -EINVAL;
671 goto errout;
672 }
673
674 err = setup_corb_rirb(chip);
675 if (err < 0)
676 goto errout;
677
678 err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops);
679 if (err < 0) {
680 dev_err(chip->card->dev, "Error creating device [card]!\n");
681 goto errout;
682 }
683
684 strcpy(card->driver, "Lola");
685 strlcpy(card->shortname, "Digigram Lola", sizeof(card->shortname));
686 snprintf(card->longname, sizeof(card->longname),
687 "%s at 0x%lx irq %i",
688 card->shortname, chip->bar[0].addr, chip->irq);
689 strcpy(card->mixername, card->shortname);
690
691 lola_irq_enable(chip);
692
693 chip->initialized = 1;
694 *rchip = chip;
695 return 0;
696
697 errout:
698 lola_free(chip);
699 return err;
700 }
701
702 static int lola_probe(struct pci_dev *pci,
703 const struct pci_device_id *pci_id)
704 {
705 static int dev;
706 struct snd_card *card;
707 struct lola *chip;
708 int err;
709
710 if (dev >= SNDRV_CARDS)
711 return -ENODEV;
712 if (!enable[dev]) {
713 dev++;
714 return -ENOENT;
715 }
716
717 err = snd_card_new(&pci->dev, index[dev], id[dev], THIS_MODULE,
718 0, &card);
719 if (err < 0) {
720 dev_err(&pci->dev, "Error creating card!\n");
721 return err;
722 }
723
724 err = lola_create(card, pci, dev, &chip);
725 if (err < 0)
726 goto out_free;
727 card->private_data = chip;
728
729 err = lola_parse_tree(chip);
730 if (err < 0)
731 goto out_free;
732
733 err = lola_create_pcm(chip);
734 if (err < 0)
735 goto out_free;
736
737 err = lola_create_mixer(chip);
738 if (err < 0)
739 goto out_free;
740
741 lola_proc_debug_new(chip);
742
743 err = snd_card_register(card);
744 if (err < 0)
745 goto out_free;
746
747 pci_set_drvdata(pci, card);
748 dev++;
749 return err;
750 out_free:
751 snd_card_free(card);
752 return err;
753 }
754
755 static void lola_remove(struct pci_dev *pci)
756 {
757 snd_card_free(pci_get_drvdata(pci));
758 }
759
760 /* PCI IDs */
761 static const struct pci_device_id lola_ids[] = {
762 { PCI_VDEVICE(DIGIGRAM, 0x0001) },
763 { 0, }
764 };
765 MODULE_DEVICE_TABLE(pci, lola_ids);
766
767 /* pci_driver definition */
768 static struct pci_driver lola_driver = {
769 .name = KBUILD_MODNAME,
770 .id_table = lola_ids,
771 .probe = lola_probe,
772 .remove = lola_remove,
773 };
774
775 module_pci_driver(lola_driver);
Linux with added FPC-III support