]>
Commit | Line | Data |
---|---|---|
02bec490 TB |
1 | /* -*- linux-c -*- * |
2 | * | |
3 | * ALSA driver for the digigram lx6464es interface | |
4 | * | |
5 | * Copyright (c) 2008, 2009 Tim Blechmann <tim@klingt.org> | |
6 | * | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License as published by | |
10 | * the Free Software Foundation; either version 2 of the License, or | |
11 | * (at your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; see the file COPYING. If not, write to | |
20 | * the Free Software Foundation, Inc., 59 Temple Place - Suite 330, | |
21 | * Boston, MA 02111-1307, USA. | |
22 | * | |
23 | */ | |
24 | ||
25 | #include <linux/module.h> | |
26 | #include <linux/init.h> | |
27 | #include <linux/pci.h> | |
28 | #include <linux/delay.h> | |
5a0e3ad6 | 29 | #include <linux/slab.h> |
02bec490 TB |
30 | |
31 | #include <sound/initval.h> | |
32 | #include <sound/control.h> | |
33 | #include <sound/info.h> | |
34 | ||
35 | #include "lx6464es.h" | |
36 | ||
37 | MODULE_AUTHOR("Tim Blechmann"); | |
38 | MODULE_LICENSE("GPL"); | |
39 | MODULE_DESCRIPTION("digigram lx6464es"); | |
40 | MODULE_SUPPORTED_DEVICE("{digigram lx6464es{}}"); | |
41 | ||
42 | ||
43 | static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; | |
44 | static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; | |
a67ff6a5 | 45 | static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; |
02bec490 | 46 | |
de0525ca TB |
47 | module_param_array(index, int, NULL, 0444); |
48 | MODULE_PARM_DESC(index, "Index value for Digigram LX6464ES interface."); | |
49 | module_param_array(id, charp, NULL, 0444); | |
50 | MODULE_PARM_DESC(id, "ID string for Digigram LX6464ES interface."); | |
51 | module_param_array(enable, bool, NULL, 0444); | |
52 | MODULE_PARM_DESC(enable, "Enable/disable specific Digigram LX6464ES soundcards."); | |
53 | ||
02bec490 TB |
54 | static const char card_name[] = "LX6464ES"; |
55 | ||
56 | ||
57 | #define PCI_DEVICE_ID_PLX_LX6464ES PCI_DEVICE_ID_PLX_9056 | |
58 | ||
cebe41d4 | 59 | static DEFINE_PCI_DEVICE_TABLE(snd_lx6464es_ids) = { |
02bec490 TB |
60 | { PCI_DEVICE(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES), |
61 | .subvendor = PCI_VENDOR_ID_DIGIGRAM, | |
62 | .subdevice = PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ES_SERIAL_SUBSYSTEM | |
63 | }, /* LX6464ES */ | |
64 | { PCI_DEVICE(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES), | |
65 | .subvendor = PCI_VENDOR_ID_DIGIGRAM, | |
66 | .subdevice = PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ES_CAE_SERIAL_SUBSYSTEM | |
67 | }, /* LX6464ES-CAE */ | |
68 | { 0, }, | |
69 | }; | |
70 | ||
71 | MODULE_DEVICE_TABLE(pci, snd_lx6464es_ids); | |
72 | ||
73 | ||
74 | ||
75 | /* PGO pour USERo dans le registre pci_0x06/loc_0xEC */ | |
76 | #define CHIPSC_RESET_XILINX (1L<<16) | |
77 | ||
78 | ||
79 | /* alsa callbacks */ | |
80 | static struct snd_pcm_hardware lx_caps = { | |
81 | .info = (SNDRV_PCM_INFO_MMAP | | |
82 | SNDRV_PCM_INFO_INTERLEAVED | | |
83 | SNDRV_PCM_INFO_MMAP_VALID | | |
84 | SNDRV_PCM_INFO_SYNC_START), | |
85 | .formats = (SNDRV_PCM_FMTBIT_S16_LE | | |
86 | SNDRV_PCM_FMTBIT_S16_BE | | |
87 | SNDRV_PCM_FMTBIT_S24_3LE | | |
88 | SNDRV_PCM_FMTBIT_S24_3BE), | |
89 | .rates = (SNDRV_PCM_RATE_CONTINUOUS | | |
90 | SNDRV_PCM_RATE_8000_192000), | |
91 | .rate_min = 8000, | |
92 | .rate_max = 192000, | |
93 | .channels_min = 2, | |
94 | .channels_max = 64, | |
95 | .buffer_bytes_max = 64*2*3*MICROBLAZE_IBL_MAX*MAX_STREAM_BUFFER, | |
96 | .period_bytes_min = (2*2*MICROBLAZE_IBL_MIN*2), | |
97 | .period_bytes_max = (4*64*MICROBLAZE_IBL_MAX*MAX_STREAM_BUFFER), | |
98 | .periods_min = 2, | |
99 | .periods_max = MAX_STREAM_BUFFER, | |
100 | }; | |
101 | ||
102 | static int lx_set_granularity(struct lx6464es *chip, u32 gran); | |
103 | ||
104 | ||
105 | static int lx_hardware_open(struct lx6464es *chip, | |
106 | struct snd_pcm_substream *substream) | |
107 | { | |
108 | int err = 0; | |
109 | struct snd_pcm_runtime *runtime = substream->runtime; | |
110 | int channels = runtime->channels; | |
111 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
112 | ||
113 | snd_pcm_uframes_t period_size = runtime->period_size; | |
114 | ||
115 | snd_printd(LXP "allocating pipe for %d channels\n", channels); | |
116 | err = lx_pipe_allocate(chip, 0, is_capture, channels); | |
117 | if (err < 0) { | |
118 | snd_printk(KERN_ERR LXP "allocating pipe failed\n"); | |
119 | return err; | |
120 | } | |
121 | ||
122 | err = lx_set_granularity(chip, period_size); | |
123 | if (err < 0) { | |
124 | snd_printk(KERN_ERR LXP "setting granularity to %ld failed\n", | |
125 | period_size); | |
126 | return err; | |
127 | } | |
128 | ||
129 | return 0; | |
130 | } | |
131 | ||
132 | static int lx_hardware_start(struct lx6464es *chip, | |
133 | struct snd_pcm_substream *substream) | |
134 | { | |
135 | int err = 0; | |
136 | struct snd_pcm_runtime *runtime = substream->runtime; | |
137 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
138 | ||
139 | snd_printd(LXP "setting stream format\n"); | |
140 | err = lx_stream_set_format(chip, runtime, 0, is_capture); | |
141 | if (err < 0) { | |
142 | snd_printk(KERN_ERR LXP "setting stream format failed\n"); | |
143 | return err; | |
144 | } | |
145 | ||
146 | snd_printd(LXP "starting pipe\n"); | |
147 | err = lx_pipe_start(chip, 0, is_capture); | |
148 | if (err < 0) { | |
149 | snd_printk(KERN_ERR LXP "starting pipe failed\n"); | |
150 | return err; | |
151 | } | |
152 | ||
153 | snd_printd(LXP "waiting for pipe to start\n"); | |
154 | err = lx_pipe_wait_for_start(chip, 0, is_capture); | |
155 | if (err < 0) { | |
156 | snd_printk(KERN_ERR LXP "waiting for pipe failed\n"); | |
157 | return err; | |
158 | } | |
159 | ||
160 | return err; | |
161 | } | |
162 | ||
163 | ||
164 | static int lx_hardware_stop(struct lx6464es *chip, | |
165 | struct snd_pcm_substream *substream) | |
166 | { | |
167 | int err = 0; | |
168 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
169 | ||
170 | snd_printd(LXP "pausing pipe\n"); | |
171 | err = lx_pipe_pause(chip, 0, is_capture); | |
172 | if (err < 0) { | |
173 | snd_printk(KERN_ERR LXP "pausing pipe failed\n"); | |
174 | return err; | |
175 | } | |
176 | ||
177 | snd_printd(LXP "waiting for pipe to become idle\n"); | |
178 | err = lx_pipe_wait_for_idle(chip, 0, is_capture); | |
179 | if (err < 0) { | |
180 | snd_printk(KERN_ERR LXP "waiting for pipe failed\n"); | |
181 | return err; | |
182 | } | |
183 | ||
184 | snd_printd(LXP "stopping pipe\n"); | |
185 | err = lx_pipe_stop(chip, 0, is_capture); | |
186 | if (err < 0) { | |
187 | snd_printk(LXP "stopping pipe failed\n"); | |
188 | return err; | |
189 | } | |
190 | ||
191 | return err; | |
192 | } | |
193 | ||
194 | ||
195 | static int lx_hardware_close(struct lx6464es *chip, | |
196 | struct snd_pcm_substream *substream) | |
197 | { | |
198 | int err = 0; | |
199 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
200 | ||
201 | snd_printd(LXP "releasing pipe\n"); | |
202 | err = lx_pipe_release(chip, 0, is_capture); | |
203 | if (err < 0) { | |
204 | snd_printk(LXP "releasing pipe failed\n"); | |
205 | return err; | |
206 | } | |
207 | ||
208 | return err; | |
209 | } | |
210 | ||
211 | ||
212 | static int lx_pcm_open(struct snd_pcm_substream *substream) | |
213 | { | |
214 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
215 | struct snd_pcm_runtime *runtime = substream->runtime; | |
216 | int err = 0; | |
217 | int board_rate; | |
218 | ||
219 | snd_printdd("->lx_pcm_open\n"); | |
220 | mutex_lock(&chip->setup_mutex); | |
221 | ||
222 | /* copy the struct snd_pcm_hardware struct */ | |
223 | runtime->hw = lx_caps; | |
224 | ||
225 | #if 0 | |
226 | /* buffer-size should better be multiple of period-size */ | |
227 | err = snd_pcm_hw_constraint_integer(runtime, | |
228 | SNDRV_PCM_HW_PARAM_PERIODS); | |
229 | if (err < 0) { | |
230 | snd_printk(KERN_WARNING LXP "could not constrain periods\n"); | |
231 | goto exit; | |
232 | } | |
233 | #endif | |
234 | ||
235 | /* the clock rate cannot be changed */ | |
236 | board_rate = chip->board_sample_rate; | |
237 | err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_RATE, | |
238 | board_rate, board_rate); | |
239 | ||
240 | if (err < 0) { | |
241 | snd_printk(KERN_WARNING LXP "could not constrain periods\n"); | |
242 | goto exit; | |
243 | } | |
244 | ||
245 | /* constrain period size */ | |
246 | err = snd_pcm_hw_constraint_minmax(runtime, | |
247 | SNDRV_PCM_HW_PARAM_PERIOD_SIZE, | |
248 | MICROBLAZE_IBL_MIN, | |
249 | MICROBLAZE_IBL_MAX); | |
250 | if (err < 0) { | |
251 | snd_printk(KERN_WARNING LXP | |
252 | "could not constrain period size\n"); | |
253 | goto exit; | |
254 | } | |
255 | ||
256 | snd_pcm_hw_constraint_step(runtime, 0, | |
257 | SNDRV_PCM_HW_PARAM_BUFFER_SIZE, 32); | |
258 | ||
259 | snd_pcm_set_sync(substream); | |
260 | err = 0; | |
261 | ||
262 | exit: | |
263 | runtime->private_data = chip; | |
264 | ||
265 | mutex_unlock(&chip->setup_mutex); | |
266 | snd_printdd("<-lx_pcm_open, %d\n", err); | |
267 | return err; | |
268 | } | |
269 | ||
270 | static int lx_pcm_close(struct snd_pcm_substream *substream) | |
271 | { | |
272 | int err = 0; | |
273 | snd_printdd("->lx_pcm_close\n"); | |
274 | return err; | |
275 | } | |
276 | ||
277 | static snd_pcm_uframes_t lx_pcm_stream_pointer(struct snd_pcm_substream | |
278 | *substream) | |
279 | { | |
280 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
281 | snd_pcm_uframes_t pos; | |
282 | unsigned long flags; | |
283 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
284 | ||
285 | struct lx_stream *lx_stream = is_capture ? &chip->capture_stream : | |
286 | &chip->playback_stream; | |
287 | ||
288 | snd_printdd("->lx_pcm_stream_pointer\n"); | |
289 | ||
290 | spin_lock_irqsave(&chip->lock, flags); | |
291 | pos = lx_stream->frame_pos * substream->runtime->period_size; | |
292 | spin_unlock_irqrestore(&chip->lock, flags); | |
293 | ||
294 | snd_printdd(LXP "stream_pointer at %ld\n", pos); | |
295 | return pos; | |
296 | } | |
297 | ||
298 | static int lx_pcm_prepare(struct snd_pcm_substream *substream) | |
299 | { | |
300 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
301 | int err = 0; | |
302 | const int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
303 | ||
304 | snd_printdd("->lx_pcm_prepare\n"); | |
305 | ||
306 | mutex_lock(&chip->setup_mutex); | |
307 | ||
308 | if (chip->hardware_running[is_capture]) { | |
309 | err = lx_hardware_stop(chip, substream); | |
310 | if (err < 0) { | |
311 | snd_printk(KERN_ERR LXP "failed to stop hardware. " | |
312 | "Error code %d\n", err); | |
313 | goto exit; | |
314 | } | |
315 | ||
316 | err = lx_hardware_close(chip, substream); | |
317 | if (err < 0) { | |
318 | snd_printk(KERN_ERR LXP "failed to close hardware. " | |
319 | "Error code %d\n", err); | |
320 | goto exit; | |
321 | } | |
322 | } | |
323 | ||
324 | snd_printd(LXP "opening hardware\n"); | |
325 | err = lx_hardware_open(chip, substream); | |
326 | if (err < 0) { | |
327 | snd_printk(KERN_ERR LXP "failed to open hardware. " | |
328 | "Error code %d\n", err); | |
329 | goto exit; | |
330 | } | |
331 | ||
332 | err = lx_hardware_start(chip, substream); | |
333 | if (err < 0) { | |
334 | snd_printk(KERN_ERR LXP "failed to start hardware. " | |
335 | "Error code %d\n", err); | |
336 | goto exit; | |
337 | } | |
338 | ||
339 | chip->hardware_running[is_capture] = 1; | |
340 | ||
341 | if (chip->board_sample_rate != substream->runtime->rate) { | |
342 | if (!err) | |
343 | chip->board_sample_rate = substream->runtime->rate; | |
344 | } | |
345 | ||
346 | exit: | |
347 | mutex_unlock(&chip->setup_mutex); | |
348 | return err; | |
349 | } | |
350 | ||
351 | static int lx_pcm_hw_params(struct snd_pcm_substream *substream, | |
352 | struct snd_pcm_hw_params *hw_params, int is_capture) | |
353 | { | |
354 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
355 | int err = 0; | |
356 | ||
357 | snd_printdd("->lx_pcm_hw_params\n"); | |
358 | ||
359 | mutex_lock(&chip->setup_mutex); | |
360 | ||
361 | /* set dma buffer */ | |
362 | err = snd_pcm_lib_malloc_pages(substream, | |
363 | params_buffer_bytes(hw_params)); | |
364 | ||
365 | if (is_capture) | |
366 | chip->capture_stream.stream = substream; | |
367 | else | |
368 | chip->playback_stream.stream = substream; | |
369 | ||
370 | mutex_unlock(&chip->setup_mutex); | |
371 | return err; | |
372 | } | |
373 | ||
374 | static int lx_pcm_hw_params_playback(struct snd_pcm_substream *substream, | |
375 | struct snd_pcm_hw_params *hw_params) | |
376 | { | |
377 | return lx_pcm_hw_params(substream, hw_params, 0); | |
378 | } | |
379 | ||
380 | static int lx_pcm_hw_params_capture(struct snd_pcm_substream *substream, | |
381 | struct snd_pcm_hw_params *hw_params) | |
382 | { | |
383 | return lx_pcm_hw_params(substream, hw_params, 1); | |
384 | } | |
385 | ||
386 | static int lx_pcm_hw_free(struct snd_pcm_substream *substream) | |
387 | { | |
388 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
389 | int err = 0; | |
390 | int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
391 | ||
392 | snd_printdd("->lx_pcm_hw_free\n"); | |
393 | mutex_lock(&chip->setup_mutex); | |
394 | ||
395 | if (chip->hardware_running[is_capture]) { | |
396 | err = lx_hardware_stop(chip, substream); | |
397 | if (err < 0) { | |
398 | snd_printk(KERN_ERR LXP "failed to stop hardware. " | |
399 | "Error code %d\n", err); | |
400 | goto exit; | |
401 | } | |
402 | ||
403 | err = lx_hardware_close(chip, substream); | |
404 | if (err < 0) { | |
405 | snd_printk(KERN_ERR LXP "failed to close hardware. " | |
406 | "Error code %d\n", err); | |
407 | goto exit; | |
408 | } | |
409 | ||
410 | chip->hardware_running[is_capture] = 0; | |
411 | } | |
412 | ||
413 | err = snd_pcm_lib_free_pages(substream); | |
414 | ||
415 | if (is_capture) | |
416 | chip->capture_stream.stream = 0; | |
417 | else | |
418 | chip->playback_stream.stream = 0; | |
419 | ||
420 | exit: | |
421 | mutex_unlock(&chip->setup_mutex); | |
422 | return err; | |
423 | } | |
424 | ||
425 | static void lx_trigger_start(struct lx6464es *chip, struct lx_stream *lx_stream) | |
426 | { | |
427 | struct snd_pcm_substream *substream = lx_stream->stream; | |
f7467452 | 428 | const unsigned int is_capture = lx_stream->is_capture; |
02bec490 TB |
429 | |
430 | int err; | |
431 | ||
432 | const u32 channels = substream->runtime->channels; | |
433 | const u32 bytes_per_frame = channels * 3; | |
434 | const u32 period_size = substream->runtime->period_size; | |
435 | const u32 periods = substream->runtime->periods; | |
436 | const u32 period_bytes = period_size * bytes_per_frame; | |
437 | ||
438 | dma_addr_t buf = substream->dma_buffer.addr; | |
439 | int i; | |
440 | ||
441 | u32 needed, freed; | |
442 | u32 size_array[5]; | |
443 | ||
444 | for (i = 0; i != periods; ++i) { | |
445 | u32 buffer_index = 0; | |
446 | ||
447 | err = lx_buffer_ask(chip, 0, is_capture, &needed, &freed, | |
448 | size_array); | |
449 | snd_printdd(LXP "starting: needed %d, freed %d\n", | |
450 | needed, freed); | |
451 | ||
452 | err = lx_buffer_give(chip, 0, is_capture, period_bytes, | |
453 | lower_32_bits(buf), upper_32_bits(buf), | |
454 | &buffer_index); | |
455 | ||
293db842 TI |
456 | snd_printdd(LXP "starting: buffer index %x on 0x%lx (%d bytes)\n", |
457 | buffer_index, (unsigned long)buf, period_bytes); | |
02bec490 TB |
458 | buf += period_bytes; |
459 | } | |
460 | ||
461 | err = lx_buffer_ask(chip, 0, is_capture, &needed, &freed, size_array); | |
462 | snd_printdd(LXP "starting: needed %d, freed %d\n", needed, freed); | |
463 | ||
464 | snd_printd(LXP "starting: starting stream\n"); | |
465 | err = lx_stream_start(chip, 0, is_capture); | |
466 | if (err < 0) | |
467 | snd_printk(KERN_ERR LXP "couldn't start stream\n"); | |
468 | else | |
469 | lx_stream->status = LX_STREAM_STATUS_RUNNING; | |
470 | ||
471 | lx_stream->frame_pos = 0; | |
472 | } | |
473 | ||
474 | static void lx_trigger_stop(struct lx6464es *chip, struct lx_stream *lx_stream) | |
475 | { | |
f7467452 | 476 | const unsigned int is_capture = lx_stream->is_capture; |
02bec490 TB |
477 | int err; |
478 | ||
479 | snd_printd(LXP "stopping: stopping stream\n"); | |
480 | err = lx_stream_stop(chip, 0, is_capture); | |
481 | if (err < 0) | |
482 | snd_printk(KERN_ERR LXP "couldn't stop stream\n"); | |
483 | else | |
484 | lx_stream->status = LX_STREAM_STATUS_FREE; | |
485 | ||
486 | } | |
487 | ||
488 | static void lx_trigger_tasklet_dispatch_stream(struct lx6464es *chip, | |
489 | struct lx_stream *lx_stream) | |
490 | { | |
491 | switch (lx_stream->status) { | |
492 | case LX_STREAM_STATUS_SCHEDULE_RUN: | |
493 | lx_trigger_start(chip, lx_stream); | |
494 | break; | |
495 | ||
496 | case LX_STREAM_STATUS_SCHEDULE_STOP: | |
497 | lx_trigger_stop(chip, lx_stream); | |
498 | break; | |
499 | ||
500 | default: | |
501 | break; | |
502 | } | |
503 | } | |
504 | ||
505 | static void lx_trigger_tasklet(unsigned long data) | |
506 | { | |
507 | struct lx6464es *chip = (struct lx6464es *)data; | |
508 | unsigned long flags; | |
509 | ||
510 | snd_printdd("->lx_trigger_tasklet\n"); | |
511 | ||
512 | spin_lock_irqsave(&chip->lock, flags); | |
513 | lx_trigger_tasklet_dispatch_stream(chip, &chip->capture_stream); | |
514 | lx_trigger_tasklet_dispatch_stream(chip, &chip->playback_stream); | |
515 | spin_unlock_irqrestore(&chip->lock, flags); | |
516 | } | |
517 | ||
518 | static int lx_pcm_trigger_dispatch(struct lx6464es *chip, | |
519 | struct lx_stream *lx_stream, int cmd) | |
520 | { | |
521 | int err = 0; | |
522 | ||
523 | switch (cmd) { | |
524 | case SNDRV_PCM_TRIGGER_START: | |
525 | lx_stream->status = LX_STREAM_STATUS_SCHEDULE_RUN; | |
526 | break; | |
527 | ||
528 | case SNDRV_PCM_TRIGGER_STOP: | |
529 | lx_stream->status = LX_STREAM_STATUS_SCHEDULE_STOP; | |
530 | break; | |
531 | ||
532 | default: | |
533 | err = -EINVAL; | |
534 | goto exit; | |
535 | } | |
536 | tasklet_schedule(&chip->trigger_tasklet); | |
537 | ||
538 | exit: | |
539 | return err; | |
540 | } | |
541 | ||
542 | ||
543 | static int lx_pcm_trigger(struct snd_pcm_substream *substream, int cmd) | |
544 | { | |
545 | struct lx6464es *chip = snd_pcm_substream_chip(substream); | |
546 | const int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE); | |
547 | struct lx_stream *stream = is_capture ? &chip->capture_stream : | |
548 | &chip->playback_stream; | |
549 | ||
550 | snd_printdd("->lx_pcm_trigger\n"); | |
551 | ||
552 | return lx_pcm_trigger_dispatch(chip, stream, cmd); | |
553 | } | |
554 | ||
555 | static int snd_lx6464es_free(struct lx6464es *chip) | |
556 | { | |
557 | snd_printdd("->snd_lx6464es_free\n"); | |
558 | ||
559 | lx_irq_disable(chip); | |
560 | ||
561 | if (chip->irq >= 0) | |
562 | free_irq(chip->irq, chip); | |
563 | ||
564 | iounmap(chip->port_dsp_bar); | |
565 | ioport_unmap(chip->port_plx_remapped); | |
566 | ||
567 | pci_release_regions(chip->pci); | |
568 | pci_disable_device(chip->pci); | |
569 | ||
570 | kfree(chip); | |
571 | ||
572 | return 0; | |
573 | } | |
574 | ||
575 | static int snd_lx6464es_dev_free(struct snd_device *device) | |
576 | { | |
577 | return snd_lx6464es_free(device->device_data); | |
578 | } | |
579 | ||
580 | /* reset the dsp during initialization */ | |
e23e7a14 | 581 | static int lx_init_xilinx_reset(struct lx6464es *chip) |
02bec490 TB |
582 | { |
583 | int i; | |
584 | u32 plx_reg = lx_plx_reg_read(chip, ePLX_CHIPSC); | |
585 | ||
586 | snd_printdd("->lx_init_xilinx_reset\n"); | |
587 | ||
588 | /* activate reset of xilinx */ | |
589 | plx_reg &= ~CHIPSC_RESET_XILINX; | |
590 | ||
591 | lx_plx_reg_write(chip, ePLX_CHIPSC, plx_reg); | |
592 | msleep(1); | |
593 | ||
594 | lx_plx_reg_write(chip, ePLX_MBOX3, 0); | |
595 | msleep(1); | |
596 | ||
597 | plx_reg |= CHIPSC_RESET_XILINX; | |
598 | lx_plx_reg_write(chip, ePLX_CHIPSC, plx_reg); | |
599 | ||
600 | /* deactivate reset of xilinx */ | |
601 | for (i = 0; i != 100; ++i) { | |
602 | u32 reg_mbox3; | |
603 | msleep(10); | |
604 | reg_mbox3 = lx_plx_reg_read(chip, ePLX_MBOX3); | |
605 | if (reg_mbox3) { | |
606 | snd_printd(LXP "xilinx reset done\n"); | |
607 | snd_printdd(LXP "xilinx took %d loops\n", i); | |
608 | break; | |
609 | } | |
610 | } | |
611 | ||
612 | /* todo: add some error handling? */ | |
613 | ||
614 | /* clear mr */ | |
615 | lx_dsp_reg_write(chip, eReg_CSM, 0); | |
616 | ||
617 | /* le xilinx ES peut ne pas etre encore pret, on attend. */ | |
618 | msleep(600); | |
619 | ||
620 | return 0; | |
621 | } | |
622 | ||
e23e7a14 | 623 | static int lx_init_xilinx_test(struct lx6464es *chip) |
02bec490 TB |
624 | { |
625 | u32 reg; | |
626 | ||
627 | snd_printdd("->lx_init_xilinx_test\n"); | |
628 | ||
629 | /* TEST if we have access to Xilinx/MicroBlaze */ | |
630 | lx_dsp_reg_write(chip, eReg_CSM, 0); | |
631 | ||
632 | reg = lx_dsp_reg_read(chip, eReg_CSM); | |
633 | ||
634 | if (reg) { | |
635 | snd_printk(KERN_ERR LXP "Problem: Reg_CSM %x.\n", reg); | |
636 | ||
637 | /* PCI9056_SPACE0_REMAP */ | |
638 | lx_plx_reg_write(chip, ePLX_PCICR, 1); | |
639 | ||
640 | reg = lx_dsp_reg_read(chip, eReg_CSM); | |
641 | if (reg) { | |
642 | snd_printk(KERN_ERR LXP "Error: Reg_CSM %x.\n", reg); | |
643 | return -EAGAIN; /* seems to be appropriate */ | |
644 | } | |
645 | } | |
646 | ||
647 | snd_printd(LXP "Xilinx/MicroBlaze access test successful\n"); | |
648 | ||
649 | return 0; | |
650 | } | |
651 | ||
652 | /* initialize ethersound */ | |
e23e7a14 | 653 | static int lx_init_ethersound_config(struct lx6464es *chip) |
02bec490 TB |
654 | { |
655 | int i; | |
656 | u32 orig_conf_es = lx_dsp_reg_read(chip, eReg_CONFES); | |
657 | ||
7e895cfa TB |
658 | /* configure 64 io channels */ |
659 | u32 conf_es = (orig_conf_es & CONFES_READ_PART_MASK) | | |
02bec490 | 660 | (64 << IOCR_INPUTS_OFFSET) | |
7e895cfa | 661 | (64 << IOCR_OUTPUTS_OFFSET) | |
02bec490 TB |
662 | (FREQ_RATIO_SINGLE_MODE << FREQ_RATIO_OFFSET); |
663 | ||
02bec490 TB |
664 | snd_printdd("->lx_init_ethersound\n"); |
665 | ||
666 | chip->freq_ratio = FREQ_RATIO_SINGLE_MODE; | |
667 | ||
668 | /* | |
669 | * write it to the card ! | |
670 | * this actually kicks the ES xilinx, the first time since poweron. | |
671 | * the MAC address in the Reg_ADMACESMSB Reg_ADMACESLSB registers | |
672 | * is not ready before this is done, and the bit 2 in Reg_CSES is set. | |
673 | * */ | |
674 | lx_dsp_reg_write(chip, eReg_CONFES, conf_es); | |
675 | ||
676 | for (i = 0; i != 1000; ++i) { | |
677 | if (lx_dsp_reg_read(chip, eReg_CSES) & 4) { | |
678 | snd_printd(LXP "ethersound initialized after %dms\n", | |
679 | i); | |
680 | goto ethersound_initialized; | |
681 | } | |
682 | msleep(1); | |
683 | } | |
684 | snd_printk(KERN_WARNING LXP | |
685 | "ethersound could not be initialized after %dms\n", i); | |
686 | return -ETIMEDOUT; | |
687 | ||
688 | ethersound_initialized: | |
689 | snd_printd(LXP "ethersound initialized\n"); | |
690 | return 0; | |
691 | } | |
692 | ||
e23e7a14 | 693 | static int lx_init_get_version_features(struct lx6464es *chip) |
02bec490 TB |
694 | { |
695 | u32 dsp_version; | |
696 | ||
697 | int err; | |
698 | ||
699 | snd_printdd("->lx_init_get_version_features\n"); | |
700 | ||
701 | err = lx_dsp_get_version(chip, &dsp_version); | |
702 | ||
703 | if (err == 0) { | |
704 | u32 freq; | |
705 | ||
706 | snd_printk(LXP "DSP version: V%02d.%02d #%d\n", | |
707 | (dsp_version>>16) & 0xff, (dsp_version>>8) & 0xff, | |
708 | dsp_version & 0xff); | |
709 | ||
710 | /* later: what firmware version do we expect? */ | |
711 | ||
712 | /* retrieve Play/Rec features */ | |
713 | /* done here because we may have to handle alternate | |
714 | * DSP files. */ | |
715 | /* later */ | |
716 | ||
717 | /* init the EtherSound sample rate */ | |
718 | err = lx_dsp_get_clock_frequency(chip, &freq); | |
719 | if (err == 0) | |
720 | chip->board_sample_rate = freq; | |
721 | snd_printd(LXP "actual clock frequency %d\n", freq); | |
722 | } else { | |
723 | snd_printk(KERN_ERR LXP "DSP corrupted \n"); | |
724 | err = -EAGAIN; | |
725 | } | |
726 | ||
727 | return err; | |
728 | } | |
729 | ||
730 | static int lx_set_granularity(struct lx6464es *chip, u32 gran) | |
731 | { | |
732 | int err = 0; | |
733 | u32 snapped_gran = MICROBLAZE_IBL_MIN; | |
734 | ||
735 | snd_printdd("->lx_set_granularity\n"); | |
736 | ||
737 | /* blocksize is a power of 2 */ | |
738 | while ((snapped_gran < gran) && | |
739 | (snapped_gran < MICROBLAZE_IBL_MAX)) { | |
740 | snapped_gran *= 2; | |
741 | } | |
742 | ||
743 | if (snapped_gran == chip->pcm_granularity) | |
744 | return 0; | |
745 | ||
746 | err = lx_dsp_set_granularity(chip, snapped_gran); | |
747 | if (err < 0) { | |
748 | snd_printk(KERN_WARNING LXP "could not set granularity\n"); | |
749 | err = -EAGAIN; | |
750 | } | |
751 | ||
752 | if (snapped_gran != gran) | |
753 | snd_printk(LXP "snapped blocksize to %d\n", snapped_gran); | |
754 | ||
755 | snd_printd(LXP "set blocksize on board %d\n", snapped_gran); | |
756 | chip->pcm_granularity = snapped_gran; | |
757 | ||
758 | return err; | |
759 | } | |
760 | ||
761 | /* initialize and test the xilinx dsp chip */ | |
e23e7a14 | 762 | static int lx_init_dsp(struct lx6464es *chip) |
02bec490 TB |
763 | { |
764 | int err; | |
02bec490 TB |
765 | int i; |
766 | ||
767 | snd_printdd("->lx_init_dsp\n"); | |
768 | ||
769 | snd_printd(LXP "initialize board\n"); | |
770 | err = lx_init_xilinx_reset(chip); | |
771 | if (err) | |
772 | return err; | |
773 | ||
774 | snd_printd(LXP "testing board\n"); | |
775 | err = lx_init_xilinx_test(chip); | |
776 | if (err) | |
777 | return err; | |
778 | ||
779 | snd_printd(LXP "initialize ethersound configuration\n"); | |
780 | err = lx_init_ethersound_config(chip); | |
781 | if (err) | |
782 | return err; | |
783 | ||
784 | lx_irq_enable(chip); | |
785 | ||
786 | /** \todo the mac address should be ready by not, but it isn't, | |
787 | * so we wait for it */ | |
788 | for (i = 0; i != 1000; ++i) { | |
80b52490 | 789 | err = lx_dsp_get_mac(chip); |
02bec490 TB |
790 | if (err) |
791 | return err; | |
80b52490 TB |
792 | if (chip->mac_address[0] || chip->mac_address[1] || chip->mac_address[2] || |
793 | chip->mac_address[3] || chip->mac_address[4] || chip->mac_address[5]) | |
02bec490 TB |
794 | goto mac_ready; |
795 | msleep(1); | |
796 | } | |
797 | return -ETIMEDOUT; | |
798 | ||
799 | mac_ready: | |
800 | snd_printd(LXP "mac address ready read after: %dms\n", i); | |
801 | snd_printk(LXP "mac address: %02X.%02X.%02X.%02X.%02X.%02X\n", | |
80b52490 TB |
802 | chip->mac_address[0], chip->mac_address[1], chip->mac_address[2], |
803 | chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]); | |
02bec490 TB |
804 | |
805 | err = lx_init_get_version_features(chip); | |
806 | if (err) | |
807 | return err; | |
808 | ||
809 | lx_set_granularity(chip, MICROBLAZE_IBL_DEFAULT); | |
810 | ||
811 | chip->playback_mute = 0; | |
812 | ||
813 | return err; | |
814 | } | |
815 | ||
816 | static struct snd_pcm_ops lx_ops_playback = { | |
817 | .open = lx_pcm_open, | |
818 | .close = lx_pcm_close, | |
819 | .ioctl = snd_pcm_lib_ioctl, | |
820 | .prepare = lx_pcm_prepare, | |
821 | .hw_params = lx_pcm_hw_params_playback, | |
822 | .hw_free = lx_pcm_hw_free, | |
823 | .trigger = lx_pcm_trigger, | |
824 | .pointer = lx_pcm_stream_pointer, | |
825 | }; | |
826 | ||
827 | static struct snd_pcm_ops lx_ops_capture = { | |
828 | .open = lx_pcm_open, | |
829 | .close = lx_pcm_close, | |
830 | .ioctl = snd_pcm_lib_ioctl, | |
831 | .prepare = lx_pcm_prepare, | |
832 | .hw_params = lx_pcm_hw_params_capture, | |
833 | .hw_free = lx_pcm_hw_free, | |
834 | .trigger = lx_pcm_trigger, | |
835 | .pointer = lx_pcm_stream_pointer, | |
836 | }; | |
837 | ||
e23e7a14 | 838 | static int lx_pcm_create(struct lx6464es *chip) |
02bec490 TB |
839 | { |
840 | int err; | |
841 | struct snd_pcm *pcm; | |
842 | ||
843 | u32 size = 64 * /* channels */ | |
844 | 3 * /* 24 bit samples */ | |
845 | MAX_STREAM_BUFFER * /* periods */ | |
846 | MICROBLAZE_IBL_MAX * /* frames per period */ | |
847 | 2; /* duplex */ | |
848 | ||
849 | size = PAGE_ALIGN(size); | |
850 | ||
851 | /* hardcoded device name & channel count */ | |
852 | err = snd_pcm_new(chip->card, (char *)card_name, 0, | |
853 | 1, 1, &pcm); | |
3bdcff70 TI |
854 | if (err < 0) |
855 | return err; | |
02bec490 TB |
856 | |
857 | pcm->private_data = chip; | |
858 | ||
859 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &lx_ops_playback); | |
860 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &lx_ops_capture); | |
861 | ||
862 | pcm->info_flags = 0; | |
863 | strcpy(pcm->name, card_name); | |
864 | ||
865 | err = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, | |
866 | snd_dma_pci_data(chip->pci), | |
867 | size, size); | |
868 | if (err < 0) | |
869 | return err; | |
870 | ||
871 | chip->pcm = pcm; | |
872 | chip->capture_stream.is_capture = 1; | |
873 | ||
874 | return 0; | |
875 | } | |
876 | ||
877 | static int lx_control_playback_info(struct snd_kcontrol *kcontrol, | |
878 | struct snd_ctl_elem_info *uinfo) | |
879 | { | |
880 | uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; | |
881 | uinfo->count = 1; | |
882 | uinfo->value.integer.min = 0; | |
883 | uinfo->value.integer.max = 1; | |
884 | return 0; | |
885 | } | |
886 | ||
887 | static int lx_control_playback_get(struct snd_kcontrol *kcontrol, | |
888 | struct snd_ctl_elem_value *ucontrol) | |
889 | { | |
890 | struct lx6464es *chip = snd_kcontrol_chip(kcontrol); | |
891 | ucontrol->value.integer.value[0] = chip->playback_mute; | |
892 | return 0; | |
893 | } | |
894 | ||
895 | static int lx_control_playback_put(struct snd_kcontrol *kcontrol, | |
896 | struct snd_ctl_elem_value *ucontrol) | |
897 | { | |
898 | struct lx6464es *chip = snd_kcontrol_chip(kcontrol); | |
899 | int changed = 0; | |
900 | int current_value = chip->playback_mute; | |
901 | ||
902 | if (current_value != ucontrol->value.integer.value[0]) { | |
903 | lx_level_unmute(chip, 0, !current_value); | |
904 | chip->playback_mute = !current_value; | |
905 | changed = 1; | |
906 | } | |
907 | return changed; | |
908 | } | |
909 | ||
e23e7a14 | 910 | static struct snd_kcontrol_new lx_control_playback_switch = { |
02bec490 TB |
911 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, |
912 | .name = "PCM Playback Switch", | |
913 | .index = 0, | |
914 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | |
915 | .private_value = 0, | |
916 | .info = lx_control_playback_info, | |
917 | .get = lx_control_playback_get, | |
918 | .put = lx_control_playback_put | |
919 | }; | |
920 | ||
921 | ||
922 | ||
923 | static void lx_proc_levels_read(struct snd_info_entry *entry, | |
924 | struct snd_info_buffer *buffer) | |
925 | { | |
926 | u32 levels[64]; | |
927 | int err; | |
928 | int i, j; | |
929 | struct lx6464es *chip = entry->private_data; | |
930 | ||
931 | snd_iprintf(buffer, "capture levels:\n"); | |
932 | err = lx_level_peaks(chip, 1, 64, levels); | |
933 | if (err < 0) | |
934 | return; | |
935 | ||
936 | for (i = 0; i != 8; ++i) { | |
937 | for (j = 0; j != 8; ++j) | |
938 | snd_iprintf(buffer, "%08x ", levels[i*8+j]); | |
939 | snd_iprintf(buffer, "\n"); | |
940 | } | |
941 | ||
942 | snd_iprintf(buffer, "\nplayback levels:\n"); | |
943 | ||
944 | err = lx_level_peaks(chip, 0, 64, levels); | |
945 | if (err < 0) | |
946 | return; | |
947 | ||
948 | for (i = 0; i != 8; ++i) { | |
949 | for (j = 0; j != 8; ++j) | |
950 | snd_iprintf(buffer, "%08x ", levels[i*8+j]); | |
951 | snd_iprintf(buffer, "\n"); | |
952 | } | |
953 | ||
954 | snd_iprintf(buffer, "\n"); | |
955 | } | |
956 | ||
e23e7a14 | 957 | static int lx_proc_create(struct snd_card *card, struct lx6464es *chip) |
02bec490 TB |
958 | { |
959 | struct snd_info_entry *entry; | |
960 | int err = snd_card_proc_new(card, "levels", &entry); | |
961 | if (err < 0) | |
962 | return err; | |
963 | ||
964 | snd_info_set_text_ops(entry, chip, lx_proc_levels_read); | |
965 | return 0; | |
966 | } | |
967 | ||
968 | ||
e23e7a14 BP |
969 | static int snd_lx6464es_create(struct snd_card *card, |
970 | struct pci_dev *pci, | |
971 | struct lx6464es **rchip) | |
02bec490 TB |
972 | { |
973 | struct lx6464es *chip; | |
974 | int err; | |
975 | ||
976 | static struct snd_device_ops ops = { | |
977 | .dev_free = snd_lx6464es_dev_free, | |
978 | }; | |
979 | ||
980 | snd_printdd("->snd_lx6464es_create\n"); | |
981 | ||
982 | *rchip = NULL; | |
983 | ||
984 | /* enable PCI device */ | |
985 | err = pci_enable_device(pci); | |
986 | if (err < 0) | |
987 | return err; | |
988 | ||
989 | pci_set_master(pci); | |
990 | ||
991 | /* check if we can restrict PCI DMA transfers to 32 bits */ | |
8e20ce94 | 992 | err = pci_set_dma_mask(pci, DMA_BIT_MASK(32)); |
02bec490 TB |
993 | if (err < 0) { |
994 | snd_printk(KERN_ERR "architecture does not support " | |
995 | "32bit PCI busmaster DMA\n"); | |
996 | pci_disable_device(pci); | |
997 | return -ENXIO; | |
998 | } | |
999 | ||
1000 | chip = kzalloc(sizeof(*chip), GFP_KERNEL); | |
1001 | if (chip == NULL) { | |
1002 | err = -ENOMEM; | |
1003 | goto alloc_failed; | |
1004 | } | |
1005 | ||
1006 | chip->card = card; | |
1007 | chip->pci = pci; | |
1008 | chip->irq = -1; | |
1009 | ||
1010 | /* initialize synchronization structs */ | |
1011 | spin_lock_init(&chip->lock); | |
1012 | spin_lock_init(&chip->msg_lock); | |
1013 | mutex_init(&chip->setup_mutex); | |
1014 | tasklet_init(&chip->trigger_tasklet, lx_trigger_tasklet, | |
1015 | (unsigned long)chip); | |
1016 | tasklet_init(&chip->tasklet_capture, lx_tasklet_capture, | |
1017 | (unsigned long)chip); | |
1018 | tasklet_init(&chip->tasklet_playback, lx_tasklet_playback, | |
1019 | (unsigned long)chip); | |
1020 | ||
1021 | /* request resources */ | |
1022 | err = pci_request_regions(pci, card_name); | |
1023 | if (err < 0) | |
1024 | goto request_regions_failed; | |
1025 | ||
1026 | /* plx port */ | |
1027 | chip->port_plx = pci_resource_start(pci, 1); | |
1028 | chip->port_plx_remapped = ioport_map(chip->port_plx, | |
1029 | pci_resource_len(pci, 1)); | |
1030 | ||
1031 | /* dsp port */ | |
1032 | chip->port_dsp_bar = pci_ioremap_bar(pci, 2); | |
1033 | ||
1034 | err = request_irq(pci->irq, lx_interrupt, IRQF_SHARED, | |
934c2b6d | 1035 | KBUILD_MODNAME, chip); |
02bec490 TB |
1036 | if (err) { |
1037 | snd_printk(KERN_ERR LXP "unable to grab IRQ %d\n", pci->irq); | |
1038 | goto request_irq_failed; | |
1039 | } | |
1040 | chip->irq = pci->irq; | |
1041 | ||
1042 | err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops); | |
1043 | if (err < 0) | |
1044 | goto device_new_failed; | |
1045 | ||
1046 | err = lx_init_dsp(chip); | |
1047 | if (err < 0) { | |
1048 | snd_printk(KERN_ERR LXP "error during DSP initialization\n"); | |
1049 | return err; | |
1050 | } | |
1051 | ||
1052 | err = lx_pcm_create(chip); | |
1053 | if (err < 0) | |
1054 | return err; | |
1055 | ||
1056 | err = lx_proc_create(card, chip); | |
1057 | if (err < 0) | |
1058 | return err; | |
1059 | ||
1060 | err = snd_ctl_add(card, snd_ctl_new1(&lx_control_playback_switch, | |
1061 | chip)); | |
1062 | if (err < 0) | |
1063 | return err; | |
1064 | ||
1065 | snd_card_set_dev(card, &pci->dev); | |
1066 | ||
1067 | *rchip = chip; | |
1068 | return 0; | |
1069 | ||
1070 | device_new_failed: | |
1071 | free_irq(pci->irq, chip); | |
1072 | ||
1073 | request_irq_failed: | |
1074 | pci_release_regions(pci); | |
1075 | ||
1076 | request_regions_failed: | |
1077 | kfree(chip); | |
1078 | ||
1079 | alloc_failed: | |
1080 | pci_disable_device(pci); | |
1081 | ||
1082 | return err; | |
1083 | } | |
1084 | ||
e23e7a14 BP |
1085 | static int snd_lx6464es_probe(struct pci_dev *pci, |
1086 | const struct pci_device_id *pci_id) | |
02bec490 TB |
1087 | { |
1088 | static int dev; | |
1089 | struct snd_card *card; | |
1090 | struct lx6464es *chip; | |
1091 | int err; | |
1092 | ||
1093 | snd_printdd("->snd_lx6464es_probe\n"); | |
1094 | ||
1095 | if (dev >= SNDRV_CARDS) | |
1096 | return -ENODEV; | |
1097 | if (!enable[dev]) { | |
1098 | dev++; | |
1099 | return -ENOENT; | |
1100 | } | |
1101 | ||
7852fd08 TI |
1102 | err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card); |
1103 | if (err < 0) | |
1104 | return err; | |
02bec490 TB |
1105 | |
1106 | err = snd_lx6464es_create(card, pci, &chip); | |
1107 | if (err < 0) { | |
1108 | snd_printk(KERN_ERR LXP "error during snd_lx6464es_create\n"); | |
1109 | goto out_free; | |
1110 | } | |
1111 | ||
80b52490 TB |
1112 | strcpy(card->driver, "LX6464ES"); |
1113 | sprintf(card->id, "LX6464ES_%02X%02X%02X", | |
1114 | chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]); | |
1115 | ||
1116 | sprintf(card->shortname, "LX6464ES %02X.%02X.%02X.%02X.%02X.%02X", | |
1117 | chip->mac_address[0], chip->mac_address[1], chip->mac_address[2], | |
1118 | chip->mac_address[3], chip->mac_address[4], chip->mac_address[5]); | |
1119 | ||
02bec490 TB |
1120 | sprintf(card->longname, "%s at 0x%lx, 0x%p, irq %i", |
1121 | card->shortname, chip->port_plx, | |
1122 | chip->port_dsp_bar, chip->irq); | |
1123 | ||
1124 | err = snd_card_register(card); | |
1125 | if (err < 0) | |
1126 | goto out_free; | |
1127 | ||
1128 | snd_printdd(LXP "initialization successful\n"); | |
1129 | pci_set_drvdata(pci, card); | |
1130 | dev++; | |
1131 | return 0; | |
1132 | ||
1133 | out_free: | |
1134 | snd_card_free(card); | |
1135 | return err; | |
1136 | ||
1137 | } | |
1138 | ||
e23e7a14 | 1139 | static void snd_lx6464es_remove(struct pci_dev *pci) |
02bec490 TB |
1140 | { |
1141 | snd_card_free(pci_get_drvdata(pci)); | |
02bec490 TB |
1142 | } |
1143 | ||
1144 | ||
e9f66d9b | 1145 | static struct pci_driver lx6464es_driver = { |
3733e424 | 1146 | .name = KBUILD_MODNAME, |
02bec490 TB |
1147 | .id_table = snd_lx6464es_ids, |
1148 | .probe = snd_lx6464es_probe, | |
e23e7a14 | 1149 | .remove = snd_lx6464es_remove, |
02bec490 TB |
1150 | }; |
1151 | ||
e9f66d9b | 1152 | module_pci_driver(lx6464es_driver); |