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