xref: /linux/sound/pci/lx6464es/lx6464es.c (revision 765532c8aaac624b5f8687af6d319c6a1138a257)
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 
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;
45 static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
46 
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 
54 static const char card_name[] = "LX6464ES";
55 
56 
57 #define PCI_DEVICE_ID_PLX_LX6464ES		PCI_DEVICE_ID_PLX_9056
58 
59 static DEFINE_PCI_DEVICE_TABLE(snd_lx6464es_ids) = {
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;
428 	const unsigned int is_capture = lx_stream->is_capture;
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 
456 		snd_printdd(LXP "starting: buffer index %x on %p (%d bytes)\n",
457 			    buffer_index, (void *)buf, period_bytes);
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 {
476 	const unsigned int is_capture = lx_stream->is_capture;
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 */
581 static int __devinit lx_init_xilinx_reset(struct lx6464es *chip)
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 
623 static int __devinit lx_init_xilinx_test(struct lx6464es *chip)
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 */
653 static int __devinit lx_init_ethersound_config(struct lx6464es *chip)
654 {
655 	int i;
656 	u32 orig_conf_es = lx_dsp_reg_read(chip, eReg_CONFES);
657 
658 	/* configure 64 io channels */
659 	u32 conf_es = (orig_conf_es & CONFES_READ_PART_MASK) |
660 		(64 << IOCR_INPUTS_OFFSET) |
661 		(64 << IOCR_OUTPUTS_OFFSET) |
662 		(FREQ_RATIO_SINGLE_MODE << FREQ_RATIO_OFFSET);
663 
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 
693 static int __devinit lx_init_get_version_features(struct lx6464es *chip)
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 */
762 static int __devinit lx_init_dsp(struct lx6464es *chip)
763 {
764 	int err;
765 	u8 mac_address[6];
766 	int i;
767 
768 	snd_printdd("->lx_init_dsp\n");
769 
770 	snd_printd(LXP "initialize board\n");
771 	err = lx_init_xilinx_reset(chip);
772 	if (err)
773 		return err;
774 
775 	snd_printd(LXP "testing board\n");
776 	err = lx_init_xilinx_test(chip);
777 	if (err)
778 		return err;
779 
780 	snd_printd(LXP "initialize ethersound configuration\n");
781 	err = lx_init_ethersound_config(chip);
782 	if (err)
783 		return err;
784 
785 	lx_irq_enable(chip);
786 
787 	/** \todo the mac address should be ready by not, but it isn't,
788 	 *  so we wait for it */
789 	for (i = 0; i != 1000; ++i) {
790 		err = lx_dsp_get_mac(chip, mac_address);
791 		if (err)
792 			return err;
793 		if (mac_address[0] || mac_address[1] || mac_address[2] ||
794 		    mac_address[3] || mac_address[4] || mac_address[5])
795 			goto mac_ready;
796 		msleep(1);
797 	}
798 	return -ETIMEDOUT;
799 
800 mac_ready:
801 	snd_printd(LXP "mac address ready read after: %dms\n", i);
802 	snd_printk(LXP "mac address: %02X.%02X.%02X.%02X.%02X.%02X\n",
803 		   mac_address[0], mac_address[1], mac_address[2],
804 		   mac_address[3], mac_address[4], mac_address[5]);
805 
806 	err = lx_init_get_version_features(chip);
807 	if (err)
808 		return err;
809 
810 	lx_set_granularity(chip, MICROBLAZE_IBL_DEFAULT);
811 
812 	chip->playback_mute = 0;
813 
814 	return err;
815 }
816 
817 static struct snd_pcm_ops lx_ops_playback = {
818 	.open      = lx_pcm_open,
819 	.close     = lx_pcm_close,
820 	.ioctl     = snd_pcm_lib_ioctl,
821 	.prepare   = lx_pcm_prepare,
822 	.hw_params = lx_pcm_hw_params_playback,
823 	.hw_free   = lx_pcm_hw_free,
824 	.trigger   = lx_pcm_trigger,
825 	.pointer   = lx_pcm_stream_pointer,
826 };
827 
828 static struct snd_pcm_ops lx_ops_capture = {
829 	.open      = lx_pcm_open,
830 	.close     = lx_pcm_close,
831 	.ioctl     = snd_pcm_lib_ioctl,
832 	.prepare   = lx_pcm_prepare,
833 	.hw_params = lx_pcm_hw_params_capture,
834 	.hw_free   = lx_pcm_hw_free,
835 	.trigger   = lx_pcm_trigger,
836 	.pointer   = lx_pcm_stream_pointer,
837 };
838 
839 static int __devinit lx_pcm_create(struct lx6464es *chip)
840 {
841 	int err;
842 	struct snd_pcm *pcm;
843 
844 	u32 size = 64 *		     /* channels */
845 		3 *		     /* 24 bit samples */
846 		MAX_STREAM_BUFFER *  /* periods */
847 		MICROBLAZE_IBL_MAX * /* frames per period */
848 		2;		     /* duplex */
849 
850 	size = PAGE_ALIGN(size);
851 
852 	/* hardcoded device name & channel count */
853 	err = snd_pcm_new(chip->card, (char *)card_name, 0,
854 			  1, 1, &pcm);
855 
856 	pcm->private_data = chip;
857 
858 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &lx_ops_playback);
859 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &lx_ops_capture);
860 
861 	pcm->info_flags = 0;
862 	strcpy(pcm->name, card_name);
863 
864 	err = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
865 						    snd_dma_pci_data(chip->pci),
866 						    size, size);
867 	if (err < 0)
868 		return err;
869 
870 	chip->pcm = pcm;
871 	chip->capture_stream.is_capture = 1;
872 
873 	return 0;
874 }
875 
876 static int lx_control_playback_info(struct snd_kcontrol *kcontrol,
877 				    struct snd_ctl_elem_info *uinfo)
878 {
879 	uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
880 	uinfo->count = 1;
881 	uinfo->value.integer.min = 0;
882 	uinfo->value.integer.max = 1;
883 	return 0;
884 }
885 
886 static int lx_control_playback_get(struct snd_kcontrol *kcontrol,
887 				   struct snd_ctl_elem_value *ucontrol)
888 {
889 	struct lx6464es *chip = snd_kcontrol_chip(kcontrol);
890 	ucontrol->value.integer.value[0] = chip->playback_mute;
891 	return 0;
892 }
893 
894 static int lx_control_playback_put(struct snd_kcontrol *kcontrol,
895 				   struct snd_ctl_elem_value *ucontrol)
896 {
897 	struct lx6464es *chip = snd_kcontrol_chip(kcontrol);
898 	int changed = 0;
899 	int current_value = chip->playback_mute;
900 
901 	if (current_value != ucontrol->value.integer.value[0]) {
902 		lx_level_unmute(chip, 0, !current_value);
903 		chip->playback_mute = !current_value;
904 		changed = 1;
905 	}
906 	return changed;
907 }
908 
909 static struct snd_kcontrol_new lx_control_playback_switch __devinitdata = {
910 	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
911 	.name = "PCM Playback Switch",
912 	.index = 0,
913 	.access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
914 	.private_value = 0,
915 	.info = lx_control_playback_info,
916 	.get = lx_control_playback_get,
917 	.put = lx_control_playback_put
918 };
919 
920 
921 
922 static void lx_proc_levels_read(struct snd_info_entry *entry,
923 				struct snd_info_buffer *buffer)
924 {
925 	u32 levels[64];
926 	int err;
927 	int i, j;
928 	struct lx6464es *chip = entry->private_data;
929 
930 	snd_iprintf(buffer, "capture levels:\n");
931 	err = lx_level_peaks(chip, 1, 64, levels);
932 	if (err < 0)
933 		return;
934 
935 	for (i = 0; i != 8; ++i) {
936 		for (j = 0; j != 8; ++j)
937 			snd_iprintf(buffer, "%08x ", levels[i*8+j]);
938 		snd_iprintf(buffer, "\n");
939 	}
940 
941 	snd_iprintf(buffer, "\nplayback levels:\n");
942 
943 	err = lx_level_peaks(chip, 0, 64, levels);
944 	if (err < 0)
945 		return;
946 
947 	for (i = 0; i != 8; ++i) {
948 		for (j = 0; j != 8; ++j)
949 			snd_iprintf(buffer, "%08x ", levels[i*8+j]);
950 		snd_iprintf(buffer, "\n");
951 	}
952 
953 	snd_iprintf(buffer, "\n");
954 }
955 
956 static int __devinit lx_proc_create(struct snd_card *card, struct lx6464es *chip)
957 {
958 	struct snd_info_entry *entry;
959 	int err = snd_card_proc_new(card, "levels", &entry);
960 	if (err < 0)
961 		return err;
962 
963 	snd_info_set_text_ops(entry, chip, lx_proc_levels_read);
964 	return 0;
965 }
966 
967 
968 static int __devinit snd_lx6464es_create(struct snd_card *card,
969 					 struct pci_dev *pci,
970 					 struct lx6464es **rchip)
971 {
972 	struct lx6464es *chip;
973 	int err;
974 
975 	static struct snd_device_ops ops = {
976 		.dev_free = snd_lx6464es_dev_free,
977 	};
978 
979 	snd_printdd("->snd_lx6464es_create\n");
980 
981 	*rchip = NULL;
982 
983 	/* enable PCI device */
984 	err = pci_enable_device(pci);
985 	if (err < 0)
986 		return err;
987 
988 	pci_set_master(pci);
989 
990 	/* check if we can restrict PCI DMA transfers to 32 bits */
991 	err = pci_set_dma_mask(pci, DMA_BIT_MASK(32));
992 	if (err < 0) {
993 		snd_printk(KERN_ERR "architecture does not support "
994 			   "32bit PCI busmaster DMA\n");
995 		pci_disable_device(pci);
996 		return -ENXIO;
997 	}
998 
999 	chip = kzalloc(sizeof(*chip), GFP_KERNEL);
1000 	if (chip == NULL) {
1001 		err = -ENOMEM;
1002 		goto alloc_failed;
1003 	}
1004 
1005 	chip->card = card;
1006 	chip->pci = pci;
1007 	chip->irq = -1;
1008 
1009 	/* initialize synchronization structs */
1010 	spin_lock_init(&chip->lock);
1011 	spin_lock_init(&chip->msg_lock);
1012 	mutex_init(&chip->setup_mutex);
1013 	tasklet_init(&chip->trigger_tasklet, lx_trigger_tasklet,
1014 		     (unsigned long)chip);
1015 	tasklet_init(&chip->tasklet_capture, lx_tasklet_capture,
1016 		     (unsigned long)chip);
1017 	tasklet_init(&chip->tasklet_playback, lx_tasklet_playback,
1018 		     (unsigned long)chip);
1019 
1020 	/* request resources */
1021 	err = pci_request_regions(pci, card_name);
1022 	if (err < 0)
1023 		goto request_regions_failed;
1024 
1025 	/* plx port */
1026 	chip->port_plx = pci_resource_start(pci, 1);
1027 	chip->port_plx_remapped = ioport_map(chip->port_plx,
1028 					     pci_resource_len(pci, 1));
1029 
1030 	/* dsp port */
1031 	chip->port_dsp_bar = pci_ioremap_bar(pci, 2);
1032 
1033 	err = request_irq(pci->irq, lx_interrupt, IRQF_SHARED,
1034 			  card_name, chip);
1035 	if (err) {
1036 		snd_printk(KERN_ERR LXP "unable to grab IRQ %d\n", pci->irq);
1037 		goto request_irq_failed;
1038 	}
1039 	chip->irq = pci->irq;
1040 
1041 	err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops);
1042 	if (err < 0)
1043 		goto device_new_failed;
1044 
1045 	err = lx_init_dsp(chip);
1046 	if (err < 0) {
1047 		snd_printk(KERN_ERR LXP "error during DSP initialization\n");
1048 		return err;
1049 	}
1050 
1051 	err = lx_pcm_create(chip);
1052 	if (err < 0)
1053 		return err;
1054 
1055 	err = lx_proc_create(card, chip);
1056 	if (err < 0)
1057 		return err;
1058 
1059 	err = snd_ctl_add(card, snd_ctl_new1(&lx_control_playback_switch,
1060 					     chip));
1061 	if (err < 0)
1062 		return err;
1063 
1064 	snd_card_set_dev(card, &pci->dev);
1065 
1066 	*rchip = chip;
1067 	return 0;
1068 
1069 device_new_failed:
1070 	free_irq(pci->irq, chip);
1071 
1072 request_irq_failed:
1073 	pci_release_regions(pci);
1074 
1075 request_regions_failed:
1076 	kfree(chip);
1077 
1078 alloc_failed:
1079 	pci_disable_device(pci);
1080 
1081 	return err;
1082 }
1083 
1084 static int __devinit snd_lx6464es_probe(struct pci_dev *pci,
1085 					const struct pci_device_id *pci_id)
1086 {
1087 	static int dev;
1088 	struct snd_card *card;
1089 	struct lx6464es *chip;
1090 	int err;
1091 
1092 	snd_printdd("->snd_lx6464es_probe\n");
1093 
1094 	if (dev >= SNDRV_CARDS)
1095 		return -ENODEV;
1096 	if (!enable[dev]) {
1097 		dev++;
1098 		return -ENOENT;
1099 	}
1100 
1101 	err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card);
1102 	if (err < 0)
1103 		return err;
1104 
1105 	err = snd_lx6464es_create(card, pci, &chip);
1106 	if (err < 0) {
1107 		snd_printk(KERN_ERR LXP "error during snd_lx6464es_create\n");
1108 		goto out_free;
1109 	}
1110 
1111 	strcpy(card->driver, "lx6464es");
1112 	strcpy(card->shortname, "Digigram LX6464ES");
1113 	sprintf(card->longname, "%s at 0x%lx, 0x%p, irq %i",
1114 		card->shortname, chip->port_plx,
1115 		chip->port_dsp_bar, chip->irq);
1116 
1117 	err = snd_card_register(card);
1118 	if (err < 0)
1119 		goto out_free;
1120 
1121 	snd_printdd(LXP "initialization successful\n");
1122 	pci_set_drvdata(pci, card);
1123 	dev++;
1124 	return 0;
1125 
1126 out_free:
1127 	snd_card_free(card);
1128 	return err;
1129 
1130 }
1131 
1132 static void __devexit snd_lx6464es_remove(struct pci_dev *pci)
1133 {
1134 	snd_card_free(pci_get_drvdata(pci));
1135 	pci_set_drvdata(pci, NULL);
1136 }
1137 
1138 
1139 static struct pci_driver driver = {
1140 	.name =     "Digigram LX6464ES",
1141 	.id_table = snd_lx6464es_ids,
1142 	.probe =    snd_lx6464es_probe,
1143 	.remove = __devexit_p(snd_lx6464es_remove),
1144 };
1145 
1146 
1147 /* module initialization */
1148 static int __init mod_init(void)
1149 {
1150 	return pci_register_driver(&driver);
1151 }
1152 
1153 static void __exit mod_exit(void)
1154 {
1155 	pci_unregister_driver(&driver);
1156 }
1157 
1158 module_init(mod_init);
1159 module_exit(mod_exit);
1160