drivers/net/wireless/ipw2x00: fix sparse warnings: make symbols static
[linux-2.6/mini2440.git] / sound / isa / sscape.c
blob48a16d865834b023704eea64b0c27d062bc6dc94
1 /*
2 * Low-level ALSA driver for the ENSONIQ SoundScape PnP
3 * Copyright (c) by Chris Rankin
5 * This driver was written in part using information obtained from
6 * the OSS/Free SoundScape driver, written by Hannu Savolainen.
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
24 #include <linux/init.h>
25 #include <linux/err.h>
26 #include <linux/isa.h>
27 #include <linux/delay.h>
28 #include <linux/pnp.h>
29 #include <linux/spinlock.h>
30 #include <linux/moduleparam.h>
31 #include <asm/dma.h>
32 #include <sound/core.h>
33 #include <sound/hwdep.h>
34 #include <sound/wss.h>
35 #include <sound/mpu401.h>
36 #include <sound/initval.h>
38 #include <sound/sscape_ioctl.h>
41 MODULE_AUTHOR("Chris Rankin");
42 MODULE_DESCRIPTION("ENSONIQ SoundScape PnP driver");
43 MODULE_LICENSE("GPL");
45 static int index[SNDRV_CARDS] __devinitdata = SNDRV_DEFAULT_IDX;
46 static char* id[SNDRV_CARDS] __devinitdata = SNDRV_DEFAULT_STR;
47 static long port[SNDRV_CARDS] __devinitdata = SNDRV_DEFAULT_PORT;
48 static long wss_port[SNDRV_CARDS] __devinitdata = SNDRV_DEFAULT_PORT;
49 static int irq[SNDRV_CARDS] __devinitdata = SNDRV_DEFAULT_IRQ;
50 static int mpu_irq[SNDRV_CARDS] __devinitdata = SNDRV_DEFAULT_IRQ;
51 static int dma[SNDRV_CARDS] __devinitdata = SNDRV_DEFAULT_DMA;
52 static int dma2[SNDRV_CARDS] __devinitdata = SNDRV_DEFAULT_DMA;
54 module_param_array(index, int, NULL, 0444);
55 MODULE_PARM_DESC(index, "Index number for SoundScape soundcard");
57 module_param_array(id, charp, NULL, 0444);
58 MODULE_PARM_DESC(id, "Description for SoundScape card");
60 module_param_array(port, long, NULL, 0444);
61 MODULE_PARM_DESC(port, "Port # for SoundScape driver.");
63 module_param_array(wss_port, long, NULL, 0444);
64 MODULE_PARM_DESC(wss_port, "WSS Port # for SoundScape driver.");
66 module_param_array(irq, int, NULL, 0444);
67 MODULE_PARM_DESC(irq, "IRQ # for SoundScape driver.");
69 module_param_array(mpu_irq, int, NULL, 0444);
70 MODULE_PARM_DESC(mpu_irq, "MPU401 IRQ # for SoundScape driver.");
72 module_param_array(dma, int, NULL, 0444);
73 MODULE_PARM_DESC(dma, "DMA # for SoundScape driver.");
75 module_param_array(dma2, int, NULL, 0444);
76 MODULE_PARM_DESC(dma2, "DMA2 # for SoundScape driver.");
78 #ifdef CONFIG_PNP
79 static int isa_registered;
80 static int pnp_registered;
82 static struct pnp_card_device_id sscape_pnpids[] = {
83 { .id = "ENS3081", .devs = { { "ENS0000" } } }, /* Soundscape PnP */
84 { .id = "ENS4081", .devs = { { "ENS1011" } } }, /* VIVO90 */
85 { .id = "" } /* end */
88 MODULE_DEVICE_TABLE(pnp_card, sscape_pnpids);
89 #endif
92 #define MPU401_IO(i) ((i) + 0)
93 #define MIDI_DATA_IO(i) ((i) + 0)
94 #define MIDI_CTRL_IO(i) ((i) + 1)
95 #define HOST_CTRL_IO(i) ((i) + 2)
96 #define HOST_DATA_IO(i) ((i) + 3)
97 #define ODIE_ADDR_IO(i) ((i) + 4)
98 #define ODIE_DATA_IO(i) ((i) + 5)
99 #define CODEC_IO(i) ((i) + 8)
101 #define IC_ODIE 1
102 #define IC_OPUS 2
104 #define RX_READY 0x01
105 #define TX_READY 0x02
107 #define CMD_ACK 0x80
108 #define CMD_SET_MIDI_VOL 0x84
109 #define CMD_GET_MIDI_VOL 0x85
110 #define CMD_XXX_MIDI_VOL 0x86
111 #define CMD_SET_EXTMIDI 0x8a
112 #define CMD_GET_EXTMIDI 0x8b
113 #define CMD_SET_MT32 0x8c
114 #define CMD_GET_MT32 0x8d
116 enum GA_REG {
117 GA_INTSTAT_REG = 0,
118 GA_INTENA_REG,
119 GA_DMAA_REG,
120 GA_DMAB_REG,
121 GA_INTCFG_REG,
122 GA_DMACFG_REG,
123 GA_CDCFG_REG,
124 GA_SMCFGA_REG,
125 GA_SMCFGB_REG,
126 GA_HMCTL_REG
129 #define DMA_8BIT 0x80
132 #define AD1845_FREQ_SEL_MSB 0x16
133 #define AD1845_FREQ_SEL_LSB 0x17
135 enum card_type {
136 SSCAPE,
137 SSCAPE_PNP,
138 SSCAPE_VIVO,
141 struct soundscape {
142 spinlock_t lock;
143 unsigned io_base;
144 unsigned wss_base;
145 int codec_type;
146 int ic_type;
147 enum card_type type;
148 struct resource *io_res;
149 struct resource *wss_res;
150 struct snd_wss *chip;
151 struct snd_mpu401 *mpu;
152 struct snd_hwdep *hw;
155 * The MIDI device won't work until we've loaded
156 * its firmware via a hardware-dependent device IOCTL
158 spinlock_t fwlock;
159 int hw_in_use;
160 unsigned long midi_usage;
161 unsigned char midi_vol;
164 #define INVALID_IRQ ((unsigned)-1)
167 static inline struct soundscape *get_card_soundscape(struct snd_card *c)
169 return (struct soundscape *) (c->private_data);
172 static inline struct soundscape *get_mpu401_soundscape(struct snd_mpu401 * mpu)
174 return (struct soundscape *) (mpu->private_data);
177 static inline struct soundscape *get_hwdep_soundscape(struct snd_hwdep * hw)
179 return (struct soundscape *) (hw->private_data);
184 * Allocates some kernel memory that we can use for DMA.
185 * I think this means that the memory has to map to
186 * contiguous pages of physical memory.
188 static struct snd_dma_buffer *get_dmabuf(struct snd_dma_buffer *buf, unsigned long size)
190 if (buf) {
191 if (snd_dma_alloc_pages_fallback(SNDRV_DMA_TYPE_DEV, snd_dma_isa_data(),
192 size, buf) < 0) {
193 snd_printk(KERN_ERR "sscape: Failed to allocate %lu bytes for DMA\n", size);
194 return NULL;
198 return buf;
202 * Release the DMA-able kernel memory ...
204 static void free_dmabuf(struct snd_dma_buffer *buf)
206 if (buf && buf->area)
207 snd_dma_free_pages(buf);
212 * This function writes to the SoundScape's control registers,
213 * but doesn't do any locking. It's up to the caller to do that.
214 * This is why this function is "unsafe" ...
216 static inline void sscape_write_unsafe(unsigned io_base, enum GA_REG reg, unsigned char val)
218 outb(reg, ODIE_ADDR_IO(io_base));
219 outb(val, ODIE_DATA_IO(io_base));
223 * Write to the SoundScape's control registers, and do the
224 * necessary locking ...
226 static void sscape_write(struct soundscape *s, enum GA_REG reg, unsigned char val)
228 unsigned long flags;
230 spin_lock_irqsave(&s->lock, flags);
231 sscape_write_unsafe(s->io_base, reg, val);
232 spin_unlock_irqrestore(&s->lock, flags);
236 * Read from the SoundScape's control registers, but leave any
237 * locking to the caller. This is why the function is "unsafe" ...
239 static inline unsigned char sscape_read_unsafe(unsigned io_base, enum GA_REG reg)
241 outb(reg, ODIE_ADDR_IO(io_base));
242 return inb(ODIE_DATA_IO(io_base));
246 * Puts the SoundScape into "host" mode, as compared to "MIDI" mode
248 static inline void set_host_mode_unsafe(unsigned io_base)
250 outb(0x0, HOST_CTRL_IO(io_base));
254 * Puts the SoundScape into "MIDI" mode, as compared to "host" mode
256 static inline void set_midi_mode_unsafe(unsigned io_base)
258 outb(0x3, HOST_CTRL_IO(io_base));
262 * Read the SoundScape's host-mode control register, but leave
263 * any locking issues to the caller ...
265 static inline int host_read_unsafe(unsigned io_base)
267 int data = -1;
268 if ((inb(HOST_CTRL_IO(io_base)) & RX_READY) != 0) {
269 data = inb(HOST_DATA_IO(io_base));
272 return data;
276 * Read the SoundScape's host-mode control register, performing
277 * a limited amount of busy-waiting if the register isn't ready.
278 * Also leaves all locking-issues to the caller ...
280 static int host_read_ctrl_unsafe(unsigned io_base, unsigned timeout)
282 int data;
284 while (((data = host_read_unsafe(io_base)) < 0) && (timeout != 0)) {
285 udelay(100);
286 --timeout;
287 } /* while */
289 return data;
293 * Write to the SoundScape's host-mode control registers, but
294 * leave any locking issues to the caller ...
296 static inline int host_write_unsafe(unsigned io_base, unsigned char data)
298 if ((inb(HOST_CTRL_IO(io_base)) & TX_READY) != 0) {
299 outb(data, HOST_DATA_IO(io_base));
300 return 1;
303 return 0;
307 * Write to the SoundScape's host-mode control registers, performing
308 * a limited amount of busy-waiting if the register isn't ready.
309 * Also leaves all locking-issues to the caller ...
311 static int host_write_ctrl_unsafe(unsigned io_base, unsigned char data,
312 unsigned timeout)
314 int err;
316 while (!(err = host_write_unsafe(io_base, data)) && (timeout != 0)) {
317 udelay(100);
318 --timeout;
319 } /* while */
321 return err;
326 * Check that the MIDI subsystem is operational. If it isn't,
327 * then we will hang the computer if we try to use it ...
329 * NOTE: This check is based upon observation, not documentation.
331 static inline int verify_mpu401(const struct snd_mpu401 * mpu)
333 return ((inb(MIDI_CTRL_IO(mpu->port)) & 0xc0) == 0x80);
337 * This is apparently the standard way to initailise an MPU-401
339 static inline void initialise_mpu401(const struct snd_mpu401 * mpu)
341 outb(0, MIDI_DATA_IO(mpu->port));
345 * Tell the SoundScape to activate the AD1845 chip (I think).
346 * The AD1845 detection fails if we *don't* do this, so I
347 * think that this is a good idea ...
349 static inline void activate_ad1845_unsafe(unsigned io_base)
351 sscape_write_unsafe(io_base, GA_HMCTL_REG, (sscape_read_unsafe(io_base, GA_HMCTL_REG) & 0xcf) | 0x10);
352 sscape_write_unsafe(io_base, GA_CDCFG_REG, 0x80);
356 * Do the necessary ALSA-level cleanup to deallocate our driver ...
358 static void soundscape_free(struct snd_card *c)
360 struct soundscape *sscape = get_card_soundscape(c);
361 release_and_free_resource(sscape->io_res);
362 release_and_free_resource(sscape->wss_res);
363 free_dma(sscape->chip->dma1);
367 * Tell the SoundScape to begin a DMA tranfer using the given channel.
368 * All locking issues are left to the caller.
370 static inline void sscape_start_dma_unsafe(unsigned io_base, enum GA_REG reg)
372 sscape_write_unsafe(io_base, reg, sscape_read_unsafe(io_base, reg) | 0x01);
373 sscape_write_unsafe(io_base, reg, sscape_read_unsafe(io_base, reg) & 0xfe);
377 * Wait for a DMA transfer to complete. This is a "limited busy-wait",
378 * and all locking issues are left to the caller.
380 static int sscape_wait_dma_unsafe(unsigned io_base, enum GA_REG reg, unsigned timeout)
382 while (!(sscape_read_unsafe(io_base, reg) & 0x01) && (timeout != 0)) {
383 udelay(100);
384 --timeout;
385 } /* while */
387 return (sscape_read_unsafe(io_base, reg) & 0x01);
391 * Wait for the On-Board Processor to return its start-up
392 * acknowledgement sequence. This wait is too long for
393 * us to perform "busy-waiting", and so we must sleep.
394 * This in turn means that we must not be holding any
395 * spinlocks when we call this function.
397 static int obp_startup_ack(struct soundscape *s, unsigned timeout)
399 while (timeout != 0) {
400 unsigned long flags;
401 unsigned char x;
403 schedule_timeout_uninterruptible(1);
405 spin_lock_irqsave(&s->lock, flags);
406 x = inb(HOST_DATA_IO(s->io_base));
407 spin_unlock_irqrestore(&s->lock, flags);
408 if ((x & 0xfe) == 0xfe)
409 return 1;
411 --timeout;
412 } /* while */
414 return 0;
418 * Wait for the host to return its start-up acknowledgement
419 * sequence. This wait is too long for us to perform
420 * "busy-waiting", and so we must sleep. This in turn means
421 * that we must not be holding any spinlocks when we call
422 * this function.
424 static int host_startup_ack(struct soundscape *s, unsigned timeout)
426 while (timeout != 0) {
427 unsigned long flags;
428 unsigned char x;
430 schedule_timeout_uninterruptible(1);
432 spin_lock_irqsave(&s->lock, flags);
433 x = inb(HOST_DATA_IO(s->io_base));
434 spin_unlock_irqrestore(&s->lock, flags);
435 if (x == 0xfe)
436 return 1;
438 --timeout;
439 } /* while */
441 return 0;
445 * Upload a byte-stream into the SoundScape using DMA channel A.
447 static int upload_dma_data(struct soundscape *s,
448 const unsigned char __user *data,
449 size_t size)
451 unsigned long flags;
452 struct snd_dma_buffer dma;
453 int ret;
455 if (!get_dmabuf(&dma, PAGE_ALIGN(size)))
456 return -ENOMEM;
458 spin_lock_irqsave(&s->lock, flags);
461 * Reset the board ...
463 sscape_write_unsafe(s->io_base, GA_HMCTL_REG, sscape_read_unsafe(s->io_base, GA_HMCTL_REG) & 0x3f);
466 * Enable the DMA channels and configure them ...
468 sscape_write_unsafe(s->io_base, GA_DMACFG_REG, 0x50);
469 sscape_write_unsafe(s->io_base, GA_DMAA_REG, (s->chip->dma1 << 4) | DMA_8BIT);
470 sscape_write_unsafe(s->io_base, GA_DMAB_REG, 0x20);
473 * Take the board out of reset ...
475 sscape_write_unsafe(s->io_base, GA_HMCTL_REG, sscape_read_unsafe(s->io_base, GA_HMCTL_REG) | 0x80);
478 * Upload the user's data (firmware?) to the SoundScape
479 * board through the DMA channel ...
481 while (size != 0) {
482 unsigned long len;
485 * Apparently, copying to/from userspace can sleep.
486 * We are therefore forbidden from holding any
487 * spinlocks while we copy ...
489 spin_unlock_irqrestore(&s->lock, flags);
492 * Remember that the data that we want to DMA
493 * comes from USERSPACE. We have already verified
494 * the userspace pointer ...
496 len = min(size, dma.bytes);
497 len -= __copy_from_user(dma.area, data, len);
498 data += len;
499 size -= len;
502 * Grab that spinlock again, now that we've
503 * finished copying!
505 spin_lock_irqsave(&s->lock, flags);
507 snd_dma_program(s->chip->dma1, dma.addr, len, DMA_MODE_WRITE);
508 sscape_start_dma_unsafe(s->io_base, GA_DMAA_REG);
509 if (!sscape_wait_dma_unsafe(s->io_base, GA_DMAA_REG, 5000)) {
511 * Don't forget to release this spinlock we're holding ...
513 spin_unlock_irqrestore(&s->lock, flags);
515 snd_printk(KERN_ERR "sscape: DMA upload has timed out\n");
516 ret = -EAGAIN;
517 goto _release_dma;
519 } /* while */
521 set_host_mode_unsafe(s->io_base);
524 * Boot the board ... (I think)
526 sscape_write_unsafe(s->io_base, GA_HMCTL_REG, sscape_read_unsafe(s->io_base, GA_HMCTL_REG) | 0x40);
527 spin_unlock_irqrestore(&s->lock, flags);
530 * If all has gone well, then the board should acknowledge
531 * the new upload and tell us that it has rebooted OK. We
532 * give it 5 seconds (max) ...
534 ret = 0;
535 if (!obp_startup_ack(s, 5)) {
536 snd_printk(KERN_ERR "sscape: No response from on-board processor after upload\n");
537 ret = -EAGAIN;
538 } else if (!host_startup_ack(s, 5)) {
539 snd_printk(KERN_ERR "sscape: SoundScape failed to initialise\n");
540 ret = -EAGAIN;
543 _release_dma:
545 * NOTE!!! We are NOT holding any spinlocks at this point !!!
547 sscape_write(s, GA_DMAA_REG, (s->ic_type == IC_ODIE ? 0x70 : 0x40));
548 free_dmabuf(&dma);
550 return ret;
554 * Upload the bootblock(?) into the SoundScape. The only
555 * purpose of this block of code seems to be to tell
556 * us which version of the microcode we should be using.
558 * NOTE: The boot-block data resides in USER-SPACE!!!
559 * However, we have already verified its memory
560 * addresses by the time we get here.
562 static int sscape_upload_bootblock(struct soundscape *sscape, struct sscape_bootblock __user *bb)
564 unsigned long flags;
565 int data = 0;
566 int ret;
568 ret = upload_dma_data(sscape, bb->code, sizeof(bb->code));
570 spin_lock_irqsave(&sscape->lock, flags);
571 if (ret == 0) {
572 data = host_read_ctrl_unsafe(sscape->io_base, 100);
574 set_midi_mode_unsafe(sscape->io_base);
575 spin_unlock_irqrestore(&sscape->lock, flags);
577 if (ret == 0) {
578 if (data < 0) {
579 snd_printk(KERN_ERR "sscape: timeout reading firmware version\n");
580 ret = -EAGAIN;
582 else if (__copy_to_user(&bb->version, &data, sizeof(bb->version))) {
583 ret = -EFAULT;
587 return ret;
591 * Upload the microcode into the SoundScape. The
592 * microcode is 64K of data, and if we try to copy
593 * it into a local variable then we will SMASH THE
594 * KERNEL'S STACK! We therefore leave it in USER
595 * SPACE, and save ourselves from copying it at all.
597 static int sscape_upload_microcode(struct soundscape *sscape,
598 const struct sscape_microcode __user *mc)
600 unsigned long flags;
601 char __user *code;
602 int err;
605 * We are going to have to copy this data into a special
606 * DMA-able buffer before we can upload it. We shall therefore
607 * just check that the data pointer is valid for now.
609 * NOTE: This buffer is 64K long! That's WAY too big to
610 * copy into a stack-temporary anyway.
612 if ( get_user(code, &mc->code) ||
613 !access_ok(VERIFY_READ, code, SSCAPE_MICROCODE_SIZE) )
614 return -EFAULT;
616 if ((err = upload_dma_data(sscape, code, SSCAPE_MICROCODE_SIZE)) == 0) {
617 snd_printk(KERN_INFO "sscape: MIDI firmware loaded\n");
620 spin_lock_irqsave(&sscape->lock, flags);
621 set_midi_mode_unsafe(sscape->io_base);
622 spin_unlock_irqrestore(&sscape->lock, flags);
624 initialise_mpu401(sscape->mpu);
626 return err;
630 * Hardware-specific device functions, to implement special
631 * IOCTLs for the SoundScape card. This is how we upload
632 * the microcode into the card, for example, and so we
633 * must ensure that no two processes can open this device
634 * simultaneously, and that we can't open it at all if
635 * someone is using the MIDI device.
637 static int sscape_hw_open(struct snd_hwdep * hw, struct file *file)
639 register struct soundscape *sscape = get_hwdep_soundscape(hw);
640 unsigned long flags;
641 int err;
643 spin_lock_irqsave(&sscape->fwlock, flags);
645 if ((sscape->midi_usage != 0) || sscape->hw_in_use) {
646 err = -EBUSY;
647 } else {
648 sscape->hw_in_use = 1;
649 err = 0;
652 spin_unlock_irqrestore(&sscape->fwlock, flags);
653 return err;
656 static int sscape_hw_release(struct snd_hwdep * hw, struct file *file)
658 register struct soundscape *sscape = get_hwdep_soundscape(hw);
659 unsigned long flags;
661 spin_lock_irqsave(&sscape->fwlock, flags);
662 sscape->hw_in_use = 0;
663 spin_unlock_irqrestore(&sscape->fwlock, flags);
664 return 0;
667 static int sscape_hw_ioctl(struct snd_hwdep * hw, struct file *file,
668 unsigned int cmd, unsigned long arg)
670 struct soundscape *sscape = get_hwdep_soundscape(hw);
671 int err = -EBUSY;
673 switch (cmd) {
674 case SND_SSCAPE_LOAD_BOOTB:
676 register struct sscape_bootblock __user *bb = (struct sscape_bootblock __user *) arg;
679 * We are going to have to copy this data into a special
680 * DMA-able buffer before we can upload it. We shall therefore
681 * just check that the data pointer is valid for now ...
683 if ( !access_ok(VERIFY_READ, bb->code, sizeof(bb->code)) )
684 return -EFAULT;
687 * Now check that we can write the firmware version number too...
689 if ( !access_ok(VERIFY_WRITE, &bb->version, sizeof(bb->version)) )
690 return -EFAULT;
692 err = sscape_upload_bootblock(sscape, bb);
694 break;
696 case SND_SSCAPE_LOAD_MCODE:
698 register const struct sscape_microcode __user *mc = (const struct sscape_microcode __user *) arg;
700 err = sscape_upload_microcode(sscape, mc);
702 break;
704 default:
705 err = -EINVAL;
706 break;
707 } /* switch */
709 return err;
714 * Mixer control for the SoundScape's MIDI device.
716 static int sscape_midi_info(struct snd_kcontrol *ctl,
717 struct snd_ctl_elem_info *uinfo)
719 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
720 uinfo->count = 1;
721 uinfo->value.integer.min = 0;
722 uinfo->value.integer.max = 127;
723 return 0;
726 static int sscape_midi_get(struct snd_kcontrol *kctl,
727 struct snd_ctl_elem_value *uctl)
729 struct snd_wss *chip = snd_kcontrol_chip(kctl);
730 struct snd_card *card = chip->card;
731 register struct soundscape *s = get_card_soundscape(card);
732 unsigned long flags;
734 spin_lock_irqsave(&s->lock, flags);
735 set_host_mode_unsafe(s->io_base);
737 if (host_write_ctrl_unsafe(s->io_base, CMD_GET_MIDI_VOL, 100)) {
738 uctl->value.integer.value[0] = host_read_ctrl_unsafe(s->io_base, 100);
741 set_midi_mode_unsafe(s->io_base);
742 spin_unlock_irqrestore(&s->lock, flags);
743 return 0;
746 static int sscape_midi_put(struct snd_kcontrol *kctl,
747 struct snd_ctl_elem_value *uctl)
749 struct snd_wss *chip = snd_kcontrol_chip(kctl);
750 struct snd_card *card = chip->card;
751 register struct soundscape *s = get_card_soundscape(card);
752 unsigned long flags;
753 int change;
755 spin_lock_irqsave(&s->lock, flags);
758 * We need to put the board into HOST mode before we
759 * can send any volume-changing HOST commands ...
761 set_host_mode_unsafe(s->io_base);
764 * To successfully change the MIDI volume setting, you seem to
765 * have to write a volume command, write the new volume value,
766 * and then perform another volume-related command. Perhaps the
767 * first command is an "open" and the second command is a "close"?
769 if (s->midi_vol == ((unsigned char) uctl->value.integer. value[0] & 127)) {
770 change = 0;
771 goto __skip_change;
773 change = (host_write_ctrl_unsafe(s->io_base, CMD_SET_MIDI_VOL, 100)
774 && host_write_ctrl_unsafe(s->io_base, ((unsigned char) uctl->value.integer. value[0]) & 127, 100)
775 && host_write_ctrl_unsafe(s->io_base, CMD_XXX_MIDI_VOL, 100));
776 __skip_change:
779 * Take the board out of HOST mode and back into MIDI mode ...
781 set_midi_mode_unsafe(s->io_base);
783 spin_unlock_irqrestore(&s->lock, flags);
784 return change;
787 static struct snd_kcontrol_new midi_mixer_ctl = {
788 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
789 .name = "MIDI",
790 .info = sscape_midi_info,
791 .get = sscape_midi_get,
792 .put = sscape_midi_put
796 * The SoundScape can use two IRQs from a possible set of four.
797 * These IRQs are encoded as bit patterns so that they can be
798 * written to the control registers.
800 static unsigned __devinit get_irq_config(int irq)
802 static const int valid_irq[] = { 9, 5, 7, 10 };
803 unsigned cfg;
805 for (cfg = 0; cfg < ARRAY_SIZE(valid_irq); ++cfg) {
806 if (irq == valid_irq[cfg])
807 return cfg;
808 } /* for */
810 return INVALID_IRQ;
815 * Perform certain arcane port-checks to see whether there
816 * is a SoundScape board lurking behind the given ports.
818 static int __devinit detect_sscape(struct soundscape *s)
820 unsigned long flags;
821 unsigned d;
822 int retval = 0;
823 int codec = s->wss_base;
825 spin_lock_irqsave(&s->lock, flags);
828 * The following code is lifted from the original OSS driver,
829 * and as I don't have a datasheet I cannot really comment
830 * on what it is doing...
832 if ((inb(HOST_CTRL_IO(s->io_base)) & 0x78) != 0)
833 goto _done;
835 d = inb(ODIE_ADDR_IO(s->io_base)) & 0xf0;
836 if ((d & 0x80) != 0)
837 goto _done;
839 if (d == 0) {
840 s->codec_type = 1;
841 s->ic_type = IC_ODIE;
842 } else if ((d & 0x60) != 0) {
843 s->codec_type = 2;
844 s->ic_type = IC_OPUS;
845 } else
846 goto _done;
848 outb(0xfa, ODIE_ADDR_IO(s->io_base));
849 if ((inb(ODIE_ADDR_IO(s->io_base)) & 0x9f) != 0x0a)
850 goto _done;
852 outb(0xfe, ODIE_ADDR_IO(s->io_base));
853 if ((inb(ODIE_ADDR_IO(s->io_base)) & 0x9f) != 0x0e)
854 goto _done;
856 outb(0xfe, ODIE_ADDR_IO(s->io_base));
857 d = inb(ODIE_DATA_IO(s->io_base));
858 if (s->type != SSCAPE_VIVO && (d & 0x9f) != 0x0e)
859 goto _done;
861 d = sscape_read_unsafe(s->io_base, GA_HMCTL_REG) & 0x3f;
862 sscape_write_unsafe(s->io_base, GA_HMCTL_REG, d | 0xc0);
864 if (s->type == SSCAPE_VIVO)
865 codec += 4;
866 /* wait for WSS codec */
867 for (d = 0; d < 500; d++) {
868 if ((inb(codec) & 0x80) == 0)
869 break;
870 spin_unlock_irqrestore(&s->lock, flags);
871 msleep(1);
872 spin_lock_irqsave(&s->lock, flags);
874 snd_printd(KERN_INFO "init delay = %d ms\n", d);
877 * SoundScape successfully detected!
879 retval = 1;
881 _done:
882 spin_unlock_irqrestore(&s->lock, flags);
883 return retval;
887 * ALSA callback function, called when attempting to open the MIDI device.
888 * Check that the MIDI firmware has been loaded, because we don't want
889 * to crash the machine. Also check that someone isn't using the hardware
890 * IOCTL device.
892 static int mpu401_open(struct snd_mpu401 * mpu)
894 int err;
896 if (!verify_mpu401(mpu)) {
897 snd_printk(KERN_ERR "sscape: MIDI disabled, please load firmware\n");
898 err = -ENODEV;
899 } else {
900 register struct soundscape *sscape = get_mpu401_soundscape(mpu);
901 unsigned long flags;
903 spin_lock_irqsave(&sscape->fwlock, flags);
905 if (sscape->hw_in_use || (sscape->midi_usage == ULONG_MAX)) {
906 err = -EBUSY;
907 } else {
908 ++(sscape->midi_usage);
909 err = 0;
912 spin_unlock_irqrestore(&sscape->fwlock, flags);
915 return err;
918 static void mpu401_close(struct snd_mpu401 * mpu)
920 register struct soundscape *sscape = get_mpu401_soundscape(mpu);
921 unsigned long flags;
923 spin_lock_irqsave(&sscape->fwlock, flags);
924 --(sscape->midi_usage);
925 spin_unlock_irqrestore(&sscape->fwlock, flags);
929 * Initialse an MPU-401 subdevice for MIDI support on the SoundScape.
931 static int __devinit create_mpu401(struct snd_card *card, int devnum, unsigned long port, int irq)
933 struct soundscape *sscape = get_card_soundscape(card);
934 struct snd_rawmidi *rawmidi;
935 int err;
937 if ((err = snd_mpu401_uart_new(card, devnum,
938 MPU401_HW_MPU401,
939 port, MPU401_INFO_INTEGRATED,
940 irq, IRQF_DISABLED,
941 &rawmidi)) == 0) {
942 struct snd_mpu401 *mpu = (struct snd_mpu401 *) rawmidi->private_data;
943 mpu->open_input = mpu401_open;
944 mpu->open_output = mpu401_open;
945 mpu->close_input = mpu401_close;
946 mpu->close_output = mpu401_close;
947 mpu->private_data = sscape;
948 sscape->mpu = mpu;
950 initialise_mpu401(mpu);
953 return err;
958 * Override for the CS4231 playback format function.
959 * The AD1845 has much simpler format and rate selection.
961 static void ad1845_playback_format(struct snd_wss *chip,
962 struct snd_pcm_hw_params *params,
963 unsigned char format)
965 unsigned long flags;
966 unsigned rate = params_rate(params);
969 * The AD1845 can't handle sample frequencies
970 * outside of 4 kHZ to 50 kHZ
972 if (rate > 50000)
973 rate = 50000;
974 else if (rate < 4000)
975 rate = 4000;
977 spin_lock_irqsave(&chip->reg_lock, flags);
980 * Program the AD1845 correctly for the playback stream.
981 * Note that we do NOT need to toggle the MCE bit because
982 * the PLAYBACK_ENABLE bit of the Interface Configuration
983 * register is set.
985 * NOTE: We seem to need to write to the MSB before the LSB
986 * to get the correct sample frequency.
988 snd_wss_out(chip, CS4231_PLAYBK_FORMAT, (format & 0xf0));
989 snd_wss_out(chip, AD1845_FREQ_SEL_MSB, (unsigned char) (rate >> 8));
990 snd_wss_out(chip, AD1845_FREQ_SEL_LSB, (unsigned char) rate);
992 spin_unlock_irqrestore(&chip->reg_lock, flags);
996 * Override for the CS4231 capture format function.
997 * The AD1845 has much simpler format and rate selection.
999 static void ad1845_capture_format(struct snd_wss *chip,
1000 struct snd_pcm_hw_params *params,
1001 unsigned char format)
1003 unsigned long flags;
1004 unsigned rate = params_rate(params);
1007 * The AD1845 can't handle sample frequencies
1008 * outside of 4 kHZ to 50 kHZ
1010 if (rate > 50000)
1011 rate = 50000;
1012 else if (rate < 4000)
1013 rate = 4000;
1015 spin_lock_irqsave(&chip->reg_lock, flags);
1018 * Program the AD1845 correctly for the playback stream.
1019 * Note that we do NOT need to toggle the MCE bit because
1020 * the CAPTURE_ENABLE bit of the Interface Configuration
1021 * register is set.
1023 * NOTE: We seem to need to write to the MSB before the LSB
1024 * to get the correct sample frequency.
1026 snd_wss_out(chip, CS4231_REC_FORMAT, (format & 0xf0));
1027 snd_wss_out(chip, AD1845_FREQ_SEL_MSB, (unsigned char) (rate >> 8));
1028 snd_wss_out(chip, AD1845_FREQ_SEL_LSB, (unsigned char) rate);
1030 spin_unlock_irqrestore(&chip->reg_lock, flags);
1034 * Create an AD1845 PCM subdevice on the SoundScape. The AD1845
1035 * is very much like a CS4231, with a few extra bits. We will
1036 * try to support at least some of the extra bits by overriding
1037 * some of the CS4231 callback.
1039 static int __devinit create_ad1845(struct snd_card *card, unsigned port,
1040 int irq, int dma1, int dma2)
1042 register struct soundscape *sscape = get_card_soundscape(card);
1043 struct snd_wss *chip;
1044 int err;
1046 if (sscape->type == SSCAPE_VIVO)
1047 port += 4;
1049 if (dma1 == dma2)
1050 dma2 = -1;
1052 err = snd_wss_create(card, port, -1, irq, dma1, dma2,
1053 WSS_HW_DETECT, WSS_HWSHARE_DMA1, &chip);
1054 if (!err) {
1055 unsigned long flags;
1056 struct snd_pcm *pcm;
1058 #define AD1845_FREQ_SEL_ENABLE 0x08
1060 #define AD1845_PWR_DOWN_CTRL 0x1b
1061 #define AD1845_CRYS_CLOCK_SEL 0x1d
1064 * It turns out that the PLAYBACK_ENABLE bit is set
1065 * by the lowlevel driver ...
1067 #define AD1845_IFACE_CONFIG \
1068 (CS4231_AUTOCALIB | CS4231_RECORD_ENABLE | CS4231_PLAYBACK_ENABLE)
1069 snd_wss_mce_up(chip);
1070 spin_lock_irqsave(&chip->reg_lock, flags);
1071 snd_wss_out(chip, CS4231_IFACE_CTRL, AD1845_IFACE_CONFIG);
1072 spin_unlock_irqrestore(&chip->reg_lock, flags);
1073 snd_wss_mce_down(chip);
1076 if (sscape->type != SSCAPE_VIVO) {
1077 int val;
1079 * The input clock frequency on the SoundScape must
1080 * be 14.31818 MHz, because we must set this register
1081 * to get the playback to sound correct ...
1083 snd_wss_mce_up(chip);
1084 spin_lock_irqsave(&chip->reg_lock, flags);
1085 snd_wss_out(chip, AD1845_CRYS_CLOCK_SEL, 0x20);
1086 spin_unlock_irqrestore(&chip->reg_lock, flags);
1087 snd_wss_mce_down(chip);
1090 * More custom configuration:
1091 * a) select "mode 2" and provide a current drive of 8mA
1092 * b) enable frequency selection (for capture/playback)
1094 spin_lock_irqsave(&chip->reg_lock, flags);
1095 snd_wss_out(chip, CS4231_MISC_INFO,
1096 CS4231_MODE2 | 0x10);
1097 val = snd_wss_in(chip, AD1845_PWR_DOWN_CTRL);
1098 snd_wss_out(chip, AD1845_PWR_DOWN_CTRL,
1099 val | AD1845_FREQ_SEL_ENABLE);
1100 spin_unlock_irqrestore(&chip->reg_lock, flags);
1103 err = snd_wss_pcm(chip, 0, &pcm);
1104 if (err < 0) {
1105 snd_printk(KERN_ERR "sscape: No PCM device "
1106 "for AD1845 chip\n");
1107 goto _error;
1110 err = snd_wss_mixer(chip);
1111 if (err < 0) {
1112 snd_printk(KERN_ERR "sscape: No mixer device "
1113 "for AD1845 chip\n");
1114 goto _error;
1116 err = snd_wss_timer(chip, 0, NULL);
1117 if (err < 0) {
1118 snd_printk(KERN_ERR "sscape: No timer device "
1119 "for AD1845 chip\n");
1120 goto _error;
1123 if (sscape->type != SSCAPE_VIVO) {
1124 err = snd_ctl_add(card,
1125 snd_ctl_new1(&midi_mixer_ctl, chip));
1126 if (err < 0) {
1127 snd_printk(KERN_ERR "sscape: Could not create "
1128 "MIDI mixer control\n");
1129 goto _error;
1131 chip->set_playback_format = ad1845_playback_format;
1132 chip->set_capture_format = ad1845_capture_format;
1135 strcpy(card->driver, "SoundScape");
1136 strcpy(card->shortname, pcm->name);
1137 snprintf(card->longname, sizeof(card->longname),
1138 "%s at 0x%lx, IRQ %d, DMA1 %d, DMA2 %d\n",
1139 pcm->name, chip->port, chip->irq,
1140 chip->dma1, chip->dma2);
1142 sscape->chip = chip;
1145 _error:
1146 return err;
1151 * Create an ALSA soundcard entry for the SoundScape, using
1152 * the given list of port, IRQ and DMA resources.
1154 static int __devinit create_sscape(int dev, struct snd_card *card)
1156 struct soundscape *sscape = get_card_soundscape(card);
1157 unsigned dma_cfg;
1158 unsigned irq_cfg;
1159 unsigned mpu_irq_cfg;
1160 unsigned xport;
1161 struct resource *io_res;
1162 struct resource *wss_res;
1163 unsigned long flags;
1164 int err;
1167 * Check that the user didn't pass us garbage data ...
1169 irq_cfg = get_irq_config(irq[dev]);
1170 if (irq_cfg == INVALID_IRQ) {
1171 snd_printk(KERN_ERR "sscape: Invalid IRQ %d\n", irq[dev]);
1172 return -ENXIO;
1175 mpu_irq_cfg = get_irq_config(mpu_irq[dev]);
1176 if (mpu_irq_cfg == INVALID_IRQ) {
1177 printk(KERN_ERR "sscape: Invalid IRQ %d\n", mpu_irq[dev]);
1178 return -ENXIO;
1180 xport = port[dev];
1183 * Grab IO ports that we will need to probe so that we
1184 * can detect and control this hardware ...
1186 io_res = request_region(xport, 8, "SoundScape");
1187 if (!io_res) {
1188 snd_printk(KERN_ERR "sscape: can't grab port 0x%x\n", xport);
1189 return -EBUSY;
1191 wss_res = NULL;
1192 if (sscape->type == SSCAPE_VIVO) {
1193 wss_res = request_region(wss_port[dev], 4, "SoundScape");
1194 if (!wss_res) {
1195 snd_printk(KERN_ERR "sscape: can't grab port 0x%lx\n",
1196 wss_port[dev]);
1197 err = -EBUSY;
1198 goto _release_region;
1203 * Grab one DMA channel ...
1205 err = request_dma(dma[dev], "SoundScape");
1206 if (err < 0) {
1207 snd_printk(KERN_ERR "sscape: can't grab DMA %d\n", dma[dev]);
1208 goto _release_region;
1211 spin_lock_init(&sscape->lock);
1212 spin_lock_init(&sscape->fwlock);
1213 sscape->io_res = io_res;
1214 sscape->wss_res = wss_res;
1215 sscape->io_base = xport;
1216 sscape->wss_base = wss_port[dev];
1218 if (!detect_sscape(sscape)) {
1219 printk(KERN_ERR "sscape: hardware not detected at 0x%x\n", sscape->io_base);
1220 err = -ENODEV;
1221 goto _release_dma;
1224 printk(KERN_INFO "sscape: hardware detected at 0x%x, using IRQ %d, DMA %d\n",
1225 sscape->io_base, irq[dev], dma[dev]);
1227 if (sscape->type != SSCAPE_VIVO) {
1229 * Now create the hardware-specific device so that we can
1230 * load the microcode into the on-board processor.
1231 * We cannot use the MPU-401 MIDI system until this firmware
1232 * has been loaded into the card.
1234 err = snd_hwdep_new(card, "MC68EC000", 0, &(sscape->hw));
1235 if (err < 0) {
1236 printk(KERN_ERR "sscape: Failed to create "
1237 "firmware device\n");
1238 goto _release_dma;
1240 strlcpy(sscape->hw->name, "SoundScape M68K",
1241 sizeof(sscape->hw->name));
1242 sscape->hw->name[sizeof(sscape->hw->name) - 1] = '\0';
1243 sscape->hw->iface = SNDRV_HWDEP_IFACE_SSCAPE;
1244 sscape->hw->ops.open = sscape_hw_open;
1245 sscape->hw->ops.release = sscape_hw_release;
1246 sscape->hw->ops.ioctl = sscape_hw_ioctl;
1247 sscape->hw->private_data = sscape;
1251 * Tell the on-board devices where their resources are (I think -
1252 * I can't be sure without a datasheet ... So many magic values!)
1254 spin_lock_irqsave(&sscape->lock, flags);
1256 activate_ad1845_unsafe(sscape->io_base);
1258 sscape_write_unsafe(sscape->io_base, GA_INTENA_REG, 0x00); /* disable */
1259 sscape_write_unsafe(sscape->io_base, GA_SMCFGA_REG, 0x2e);
1260 sscape_write_unsafe(sscape->io_base, GA_SMCFGB_REG, 0x00);
1263 * Enable and configure the DMA channels ...
1265 sscape_write_unsafe(sscape->io_base, GA_DMACFG_REG, 0x50);
1266 dma_cfg = (sscape->ic_type == IC_ODIE ? 0x70 : 0x40);
1267 sscape_write_unsafe(sscape->io_base, GA_DMAA_REG, dma_cfg);
1268 sscape_write_unsafe(sscape->io_base, GA_DMAB_REG, 0x20);
1270 sscape_write_unsafe(sscape->io_base,
1271 GA_INTCFG_REG, 0xf0 | (mpu_irq_cfg << 2) | mpu_irq_cfg);
1272 sscape_write_unsafe(sscape->io_base,
1273 GA_CDCFG_REG, 0x09 | DMA_8BIT
1274 | (dma[dev] << 4) | (irq_cfg << 1));
1276 spin_unlock_irqrestore(&sscape->lock, flags);
1279 * We have now enabled the codec chip, and so we should
1280 * detect the AD1845 device ...
1282 err = create_ad1845(card, wss_port[dev], irq[dev],
1283 dma[dev], dma2[dev]);
1284 if (err < 0) {
1285 printk(KERN_ERR "sscape: No AD1845 device at 0x%lx, IRQ %d\n",
1286 wss_port[dev], irq[dev]);
1287 goto _release_dma;
1289 #define MIDI_DEVNUM 0
1290 if (sscape->type != SSCAPE_VIVO) {
1291 err = create_mpu401(card, MIDI_DEVNUM,
1292 MPU401_IO(xport), mpu_irq[dev]);
1293 if (err < 0) {
1294 printk(KERN_ERR "sscape: Failed to create "
1295 "MPU-401 device at 0x%x\n",
1296 MPU401_IO(xport));
1297 goto _release_dma;
1301 * Enable the master IRQ ...
1303 sscape_write(sscape, GA_INTENA_REG, 0x80);
1306 * Initialize mixer
1308 sscape->midi_vol = 0;
1309 host_write_ctrl_unsafe(sscape->io_base, CMD_SET_MIDI_VOL, 100);
1310 host_write_ctrl_unsafe(sscape->io_base, 0, 100);
1311 host_write_ctrl_unsafe(sscape->io_base, CMD_XXX_MIDI_VOL, 100);
1315 * Now that we have successfully created this sound card,
1316 * it is safe to store the pointer.
1317 * NOTE: we only register the sound card's "destructor"
1318 * function now that our "constructor" has completed.
1320 card->private_free = soundscape_free;
1322 return 0;
1324 _release_dma:
1325 free_dma(dma[dev]);
1327 _release_region:
1328 release_and_free_resource(wss_res);
1329 release_and_free_resource(io_res);
1331 return err;
1335 static int __devinit snd_sscape_match(struct device *pdev, unsigned int i)
1338 * Make sure we were given ALL of the other parameters.
1340 if (port[i] == SNDRV_AUTO_PORT)
1341 return 0;
1343 if (irq[i] == SNDRV_AUTO_IRQ ||
1344 mpu_irq[i] == SNDRV_AUTO_IRQ ||
1345 dma[i] == SNDRV_AUTO_DMA) {
1346 printk(KERN_INFO
1347 "sscape: insufficient parameters, need IO, IRQ, MPU-IRQ and DMA\n");
1348 return 0;
1351 return 1;
1354 static int __devinit snd_sscape_probe(struct device *pdev, unsigned int dev)
1356 struct snd_card *card;
1357 struct soundscape *sscape;
1358 int ret;
1360 card = snd_card_new(index[dev], id[dev], THIS_MODULE,
1361 sizeof(struct soundscape));
1362 if (!card)
1363 return -ENOMEM;
1365 sscape = get_card_soundscape(card);
1366 sscape->type = SSCAPE;
1368 dma[dev] &= 0x03;
1369 ret = create_sscape(dev, card);
1370 if (ret < 0)
1371 goto _release_card;
1373 snd_card_set_dev(card, pdev);
1374 if ((ret = snd_card_register(card)) < 0) {
1375 printk(KERN_ERR "sscape: Failed to register sound card\n");
1376 goto _release_card;
1378 dev_set_drvdata(pdev, card);
1379 return 0;
1381 _release_card:
1382 snd_card_free(card);
1383 return ret;
1386 static int __devexit snd_sscape_remove(struct device *devptr, unsigned int dev)
1388 snd_card_free(dev_get_drvdata(devptr));
1389 dev_set_drvdata(devptr, NULL);
1390 return 0;
1393 #define DEV_NAME "sscape"
1395 static struct isa_driver snd_sscape_driver = {
1396 .match = snd_sscape_match,
1397 .probe = snd_sscape_probe,
1398 .remove = __devexit_p(snd_sscape_remove),
1399 /* FIXME: suspend/resume */
1400 .driver = {
1401 .name = DEV_NAME
1405 #ifdef CONFIG_PNP
1406 static inline int __devinit get_next_autoindex(int i)
1408 while (i < SNDRV_CARDS && port[i] != SNDRV_AUTO_PORT)
1409 ++i;
1410 return i;
1414 static int __devinit sscape_pnp_detect(struct pnp_card_link *pcard,
1415 const struct pnp_card_device_id *pid)
1417 static int idx = 0;
1418 struct pnp_dev *dev;
1419 struct snd_card *card;
1420 struct soundscape *sscape;
1421 int ret;
1424 * Allow this function to fail *quietly* if all the ISA PnP
1425 * devices were configured using module parameters instead.
1427 if ((idx = get_next_autoindex(idx)) >= SNDRV_CARDS)
1428 return -ENOSPC;
1431 * We have found a candidate ISA PnP card. Now we
1432 * have to check that it has the devices that we
1433 * expect it to have.
1435 * We will NOT try and autoconfigure all of the resources
1436 * needed and then activate the card as we are assuming that
1437 * has already been done at boot-time using /proc/isapnp.
1438 * We shall simply try to give each active card the resources
1439 * that it wants. This is a sensible strategy for a modular
1440 * system where unused modules are unloaded regularly.
1442 * This strategy is utterly useless if we compile the driver
1443 * into the kernel, of course.
1445 // printk(KERN_INFO "sscape: %s\n", card->name);
1448 * Check that we still have room for another sound card ...
1450 dev = pnp_request_card_device(pcard, pid->devs[0].id, NULL);
1451 if (! dev)
1452 return -ENODEV;
1454 if (!pnp_is_active(dev)) {
1455 if (pnp_activate_dev(dev) < 0) {
1456 printk(KERN_INFO "sscape: device is inactive\n");
1457 return -EBUSY;
1462 * Create a new ALSA sound card entry, in anticipation
1463 * of detecting our hardware ...
1465 card = snd_card_new(index[idx], id[idx], THIS_MODULE,
1466 sizeof(struct soundscape));
1467 if (!card)
1468 return -ENOMEM;
1470 sscape = get_card_soundscape(card);
1473 * Identify card model ...
1475 if (!strncmp("ENS4081", pid->id, 7))
1476 sscape->type = SSCAPE_VIVO;
1477 else
1478 sscape->type = SSCAPE_PNP;
1481 * Read the correct parameters off the ISA PnP bus ...
1483 port[idx] = pnp_port_start(dev, 0);
1484 irq[idx] = pnp_irq(dev, 0);
1485 mpu_irq[idx] = pnp_irq(dev, 1);
1486 dma[idx] = pnp_dma(dev, 0) & 0x03;
1487 if (sscape->type == SSCAPE_PNP) {
1488 dma2[idx] = dma[idx];
1489 wss_port[idx] = CODEC_IO(port[idx]);
1490 } else {
1491 wss_port[idx] = pnp_port_start(dev, 1);
1492 dma2[idx] = pnp_dma(dev, 1);
1495 ret = create_sscape(idx, card);
1496 if (ret < 0)
1497 goto _release_card;
1499 snd_card_set_dev(card, &pcard->card->dev);
1500 if ((ret = snd_card_register(card)) < 0) {
1501 printk(KERN_ERR "sscape: Failed to register sound card\n");
1502 goto _release_card;
1505 pnp_set_card_drvdata(pcard, card);
1506 ++idx;
1507 return 0;
1509 _release_card:
1510 snd_card_free(card);
1511 return ret;
1514 static void __devexit sscape_pnp_remove(struct pnp_card_link * pcard)
1516 snd_card_free(pnp_get_card_drvdata(pcard));
1517 pnp_set_card_drvdata(pcard, NULL);
1520 static struct pnp_card_driver sscape_pnpc_driver = {
1521 .flags = PNP_DRIVER_RES_DO_NOT_CHANGE,
1522 .name = "sscape",
1523 .id_table = sscape_pnpids,
1524 .probe = sscape_pnp_detect,
1525 .remove = __devexit_p(sscape_pnp_remove),
1528 #endif /* CONFIG_PNP */
1530 static int __init sscape_init(void)
1532 int err;
1534 err = isa_register_driver(&snd_sscape_driver, SNDRV_CARDS);
1535 #ifdef CONFIG_PNP
1536 if (!err)
1537 isa_registered = 1;
1539 err = pnp_register_card_driver(&sscape_pnpc_driver);
1540 if (!err)
1541 pnp_registered = 1;
1543 if (isa_registered)
1544 err = 0;
1545 #endif
1546 return err;
1549 static void __exit sscape_exit(void)
1551 #ifdef CONFIG_PNP
1552 if (pnp_registered)
1553 pnp_unregister_card_driver(&sscape_pnpc_driver);
1554 if (isa_registered)
1555 #endif
1556 isa_unregister_driver(&snd_sscape_driver);
1559 module_init(sscape_init);
1560 module_exit(sscape_exit);