Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
awilliam
GitHub Repository: awilliam/linux-vfio
Path: blob/master/sound/pci/lola/lola.c
10817 views
1
/*
2
* Support for Digigram Lola PCI-e boards
3
*
4
* Copyright (c) 2011 Takashi Iwai <[email protected]>
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/moduleparam.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 int 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 <[email protected]>");
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) printk(KERN_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
printk(KERN_WARNING SFX "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
printk(KERN_WARNING SFX "RIRB response error\n");
186
if (!chip->polling_mode) {
187
printk(KERN_WARNING SFX "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
printk(KERN_ERR SFX "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 __devinit 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
printk(KERN_ERR SFX "Can't read VENDOR_ID\n");
456
return err;
457
}
458
val >>= 16;
459
if (val != 0x1369) {
460
printk(KERN_ERR SFX "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
printk(KERN_ERR SFX "Can't read FUNCTION_TYPE for 0x%x\n", nid);
467
return err;
468
}
469
if (val != 1) {
470
printk(KERN_ERR SFX "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
printk(KERN_ERR SFX "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
snd_printdd(SFX "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
printk(KERN_ERR SFX "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
if (chip->bar[0].remap_addr)
555
iounmap(chip->bar[0].remap_addr);
556
if (chip->bar[1].remap_addr)
557
iounmap(chip->bar[1].remap_addr);
558
if (chip->rb.area)
559
snd_dma_free_pages(&chip->rb);
560
pci_release_regions(chip->pci);
561
pci_disable_device(chip->pci);
562
kfree(chip);
563
}
564
565
static int lola_dev_free(struct snd_device *device)
566
{
567
lola_free(device->device_data);
568
return 0;
569
}
570
571
static int __devinit lola_create(struct snd_card *card, struct pci_dev *pci,
572
int dev, struct lola **rchip)
573
{
574
struct lola *chip;
575
int err;
576
unsigned int dever;
577
static struct snd_device_ops ops = {
578
.dev_free = lola_dev_free,
579
};
580
581
*rchip = NULL;
582
583
err = pci_enable_device(pci);
584
if (err < 0)
585
return err;
586
587
chip = kzalloc(sizeof(*chip), GFP_KERNEL);
588
if (!chip) {
589
snd_printk(KERN_ERR SFX "cannot allocate chip\n");
590
pci_disable_device(pci);
591
return -ENOMEM;
592
}
593
594
spin_lock_init(&chip->reg_lock);
595
mutex_init(&chip->open_mutex);
596
chip->card = card;
597
chip->pci = pci;
598
chip->irq = -1;
599
600
chip->granularity = granularity[dev];
601
switch (chip->granularity) {
602
case 8:
603
chip->sample_rate_max = 48000;
604
break;
605
case 16:
606
chip->sample_rate_max = 96000;
607
break;
608
case 32:
609
chip->sample_rate_max = 192000;
610
break;
611
default:
612
snd_printk(KERN_WARNING SFX
613
"Invalid granularity %d, reset to %d\n",
614
chip->granularity, LOLA_GRANULARITY_MAX);
615
chip->granularity = LOLA_GRANULARITY_MAX;
616
chip->sample_rate_max = 192000;
617
break;
618
}
619
chip->sample_rate_min = sample_rate_min[dev];
620
if (chip->sample_rate_min > chip->sample_rate_max) {
621
snd_printk(KERN_WARNING SFX
622
"Invalid sample_rate_min %d, reset to 16000\n",
623
chip->sample_rate_min);
624
chip->sample_rate_min = 16000;
625
}
626
627
err = pci_request_regions(pci, DRVNAME);
628
if (err < 0) {
629
kfree(chip);
630
pci_disable_device(pci);
631
return err;
632
}
633
634
chip->bar[0].addr = pci_resource_start(pci, 0);
635
chip->bar[0].remap_addr = pci_ioremap_bar(pci, 0);
636
chip->bar[1].addr = pci_resource_start(pci, 2);
637
chip->bar[1].remap_addr = pci_ioremap_bar(pci, 2);
638
if (!chip->bar[0].remap_addr || !chip->bar[1].remap_addr) {
639
snd_printk(KERN_ERR SFX "ioremap error\n");
640
err = -ENXIO;
641
goto errout;
642
}
643
644
pci_set_master(pci);
645
646
err = reset_controller(chip);
647
if (err < 0)
648
goto errout;
649
650
if (request_irq(pci->irq, lola_interrupt, IRQF_SHARED,
651
DRVNAME, chip)) {
652
printk(KERN_ERR SFX "unable to grab IRQ %d\n", pci->irq);
653
err = -EBUSY;
654
goto errout;
655
}
656
chip->irq = pci->irq;
657
synchronize_irq(chip->irq);
658
659
dever = lola_readl(chip, BAR1, DEVER);
660
chip->pcm[CAPT].num_streams = (dever >> 0) & 0x3ff;
661
chip->pcm[PLAY].num_streams = (dever >> 10) & 0x3ff;
662
chip->version = (dever >> 24) & 0xff;
663
snd_printdd(SFX "streams in=%d, out=%d, version=0x%x\n",
664
chip->pcm[CAPT].num_streams, chip->pcm[PLAY].num_streams,
665
chip->version);
666
667
/* Test LOLA_BAR1_DEVER */
668
if (chip->pcm[CAPT].num_streams > MAX_STREAM_IN_COUNT ||
669
chip->pcm[PLAY].num_streams > MAX_STREAM_OUT_COUNT ||
670
(!chip->pcm[CAPT].num_streams &&
671
!chip->pcm[PLAY].num_streams)) {
672
printk(KERN_ERR SFX "invalid DEVER = %x\n", dever);
673
err = -EINVAL;
674
goto errout;
675
}
676
677
err = setup_corb_rirb(chip);
678
if (err < 0)
679
goto errout;
680
681
err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops);
682
if (err < 0) {
683
snd_printk(KERN_ERR SFX "Error creating device [card]!\n");
684
goto errout;
685
}
686
687
strcpy(card->driver, "Lola");
688
strlcpy(card->shortname, "Digigram Lola", sizeof(card->shortname));
689
snprintf(card->longname, sizeof(card->longname),
690
"%s at 0x%lx irq %i",
691
card->shortname, chip->bar[0].addr, chip->irq);
692
strcpy(card->mixername, card->shortname);
693
694
lola_irq_enable(chip);
695
696
chip->initialized = 1;
697
*rchip = chip;
698
return 0;
699
700
errout:
701
lola_free(chip);
702
return err;
703
}
704
705
static int __devinit lola_probe(struct pci_dev *pci,
706
const struct pci_device_id *pci_id)
707
{
708
static int dev;
709
struct snd_card *card;
710
struct lola *chip;
711
int err;
712
713
if (dev >= SNDRV_CARDS)
714
return -ENODEV;
715
if (!enable[dev]) {
716
dev++;
717
return -ENOENT;
718
}
719
720
err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card);
721
if (err < 0) {
722
snd_printk(KERN_ERR SFX "Error creating card!\n");
723
return err;
724
}
725
726
snd_card_set_dev(card, &pci->dev);
727
728
err = lola_create(card, pci, dev, &chip);
729
if (err < 0)
730
goto out_free;
731
card->private_data = chip;
732
733
err = lola_parse_tree(chip);
734
if (err < 0)
735
goto out_free;
736
737
err = lola_create_pcm(chip);
738
if (err < 0)
739
goto out_free;
740
741
err = lola_create_mixer(chip);
742
if (err < 0)
743
goto out_free;
744
745
lola_proc_debug_new(chip);
746
747
err = snd_card_register(card);
748
if (err < 0)
749
goto out_free;
750
751
pci_set_drvdata(pci, card);
752
dev++;
753
return err;
754
out_free:
755
snd_card_free(card);
756
return err;
757
}
758
759
static void __devexit lola_remove(struct pci_dev *pci)
760
{
761
snd_card_free(pci_get_drvdata(pci));
762
pci_set_drvdata(pci, NULL);
763
}
764
765
/* PCI IDs */
766
static DEFINE_PCI_DEVICE_TABLE(lola_ids) = {
767
{ PCI_VDEVICE(DIGIGRAM, 0x0001) },
768
{ 0, }
769
};
770
MODULE_DEVICE_TABLE(pci, lola_ids);
771
772
/* pci_driver definition */
773
static struct pci_driver driver = {
774
.name = DRVNAME,
775
.id_table = lola_ids,
776
.probe = lola_probe,
777
.remove = __devexit_p(lola_remove),
778
};
779
780
static int __init alsa_card_lola_init(void)
781
{
782
return pci_register_driver(&driver);
783
}
784
785
static void __exit alsa_card_lola_exit(void)
786
{
787
pci_unregister_driver(&driver);
788
}
789
790
module_init(alsa_card_lola_init)
791
module_exit(alsa_card_lola_exit)
792
793