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