net: adaptec: starfire: add checks for dma mapping errors
[linux/fpc-iii.git] / sound / sh / aica.c
blobfbbc252795599655bac0f795fbe47b607f18f8d8
1 /*
2 * This code is licenced under
3 * the General Public Licence
4 * version 2
6 * Copyright Adrian McMenamin 2005, 2006, 2007
7 * <adrian@mcmen.demon.co.uk>
8 * Requires firmware (BSD licenced) available from:
9 * http://linuxdc.cvs.sourceforge.net/linuxdc/linux-sh-dc/sound/oss/aica/firmware/
10 * or the maintainer
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of version 2 of the GNU General Public License as published by
14 * the Free Software Foundation.
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
27 #include <linux/init.h>
28 #include <linux/jiffies.h>
29 #include <linux/slab.h>
30 #include <linux/time.h>
31 #include <linux/wait.h>
32 #include <linux/module.h>
33 #include <linux/platform_device.h>
34 #include <linux/firmware.h>
35 #include <linux/timer.h>
36 #include <linux/delay.h>
37 #include <linux/workqueue.h>
38 #include <linux/io.h>
39 #include <sound/core.h>
40 #include <sound/control.h>
41 #include <sound/pcm.h>
42 #include <sound/initval.h>
43 #include <sound/info.h>
44 #include <asm/dma.h>
45 #include <mach/sysasic.h>
46 #include "aica.h"
48 MODULE_AUTHOR("Adrian McMenamin <adrian@mcmen.demon.co.uk>");
49 MODULE_DESCRIPTION("Dreamcast AICA sound (pcm) driver");
50 MODULE_LICENSE("GPL");
51 MODULE_SUPPORTED_DEVICE("{{Yamaha/SEGA, AICA}}");
52 MODULE_FIRMWARE("aica_firmware.bin");
54 /* module parameters */
55 #define CARD_NAME "AICA"
56 static int index = -1;
57 static char *id;
58 static bool enable = 1;
59 module_param(index, int, 0444);
60 MODULE_PARM_DESC(index, "Index value for " CARD_NAME " soundcard.");
61 module_param(id, charp, 0444);
62 MODULE_PARM_DESC(id, "ID string for " CARD_NAME " soundcard.");
63 module_param(enable, bool, 0644);
64 MODULE_PARM_DESC(enable, "Enable " CARD_NAME " soundcard.");
66 /* Simple platform device */
67 static struct platform_device *pd;
68 static struct resource aica_memory_space[2] = {
70 .name = "AICA ARM CONTROL",
71 .start = ARM_RESET_REGISTER,
72 .flags = IORESOURCE_MEM,
73 .end = ARM_RESET_REGISTER + 3,
76 .name = "AICA Sound RAM",
77 .start = SPU_MEMORY_BASE,
78 .flags = IORESOURCE_MEM,
79 .end = SPU_MEMORY_BASE + 0x200000 - 1,
83 /* SPU specific functions */
84 /* spu_write_wait - wait for G2-SH FIFO to clear */
85 static void spu_write_wait(void)
87 int time_count;
88 time_count = 0;
89 while (1) {
90 if (!(readl(G2_FIFO) & 0x11))
91 break;
92 /* To ensure hardware failure doesn't wedge kernel */
93 time_count++;
94 if (time_count > 0x10000) {
95 snd_printk
96 ("WARNING: G2 FIFO appears to be blocked.\n");
97 break;
102 /* spu_memset - write to memory in SPU address space */
103 static void spu_memset(u32 toi, u32 what, int length)
105 int i;
106 unsigned long flags;
107 if (snd_BUG_ON(length % 4))
108 return;
109 for (i = 0; i < length; i++) {
110 if (!(i % 8))
111 spu_write_wait();
112 local_irq_save(flags);
113 writel(what, toi + SPU_MEMORY_BASE);
114 local_irq_restore(flags);
115 toi++;
119 /* spu_memload - write to SPU address space */
120 static void spu_memload(u32 toi, void *from, int length)
122 unsigned long flags;
123 u32 *froml = from;
124 u32 __iomem *to = (u32 __iomem *) (SPU_MEMORY_BASE + toi);
125 int i;
126 u32 val;
127 length = DIV_ROUND_UP(length, 4);
128 spu_write_wait();
129 for (i = 0; i < length; i++) {
130 if (!(i % 8))
131 spu_write_wait();
132 val = *froml;
133 local_irq_save(flags);
134 writel(val, to);
135 local_irq_restore(flags);
136 froml++;
137 to++;
141 /* spu_disable - set spu registers to stop sound output */
142 static void spu_disable(void)
144 int i;
145 unsigned long flags;
146 u32 regval;
147 spu_write_wait();
148 regval = readl(ARM_RESET_REGISTER);
149 regval |= 1;
150 spu_write_wait();
151 local_irq_save(flags);
152 writel(regval, ARM_RESET_REGISTER);
153 local_irq_restore(flags);
154 for (i = 0; i < 64; i++) {
155 spu_write_wait();
156 regval = readl(SPU_REGISTER_BASE + (i * 0x80));
157 regval = (regval & ~0x4000) | 0x8000;
158 spu_write_wait();
159 local_irq_save(flags);
160 writel(regval, SPU_REGISTER_BASE + (i * 0x80));
161 local_irq_restore(flags);
165 /* spu_enable - set spu registers to enable sound output */
166 static void spu_enable(void)
168 unsigned long flags;
169 u32 regval = readl(ARM_RESET_REGISTER);
170 regval &= ~1;
171 spu_write_wait();
172 local_irq_save(flags);
173 writel(regval, ARM_RESET_REGISTER);
174 local_irq_restore(flags);
178 * Halt the sound processor, clear the memory,
179 * load some default ARM7 code, and then restart ARM7
181 static void spu_reset(void)
183 unsigned long flags;
184 spu_disable();
185 spu_memset(0, 0, 0x200000 / 4);
186 /* Put ARM7 in endless loop */
187 local_irq_save(flags);
188 __raw_writel(0xea000002, SPU_MEMORY_BASE);
189 local_irq_restore(flags);
190 spu_enable();
193 /* aica_chn_start - write to spu to start playback */
194 static void aica_chn_start(void)
196 unsigned long flags;
197 spu_write_wait();
198 local_irq_save(flags);
199 writel(AICA_CMD_KICK | AICA_CMD_START, (u32 *) AICA_CONTROL_POINT);
200 local_irq_restore(flags);
203 /* aica_chn_halt - write to spu to halt playback */
204 static void aica_chn_halt(void)
206 unsigned long flags;
207 spu_write_wait();
208 local_irq_save(flags);
209 writel(AICA_CMD_KICK | AICA_CMD_STOP, (u32 *) AICA_CONTROL_POINT);
210 local_irq_restore(flags);
213 /* ALSA code below */
214 static struct snd_pcm_hardware snd_pcm_aica_playback_hw = {
215 .info = (SNDRV_PCM_INFO_NONINTERLEAVED),
216 .formats =
217 (SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_LE |
218 SNDRV_PCM_FMTBIT_IMA_ADPCM),
219 .rates = SNDRV_PCM_RATE_8000_48000,
220 .rate_min = 8000,
221 .rate_max = 48000,
222 .channels_min = 1,
223 .channels_max = 2,
224 .buffer_bytes_max = AICA_BUFFER_SIZE,
225 .period_bytes_min = AICA_PERIOD_SIZE,
226 .period_bytes_max = AICA_PERIOD_SIZE,
227 .periods_min = AICA_PERIOD_NUMBER,
228 .periods_max = AICA_PERIOD_NUMBER,
231 static int aica_dma_transfer(int channels, int buffer_size,
232 struct snd_pcm_substream *substream)
234 int q, err, period_offset;
235 struct snd_card_aica *dreamcastcard;
236 struct snd_pcm_runtime *runtime;
237 unsigned long flags;
238 err = 0;
239 dreamcastcard = substream->pcm->private_data;
240 period_offset = dreamcastcard->clicks;
241 period_offset %= (AICA_PERIOD_NUMBER / channels);
242 runtime = substream->runtime;
243 for (q = 0; q < channels; q++) {
244 local_irq_save(flags);
245 err = dma_xfer(AICA_DMA_CHANNEL,
246 (unsigned long) (runtime->dma_area +
247 (AICA_BUFFER_SIZE * q) /
248 channels +
249 AICA_PERIOD_SIZE *
250 period_offset),
251 AICA_CHANNEL0_OFFSET + q * CHANNEL_OFFSET +
252 AICA_PERIOD_SIZE * period_offset,
253 buffer_size / channels, AICA_DMA_MODE);
254 if (unlikely(err < 0)) {
255 local_irq_restore(flags);
256 break;
258 dma_wait_for_completion(AICA_DMA_CHANNEL);
259 local_irq_restore(flags);
261 return err;
264 static void startup_aica(struct snd_card_aica *dreamcastcard)
266 spu_memload(AICA_CHANNEL0_CONTROL_OFFSET,
267 dreamcastcard->channel, sizeof(struct aica_channel));
268 aica_chn_start();
271 static void run_spu_dma(struct work_struct *work)
273 int buffer_size;
274 struct snd_pcm_runtime *runtime;
275 struct snd_card_aica *dreamcastcard;
276 dreamcastcard =
277 container_of(work, struct snd_card_aica, spu_dma_work);
278 runtime = dreamcastcard->substream->runtime;
279 if (unlikely(dreamcastcard->dma_check == 0)) {
280 buffer_size =
281 frames_to_bytes(runtime, runtime->buffer_size);
282 if (runtime->channels > 1)
283 dreamcastcard->channel->flags |= 0x01;
284 aica_dma_transfer(runtime->channels, buffer_size,
285 dreamcastcard->substream);
286 startup_aica(dreamcastcard);
287 dreamcastcard->clicks =
288 buffer_size / (AICA_PERIOD_SIZE * runtime->channels);
289 return;
290 } else {
291 aica_dma_transfer(runtime->channels,
292 AICA_PERIOD_SIZE * runtime->channels,
293 dreamcastcard->substream);
294 snd_pcm_period_elapsed(dreamcastcard->substream);
295 dreamcastcard->clicks++;
296 if (unlikely(dreamcastcard->clicks >= AICA_PERIOD_NUMBER))
297 dreamcastcard->clicks %= AICA_PERIOD_NUMBER;
298 mod_timer(&dreamcastcard->timer, jiffies + 1);
302 static void aica_period_elapsed(unsigned long timer_var)
304 /*timer function - so cannot sleep */
305 int play_period;
306 struct snd_pcm_runtime *runtime;
307 struct snd_pcm_substream *substream;
308 struct snd_card_aica *dreamcastcard;
309 substream = (struct snd_pcm_substream *) timer_var;
310 runtime = substream->runtime;
311 dreamcastcard = substream->pcm->private_data;
312 /* Have we played out an additional period? */
313 play_period =
314 frames_to_bytes(runtime,
315 readl
316 (AICA_CONTROL_CHANNEL_SAMPLE_NUMBER)) /
317 AICA_PERIOD_SIZE;
318 if (play_period == dreamcastcard->current_period) {
319 /* reschedule the timer */
320 mod_timer(&(dreamcastcard->timer), jiffies + 1);
321 return;
323 if (runtime->channels > 1)
324 dreamcastcard->current_period = play_period;
325 if (unlikely(dreamcastcard->dma_check == 0))
326 dreamcastcard->dma_check = 1;
327 schedule_work(&(dreamcastcard->spu_dma_work));
330 static void spu_begin_dma(struct snd_pcm_substream *substream)
332 struct snd_card_aica *dreamcastcard;
333 struct snd_pcm_runtime *runtime;
334 runtime = substream->runtime;
335 dreamcastcard = substream->pcm->private_data;
336 /*get the queue to do the work */
337 schedule_work(&(dreamcastcard->spu_dma_work));
338 /* Timer may already be running */
339 if (unlikely(dreamcastcard->timer.data)) {
340 mod_timer(&dreamcastcard->timer, jiffies + 4);
341 return;
343 setup_timer(&dreamcastcard->timer, aica_period_elapsed,
344 (unsigned long) substream);
345 mod_timer(&dreamcastcard->timer, jiffies + 4);
348 static int snd_aicapcm_pcm_open(struct snd_pcm_substream
349 *substream)
351 struct snd_pcm_runtime *runtime;
352 struct aica_channel *channel;
353 struct snd_card_aica *dreamcastcard;
354 if (!enable)
355 return -ENOENT;
356 dreamcastcard = substream->pcm->private_data;
357 channel = kmalloc(sizeof(struct aica_channel), GFP_KERNEL);
358 if (!channel)
359 return -ENOMEM;
360 /* set defaults for channel */
361 channel->sfmt = SM_8BIT;
362 channel->cmd = AICA_CMD_START;
363 channel->vol = dreamcastcard->master_volume;
364 channel->pan = 0x80;
365 channel->pos = 0;
366 channel->flags = 0; /* default to mono */
367 dreamcastcard->channel = channel;
368 runtime = substream->runtime;
369 runtime->hw = snd_pcm_aica_playback_hw;
370 spu_enable();
371 dreamcastcard->clicks = 0;
372 dreamcastcard->current_period = 0;
373 dreamcastcard->dma_check = 0;
374 return 0;
377 static int snd_aicapcm_pcm_close(struct snd_pcm_substream
378 *substream)
380 struct snd_card_aica *dreamcastcard = substream->pcm->private_data;
381 flush_work(&(dreamcastcard->spu_dma_work));
382 if (dreamcastcard->timer.data)
383 del_timer(&dreamcastcard->timer);
384 kfree(dreamcastcard->channel);
385 spu_disable();
386 return 0;
389 static int snd_aicapcm_pcm_hw_free(struct snd_pcm_substream
390 *substream)
392 /* Free the DMA buffer */
393 return snd_pcm_lib_free_pages(substream);
396 static int snd_aicapcm_pcm_hw_params(struct snd_pcm_substream
397 *substream, struct snd_pcm_hw_params
398 *hw_params)
400 /* Allocate a DMA buffer using ALSA built-ins */
401 return
402 snd_pcm_lib_malloc_pages(substream,
403 params_buffer_bytes(hw_params));
406 static int snd_aicapcm_pcm_prepare(struct snd_pcm_substream
407 *substream)
409 struct snd_card_aica *dreamcastcard = substream->pcm->private_data;
410 if ((substream->runtime)->format == SNDRV_PCM_FORMAT_S16_LE)
411 dreamcastcard->channel->sfmt = SM_16BIT;
412 dreamcastcard->channel->freq = substream->runtime->rate;
413 dreamcastcard->substream = substream;
414 return 0;
417 static int snd_aicapcm_pcm_trigger(struct snd_pcm_substream
418 *substream, int cmd)
420 switch (cmd) {
421 case SNDRV_PCM_TRIGGER_START:
422 spu_begin_dma(substream);
423 break;
424 case SNDRV_PCM_TRIGGER_STOP:
425 aica_chn_halt();
426 break;
427 default:
428 return -EINVAL;
430 return 0;
433 static unsigned long snd_aicapcm_pcm_pointer(struct snd_pcm_substream
434 *substream)
436 return readl(AICA_CONTROL_CHANNEL_SAMPLE_NUMBER);
439 static struct snd_pcm_ops snd_aicapcm_playback_ops = {
440 .open = snd_aicapcm_pcm_open,
441 .close = snd_aicapcm_pcm_close,
442 .ioctl = snd_pcm_lib_ioctl,
443 .hw_params = snd_aicapcm_pcm_hw_params,
444 .hw_free = snd_aicapcm_pcm_hw_free,
445 .prepare = snd_aicapcm_pcm_prepare,
446 .trigger = snd_aicapcm_pcm_trigger,
447 .pointer = snd_aicapcm_pcm_pointer,
450 /* TO DO: set up to handle more than one pcm instance */
451 static int __init snd_aicapcmchip(struct snd_card_aica
452 *dreamcastcard, int pcm_index)
454 struct snd_pcm *pcm;
455 int err;
456 /* AICA has no capture ability */
457 err =
458 snd_pcm_new(dreamcastcard->card, "AICA PCM", pcm_index, 1, 0,
459 &pcm);
460 if (unlikely(err < 0))
461 return err;
462 pcm->private_data = dreamcastcard;
463 strcpy(pcm->name, "AICA PCM");
464 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
465 &snd_aicapcm_playback_ops);
466 /* Allocate the DMA buffers */
467 err =
468 snd_pcm_lib_preallocate_pages_for_all(pcm,
469 SNDRV_DMA_TYPE_CONTINUOUS,
470 snd_dma_continuous_data
471 (GFP_KERNEL),
472 AICA_BUFFER_SIZE,
473 AICA_BUFFER_SIZE);
474 return err;
477 /* Mixer controls */
478 #define aica_pcmswitch_info snd_ctl_boolean_mono_info
480 static int aica_pcmswitch_get(struct snd_kcontrol *kcontrol,
481 struct snd_ctl_elem_value *ucontrol)
483 ucontrol->value.integer.value[0] = 1; /* TO DO: Fix me */
484 return 0;
487 static int aica_pcmswitch_put(struct snd_kcontrol *kcontrol,
488 struct snd_ctl_elem_value *ucontrol)
490 if (ucontrol->value.integer.value[0] == 1)
491 return 0; /* TO DO: Fix me */
492 else
493 aica_chn_halt();
494 return 0;
497 static int aica_pcmvolume_info(struct snd_kcontrol *kcontrol,
498 struct snd_ctl_elem_info *uinfo)
500 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
501 uinfo->count = 1;
502 uinfo->value.integer.min = 0;
503 uinfo->value.integer.max = 0xFF;
504 return 0;
507 static int aica_pcmvolume_get(struct snd_kcontrol *kcontrol,
508 struct snd_ctl_elem_value *ucontrol)
510 struct snd_card_aica *dreamcastcard;
511 dreamcastcard = kcontrol->private_data;
512 if (unlikely(!dreamcastcard->channel))
513 return -ETXTBSY; /* we've not yet been set up */
514 ucontrol->value.integer.value[0] = dreamcastcard->channel->vol;
515 return 0;
518 static int aica_pcmvolume_put(struct snd_kcontrol *kcontrol,
519 struct snd_ctl_elem_value *ucontrol)
521 struct snd_card_aica *dreamcastcard;
522 unsigned int vol;
523 dreamcastcard = kcontrol->private_data;
524 if (unlikely(!dreamcastcard->channel))
525 return -ETXTBSY;
526 vol = ucontrol->value.integer.value[0];
527 if (vol > 0xff)
528 return -EINVAL;
529 if (unlikely(dreamcastcard->channel->vol == vol))
530 return 0;
531 dreamcastcard->channel->vol = ucontrol->value.integer.value[0];
532 dreamcastcard->master_volume = ucontrol->value.integer.value[0];
533 spu_memload(AICA_CHANNEL0_CONTROL_OFFSET,
534 dreamcastcard->channel, sizeof(struct aica_channel));
535 return 1;
538 static struct snd_kcontrol_new snd_aica_pcmswitch_control = {
539 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
540 .name = "PCM Playback Switch",
541 .index = 0,
542 .info = aica_pcmswitch_info,
543 .get = aica_pcmswitch_get,
544 .put = aica_pcmswitch_put
547 static struct snd_kcontrol_new snd_aica_pcmvolume_control = {
548 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
549 .name = "PCM Playback Volume",
550 .index = 0,
551 .info = aica_pcmvolume_info,
552 .get = aica_pcmvolume_get,
553 .put = aica_pcmvolume_put
556 static int load_aica_firmware(void)
558 int err;
559 const struct firmware *fw_entry;
560 spu_reset();
561 err = request_firmware(&fw_entry, "aica_firmware.bin", &pd->dev);
562 if (unlikely(err))
563 return err;
564 /* write firmware into memory */
565 spu_disable();
566 spu_memload(0, fw_entry->data, fw_entry->size);
567 spu_enable();
568 release_firmware(fw_entry);
569 return err;
572 static int add_aicamixer_controls(struct snd_card_aica *dreamcastcard)
574 int err;
575 err = snd_ctl_add
576 (dreamcastcard->card,
577 snd_ctl_new1(&snd_aica_pcmvolume_control, dreamcastcard));
578 if (unlikely(err < 0))
579 return err;
580 err = snd_ctl_add
581 (dreamcastcard->card,
582 snd_ctl_new1(&snd_aica_pcmswitch_control, dreamcastcard));
583 if (unlikely(err < 0))
584 return err;
585 return 0;
588 static int snd_aica_remove(struct platform_device *devptr)
590 struct snd_card_aica *dreamcastcard;
591 dreamcastcard = platform_get_drvdata(devptr);
592 if (unlikely(!dreamcastcard))
593 return -ENODEV;
594 snd_card_free(dreamcastcard->card);
595 kfree(dreamcastcard);
596 return 0;
599 static int snd_aica_probe(struct platform_device *devptr)
601 int err;
602 struct snd_card_aica *dreamcastcard;
603 dreamcastcard = kmalloc(sizeof(struct snd_card_aica), GFP_KERNEL);
604 if (unlikely(!dreamcastcard))
605 return -ENOMEM;
606 err = snd_card_new(&devptr->dev, index, SND_AICA_DRIVER,
607 THIS_MODULE, 0, &dreamcastcard->card);
608 if (unlikely(err < 0)) {
609 kfree(dreamcastcard);
610 return err;
612 strcpy(dreamcastcard->card->driver, "snd_aica");
613 strcpy(dreamcastcard->card->shortname, SND_AICA_DRIVER);
614 strcpy(dreamcastcard->card->longname,
615 "Yamaha AICA Super Intelligent Sound Processor for SEGA Dreamcast");
616 /* Prepare to use the queue */
617 INIT_WORK(&(dreamcastcard->spu_dma_work), run_spu_dma);
618 /* Load the PCM 'chip' */
619 err = snd_aicapcmchip(dreamcastcard, 0);
620 if (unlikely(err < 0))
621 goto freedreamcast;
622 dreamcastcard->timer.data = 0;
623 dreamcastcard->channel = NULL;
624 /* Add basic controls */
625 err = add_aicamixer_controls(dreamcastcard);
626 if (unlikely(err < 0))
627 goto freedreamcast;
628 /* Register the card with ALSA subsystem */
629 err = snd_card_register(dreamcastcard->card);
630 if (unlikely(err < 0))
631 goto freedreamcast;
632 platform_set_drvdata(devptr, dreamcastcard);
633 snd_printk
634 ("ALSA Driver for Yamaha AICA Super Intelligent Sound Processor\n");
635 return 0;
636 freedreamcast:
637 snd_card_free(dreamcastcard->card);
638 kfree(dreamcastcard);
639 return err;
642 static struct platform_driver snd_aica_driver = {
643 .probe = snd_aica_probe,
644 .remove = snd_aica_remove,
645 .driver = {
646 .name = SND_AICA_DRIVER,
650 static int __init aica_init(void)
652 int err;
653 err = platform_driver_register(&snd_aica_driver);
654 if (unlikely(err < 0))
655 return err;
656 pd = platform_device_register_simple(SND_AICA_DRIVER, -1,
657 aica_memory_space, 2);
658 if (IS_ERR(pd)) {
659 platform_driver_unregister(&snd_aica_driver);
660 return PTR_ERR(pd);
662 /* Load the firmware */
663 return load_aica_firmware();
666 static void __exit aica_exit(void)
668 platform_device_unregister(pd);
669 platform_driver_unregister(&snd_aica_driver);
670 /* Kill any sound still playing and reset ARM7 to safe state */
671 spu_reset();
674 module_init(aica_init);
675 module_exit(aica_exit);