[ALSA] cs4231-lib: replace common delay loop by function
[linux-2.6/verdex.git] / sound / drivers / opl3 / opl3_lib.c
blob87fe376f38f0c0744a6111195346f5f990daca76
1 /*
2 * Copyright (c) by Jaroslav Kysela <perex@suse.cz>,
3 * Hannu Savolainen 1993-1996,
4 * Rob Hooft
5 *
6 * Routines for control of AdLib FM cards (OPL2/OPL3/OPL4 chips)
8 * Most if code is ported from OSS/Lite.
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
26 #include <sound/opl3.h>
27 #include <asm/io.h>
28 #include <linux/delay.h>
29 #include <linux/init.h>
30 #include <linux/slab.h>
31 #include <linux/ioport.h>
32 #include <sound/minors.h>
34 MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>, Hannu Savolainen 1993-1996, Rob Hooft");
35 MODULE_DESCRIPTION("Routines for control of AdLib FM cards (OPL2/OPL3/OPL4 chips)");
36 MODULE_LICENSE("GPL");
38 extern char snd_opl3_regmap[MAX_OPL2_VOICES][4];
40 static void snd_opl2_command(struct snd_opl3 * opl3, unsigned short cmd, unsigned char val)
42 unsigned long flags;
43 unsigned long port;
46 * The original 2-OP synth requires a quite long delay
47 * after writing to a register.
50 port = (cmd & OPL3_RIGHT) ? opl3->r_port : opl3->l_port;
52 spin_lock_irqsave(&opl3->reg_lock, flags);
54 outb((unsigned char) cmd, port);
55 udelay(10);
57 outb((unsigned char) val, port + 1);
58 udelay(30);
60 spin_unlock_irqrestore(&opl3->reg_lock, flags);
63 static void snd_opl3_command(struct snd_opl3 * opl3, unsigned short cmd, unsigned char val)
65 unsigned long flags;
66 unsigned long port;
69 * The OPL-3 survives with just two INBs
70 * after writing to a register.
73 port = (cmd & OPL3_RIGHT) ? opl3->r_port : opl3->l_port;
75 spin_lock_irqsave(&opl3->reg_lock, flags);
77 outb((unsigned char) cmd, port);
78 inb(opl3->l_port);
79 inb(opl3->l_port);
81 outb((unsigned char) val, port + 1);
82 inb(opl3->l_port);
83 inb(opl3->l_port);
85 spin_unlock_irqrestore(&opl3->reg_lock, flags);
88 static int snd_opl3_detect(struct snd_opl3 * opl3)
91 * This function returns 1 if the FM chip is present at the given I/O port
92 * The detection algorithm plays with the timer built in the FM chip and
93 * looks for a change in the status register.
95 * Note! The timers of the FM chip are not connected to AdLib (and compatible)
96 * boards.
98 * Note2! The chip is initialized if detected.
101 unsigned char stat1, stat2, signature;
103 /* Reset timers 1 and 2 */
104 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_TIMER1_MASK | OPL3_TIMER2_MASK);
105 /* Reset the IRQ of the FM chip */
106 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_IRQ_RESET);
107 signature = stat1 = inb(opl3->l_port); /* Status register */
108 if ((stat1 & 0xe0) != 0x00) { /* Should be 0x00 */
109 snd_printd("OPL3: stat1 = 0x%x\n", stat1);
110 return -ENODEV;
112 /* Set timer1 to 0xff */
113 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER1, 0xff);
114 /* Unmask and start timer 1 */
115 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_TIMER2_MASK | OPL3_TIMER1_START);
116 /* Now we have to delay at least 80us */
117 udelay(200);
118 /* Read status after timers have expired */
119 stat2 = inb(opl3->l_port);
120 /* Stop the timers */
121 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_TIMER1_MASK | OPL3_TIMER2_MASK);
122 /* Reset the IRQ of the FM chip */
123 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_IRQ_RESET);
124 if ((stat2 & 0xe0) != 0xc0) { /* There is no YM3812 */
125 snd_printd("OPL3: stat2 = 0x%x\n", stat2);
126 return -ENODEV;
129 /* If the toplevel code knows exactly the type of chip, don't try
130 to detect it. */
131 if (opl3->hardware != OPL3_HW_AUTO)
132 return 0;
134 /* There is a FM chip on this address. Detect the type (OPL2 to OPL4) */
135 if (signature == 0x06) { /* OPL2 */
136 opl3->hardware = OPL3_HW_OPL2;
137 } else {
139 * If we had an OPL4 chip, opl3->hardware would have been set
140 * by the OPL4 driver; so we can assume OPL3 here.
142 snd_assert(opl3->r_port != 0, return -ENODEV);
143 opl3->hardware = OPL3_HW_OPL3;
145 return 0;
149 * AdLib timers
153 * Timer 1 - 80us
156 static int snd_opl3_timer1_start(struct snd_timer * timer)
158 unsigned long flags;
159 unsigned char tmp;
160 unsigned int ticks;
161 struct snd_opl3 *opl3;
163 opl3 = snd_timer_chip(timer);
164 spin_lock_irqsave(&opl3->timer_lock, flags);
165 ticks = timer->sticks;
166 tmp = (opl3->timer_enable | OPL3_TIMER1_START) & ~OPL3_TIMER1_MASK;
167 opl3->timer_enable = tmp;
168 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER1, 256 - ticks); /* timer 1 count */
169 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, tmp); /* enable timer 1 IRQ */
170 spin_unlock_irqrestore(&opl3->timer_lock, flags);
171 return 0;
174 static int snd_opl3_timer1_stop(struct snd_timer * timer)
176 unsigned long flags;
177 unsigned char tmp;
178 struct snd_opl3 *opl3;
180 opl3 = snd_timer_chip(timer);
181 spin_lock_irqsave(&opl3->timer_lock, flags);
182 tmp = (opl3->timer_enable | OPL3_TIMER1_MASK) & ~OPL3_TIMER1_START;
183 opl3->timer_enable = tmp;
184 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, tmp); /* disable timer #1 */
185 spin_unlock_irqrestore(&opl3->timer_lock, flags);
186 return 0;
190 * Timer 2 - 320us
193 static int snd_opl3_timer2_start(struct snd_timer * timer)
195 unsigned long flags;
196 unsigned char tmp;
197 unsigned int ticks;
198 struct snd_opl3 *opl3;
200 opl3 = snd_timer_chip(timer);
201 spin_lock_irqsave(&opl3->timer_lock, flags);
202 ticks = timer->sticks;
203 tmp = (opl3->timer_enable | OPL3_TIMER2_START) & ~OPL3_TIMER2_MASK;
204 opl3->timer_enable = tmp;
205 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER2, 256 - ticks); /* timer 1 count */
206 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, tmp); /* enable timer 1 IRQ */
207 spin_unlock_irqrestore(&opl3->timer_lock, flags);
208 return 0;
211 static int snd_opl3_timer2_stop(struct snd_timer * timer)
213 unsigned long flags;
214 unsigned char tmp;
215 struct snd_opl3 *opl3;
217 opl3 = snd_timer_chip(timer);
218 spin_lock_irqsave(&opl3->timer_lock, flags);
219 tmp = (opl3->timer_enable | OPL3_TIMER2_MASK) & ~OPL3_TIMER2_START;
220 opl3->timer_enable = tmp;
221 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, tmp); /* disable timer #1 */
222 spin_unlock_irqrestore(&opl3->timer_lock, flags);
223 return 0;
230 static struct snd_timer_hardware snd_opl3_timer1 =
232 .flags = SNDRV_TIMER_HW_STOP,
233 .resolution = 80000,
234 .ticks = 256,
235 .start = snd_opl3_timer1_start,
236 .stop = snd_opl3_timer1_stop,
239 static struct snd_timer_hardware snd_opl3_timer2 =
241 .flags = SNDRV_TIMER_HW_STOP,
242 .resolution = 320000,
243 .ticks = 256,
244 .start = snd_opl3_timer2_start,
245 .stop = snd_opl3_timer2_stop,
248 static int snd_opl3_timer1_init(struct snd_opl3 * opl3, int timer_no)
250 struct snd_timer *timer = NULL;
251 struct snd_timer_id tid;
252 int err;
254 tid.dev_class = SNDRV_TIMER_CLASS_CARD;
255 tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
256 tid.card = opl3->card->number;
257 tid.device = timer_no;
258 tid.subdevice = 0;
259 if ((err = snd_timer_new(opl3->card, "AdLib timer #1", &tid, &timer)) >= 0) {
260 strcpy(timer->name, "AdLib timer #1");
261 timer->private_data = opl3;
262 timer->hw = snd_opl3_timer1;
264 opl3->timer1 = timer;
265 return err;
268 static int snd_opl3_timer2_init(struct snd_opl3 * opl3, int timer_no)
270 struct snd_timer *timer = NULL;
271 struct snd_timer_id tid;
272 int err;
274 tid.dev_class = SNDRV_TIMER_CLASS_CARD;
275 tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
276 tid.card = opl3->card->number;
277 tid.device = timer_no;
278 tid.subdevice = 0;
279 if ((err = snd_timer_new(opl3->card, "AdLib timer #2", &tid, &timer)) >= 0) {
280 strcpy(timer->name, "AdLib timer #2");
281 timer->private_data = opl3;
282 timer->hw = snd_opl3_timer2;
284 opl3->timer2 = timer;
285 return err;
292 void snd_opl3_interrupt(struct snd_hwdep * hw)
294 unsigned char status;
295 struct snd_opl3 *opl3;
296 struct snd_timer *timer;
298 if (hw == NULL)
299 return;
301 opl3 = hw->private_data;
302 status = inb(opl3->l_port);
303 #if 0
304 snd_printk("AdLib IRQ status = 0x%x\n", status);
305 #endif
306 if (!(status & 0x80))
307 return;
309 if (status & 0x40) {
310 timer = opl3->timer1;
311 snd_timer_interrupt(timer, timer->sticks);
313 if (status & 0x20) {
314 timer = opl3->timer2;
315 snd_timer_interrupt(timer, timer->sticks);
319 EXPORT_SYMBOL(snd_opl3_interrupt);
325 static int snd_opl3_free(struct snd_opl3 *opl3)
327 snd_assert(opl3 != NULL, return -ENXIO);
328 if (opl3->private_free)
329 opl3->private_free(opl3);
330 release_and_free_resource(opl3->res_l_port);
331 release_and_free_resource(opl3->res_r_port);
332 kfree(opl3);
333 return 0;
336 static int snd_opl3_dev_free(struct snd_device *device)
338 struct snd_opl3 *opl3 = device->device_data;
339 return snd_opl3_free(opl3);
342 int snd_opl3_new(struct snd_card *card,
343 unsigned short hardware,
344 struct snd_opl3 **ropl3)
346 static struct snd_device_ops ops = {
347 .dev_free = snd_opl3_dev_free,
349 struct snd_opl3 *opl3;
350 int err;
352 *ropl3 = NULL;
353 opl3 = kzalloc(sizeof(*opl3), GFP_KERNEL);
354 if (opl3 == NULL) {
355 snd_printk(KERN_ERR "opl3: cannot allocate\n");
356 return -ENOMEM;
359 opl3->card = card;
360 opl3->hardware = hardware;
361 spin_lock_init(&opl3->reg_lock);
362 spin_lock_init(&opl3->timer_lock);
363 mutex_init(&opl3->access_mutex);
365 if ((err = snd_device_new(card, SNDRV_DEV_CODEC, opl3, &ops)) < 0) {
366 snd_opl3_free(opl3);
367 return err;
370 *ropl3 = opl3;
371 return 0;
374 EXPORT_SYMBOL(snd_opl3_new);
376 int snd_opl3_init(struct snd_opl3 *opl3)
378 if (! opl3->command) {
379 printk(KERN_ERR "snd_opl3_init: command not defined!\n");
380 return -EINVAL;
383 opl3->command(opl3, OPL3_LEFT | OPL3_REG_TEST, OPL3_ENABLE_WAVE_SELECT);
384 /* Melodic mode */
385 opl3->command(opl3, OPL3_LEFT | OPL3_REG_PERCUSSION, 0x00);
387 switch (opl3->hardware & OPL3_HW_MASK) {
388 case OPL3_HW_OPL2:
389 opl3->max_voices = MAX_OPL2_VOICES;
390 break;
391 case OPL3_HW_OPL3:
392 case OPL3_HW_OPL4:
393 opl3->max_voices = MAX_OPL3_VOICES;
394 /* Enter OPL3 mode */
395 opl3->command(opl3, OPL3_RIGHT | OPL3_REG_MODE, OPL3_OPL3_ENABLE);
397 return 0;
400 EXPORT_SYMBOL(snd_opl3_init);
402 int snd_opl3_create(struct snd_card *card,
403 unsigned long l_port,
404 unsigned long r_port,
405 unsigned short hardware,
406 int integrated,
407 struct snd_opl3 ** ropl3)
409 struct snd_opl3 *opl3;
410 int err;
412 *ropl3 = NULL;
413 if ((err = snd_opl3_new(card, hardware, &opl3)) < 0)
414 return err;
415 if (! integrated) {
416 if ((opl3->res_l_port = request_region(l_port, 2, "OPL2/3 (left)")) == NULL) {
417 snd_printk(KERN_ERR "opl3: can't grab left port 0x%lx\n", l_port);
418 snd_device_free(card, opl3);
419 return -EBUSY;
421 if (r_port != 0 &&
422 (opl3->res_r_port = request_region(r_port, 2, "OPL2/3 (right)")) == NULL) {
423 snd_printk(KERN_ERR "opl3: can't grab right port 0x%lx\n", r_port);
424 snd_device_free(card, opl3);
425 return -EBUSY;
428 opl3->l_port = l_port;
429 opl3->r_port = r_port;
431 switch (opl3->hardware) {
432 /* some hardware doesn't support timers */
433 case OPL3_HW_OPL3_SV:
434 case OPL3_HW_OPL3_CS:
435 case OPL3_HW_OPL3_FM801:
436 opl3->command = &snd_opl3_command;
437 break;
438 default:
439 opl3->command = &snd_opl2_command;
440 if ((err = snd_opl3_detect(opl3)) < 0) {
441 snd_printd("OPL2/3 chip not detected at 0x%lx/0x%lx\n",
442 opl3->l_port, opl3->r_port);
443 snd_device_free(card, opl3);
444 return err;
446 /* detect routine returns correct hardware type */
447 switch (opl3->hardware & OPL3_HW_MASK) {
448 case OPL3_HW_OPL3:
449 case OPL3_HW_OPL4:
450 opl3->command = &snd_opl3_command;
454 snd_opl3_init(opl3);
456 *ropl3 = opl3;
457 return 0;
460 EXPORT_SYMBOL(snd_opl3_create);
462 int snd_opl3_timer_new(struct snd_opl3 * opl3, int timer1_dev, int timer2_dev)
464 int err;
466 if (timer1_dev >= 0)
467 if ((err = snd_opl3_timer1_init(opl3, timer1_dev)) < 0)
468 return err;
469 if (timer2_dev >= 0) {
470 if ((err = snd_opl3_timer2_init(opl3, timer2_dev)) < 0) {
471 snd_device_free(opl3->card, opl3->timer1);
472 opl3->timer1 = NULL;
473 return err;
476 return 0;
479 EXPORT_SYMBOL(snd_opl3_timer_new);
481 int snd_opl3_hwdep_new(struct snd_opl3 * opl3,
482 int device, int seq_device,
483 struct snd_hwdep ** rhwdep)
485 struct snd_hwdep *hw;
486 struct snd_card *card = opl3->card;
487 int err;
489 if (rhwdep)
490 *rhwdep = NULL;
492 /* create hardware dependent device (direct FM) */
494 if ((err = snd_hwdep_new(card, "OPL2/OPL3", device, &hw)) < 0) {
495 snd_device_free(card, opl3);
496 return err;
498 hw->private_data = opl3;
499 #ifdef CONFIG_SND_OSSEMUL
500 if (device == 0) {
501 hw->oss_type = SNDRV_OSS_DEVICE_TYPE_DMFM;
502 sprintf(hw->oss_dev, "dmfm%i", card->number);
504 #endif
505 strcpy(hw->name, hw->id);
506 switch (opl3->hardware & OPL3_HW_MASK) {
507 case OPL3_HW_OPL2:
508 strcpy(hw->name, "OPL2 FM");
509 hw->iface = SNDRV_HWDEP_IFACE_OPL2;
510 break;
511 case OPL3_HW_OPL3:
512 strcpy(hw->name, "OPL3 FM");
513 hw->iface = SNDRV_HWDEP_IFACE_OPL3;
514 break;
515 case OPL3_HW_OPL4:
516 strcpy(hw->name, "OPL4 FM");
517 hw->iface = SNDRV_HWDEP_IFACE_OPL4;
518 break;
521 /* operators - only ioctl */
522 hw->ops.open = snd_opl3_open;
523 hw->ops.ioctl = snd_opl3_ioctl;
524 hw->ops.release = snd_opl3_release;
526 opl3->seq_dev_num = seq_device;
527 #if defined(CONFIG_SND_SEQUENCER) || (defined(MODULE) && defined(CONFIG_SND_SEQUENCER_MODULE))
528 if (snd_seq_device_new(card, seq_device, SNDRV_SEQ_DEV_ID_OPL3,
529 sizeof(struct snd_opl3 *), &opl3->seq_dev) >= 0) {
530 strcpy(opl3->seq_dev->name, hw->name);
531 *(struct snd_opl3 **)SNDRV_SEQ_DEVICE_ARGPTR(opl3->seq_dev) = opl3;
533 #endif
534 if (rhwdep)
535 *rhwdep = hw;
536 return 0;
539 EXPORT_SYMBOL(snd_opl3_hwdep_new);
542 * INIT part
545 static int __init alsa_opl3_init(void)
547 return 0;
550 static void __exit alsa_opl3_exit(void)
554 module_init(alsa_opl3_init)
555 module_exit(alsa_opl3_exit)