xref: /openbmc/linux/sound/isa/sc6000.c (revision c2828661)
1e307258dSKrzysztof Helt /*
2e307258dSKrzysztof Helt  *  Driver for Gallant SC-6000 soundcard. This card is also known as
3e307258dSKrzysztof Helt  *  Audio Excel DSP 16 or Zoltrix AV302.
4e307258dSKrzysztof Helt  *  These cards use CompuMedia ASC-9308 chip + AD1848 codec.
5c2828661SKrzysztof Helt  *  SC-6600 and SC-7000 cards are also supported. They are based on
6c2828661SKrzysztof Helt  *  CompuMedia ASC-9408 chip and CS4231 codec.
7e307258dSKrzysztof Helt  *
8e307258dSKrzysztof Helt  *  Copyright (C) 2007 Krzysztof Helt <krzysztof.h1@wp.pl>
9e307258dSKrzysztof Helt  *
10e307258dSKrzysztof Helt  *  I don't have documentation for this card. I used the driver
11e307258dSKrzysztof Helt  *  for OSS/Free included in the kernel source as reference.
12e307258dSKrzysztof Helt  *
13e307258dSKrzysztof Helt  *  This program is free software; you can redistribute it and/or modify
14e307258dSKrzysztof Helt  *  it under the terms of the GNU General Public License as published by
15e307258dSKrzysztof Helt  *  the Free Software Foundation; either version 2 of the License, or
16e307258dSKrzysztof Helt  *  (at your option) any later version.
17e307258dSKrzysztof Helt  *
18e307258dSKrzysztof Helt  *  This program is distributed in the hope that it will be useful,
19e307258dSKrzysztof Helt  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
20e307258dSKrzysztof Helt  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21e307258dSKrzysztof Helt  *  GNU General Public License for more details.
22e307258dSKrzysztof Helt  *
23e307258dSKrzysztof Helt  *  You should have received a copy of the GNU General Public License
24e307258dSKrzysztof Helt  *  along with this program; if not, write to the Free Software
25e307258dSKrzysztof Helt  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
26e307258dSKrzysztof Helt  */
27e307258dSKrzysztof Helt 
28e307258dSKrzysztof Helt #include <linux/module.h>
293a5bdee5SAndrew Morton #include <linux/delay.h>
30e307258dSKrzysztof Helt #include <linux/isa.h>
31e307258dSKrzysztof Helt #include <linux/io.h>
32e307258dSKrzysztof Helt #include <asm/dma.h>
33e307258dSKrzysztof Helt #include <sound/core.h>
34760fc6b8SKrzysztof Helt #include <sound/wss.h>
35e307258dSKrzysztof Helt #include <sound/opl3.h>
36e307258dSKrzysztof Helt #include <sound/mpu401.h>
37e307258dSKrzysztof Helt #include <sound/control.h>
38e307258dSKrzysztof Helt #define SNDRV_LEGACY_FIND_FREE_IRQ
39e307258dSKrzysztof Helt #define SNDRV_LEGACY_FIND_FREE_DMA
40e307258dSKrzysztof Helt #include <sound/initval.h>
41e307258dSKrzysztof Helt 
42e307258dSKrzysztof Helt MODULE_AUTHOR("Krzysztof Helt");
43e307258dSKrzysztof Helt MODULE_DESCRIPTION("Gallant SC-6000");
44e307258dSKrzysztof Helt MODULE_LICENSE("GPL");
45e307258dSKrzysztof Helt MODULE_SUPPORTED_DEVICE("{{Gallant, SC-6000},"
46e307258dSKrzysztof Helt 			"{AudioExcel, Audio Excel DSP 16},"
47e307258dSKrzysztof Helt 			"{Zoltrix, AV302}}");
48e307258dSKrzysztof Helt 
49e307258dSKrzysztof Helt static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;	/* Index 0-MAX */
50e307258dSKrzysztof Helt static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;	/* ID for this card */
51e307258dSKrzysztof Helt static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE;	/* Enable this card */
52e307258dSKrzysztof Helt static long port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT;	/* 0x220, 0x240 */
53e307258dSKrzysztof Helt static int irq[SNDRV_CARDS] = SNDRV_DEFAULT_IRQ;	/* 5, 7, 9, 10, 11 */
54e307258dSKrzysztof Helt static long mss_port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT;	/* 0x530, 0xe80 */
55e307258dSKrzysztof Helt static long mpu_port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT;
56e307258dSKrzysztof Helt 						/* 0x300, 0x310, 0x320, 0x330 */
57e307258dSKrzysztof Helt static int mpu_irq[SNDRV_CARDS] = SNDRV_DEFAULT_IRQ;	/* 5, 7, 9, 10, 0 */
58e307258dSKrzysztof Helt static int dma[SNDRV_CARDS] = SNDRV_DEFAULT_DMA;	/* 0, 1, 3 */
59e307258dSKrzysztof Helt 
60e307258dSKrzysztof Helt module_param_array(index, int, NULL, 0444);
61e307258dSKrzysztof Helt MODULE_PARM_DESC(index, "Index value for sc-6000 based soundcard.");
62e307258dSKrzysztof Helt module_param_array(id, charp, NULL, 0444);
63e307258dSKrzysztof Helt MODULE_PARM_DESC(id, "ID string for sc-6000 based soundcard.");
64e307258dSKrzysztof Helt module_param_array(enable, bool, NULL, 0444);
65e307258dSKrzysztof Helt MODULE_PARM_DESC(enable, "Enable sc-6000 based soundcard.");
66e307258dSKrzysztof Helt module_param_array(port, long, NULL, 0444);
67e307258dSKrzysztof Helt MODULE_PARM_DESC(port, "Port # for sc-6000 driver.");
68e307258dSKrzysztof Helt module_param_array(mss_port, long, NULL, 0444);
69e307258dSKrzysztof Helt MODULE_PARM_DESC(mss_port, "MSS Port # for sc-6000 driver.");
70e307258dSKrzysztof Helt module_param_array(mpu_port, long, NULL, 0444);
71e307258dSKrzysztof Helt MODULE_PARM_DESC(mpu_port, "MPU-401 port # for sc-6000 driver.");
72e307258dSKrzysztof Helt module_param_array(irq, int, NULL, 0444);
73e307258dSKrzysztof Helt MODULE_PARM_DESC(irq, "IRQ # for sc-6000 driver.");
74e307258dSKrzysztof Helt module_param_array(mpu_irq, int, NULL, 0444);
75e307258dSKrzysztof Helt MODULE_PARM_DESC(mpu_irq, "MPU-401 IRQ # for sc-6000 driver.");
76e307258dSKrzysztof Helt module_param_array(dma, int, NULL, 0444);
77e307258dSKrzysztof Helt MODULE_PARM_DESC(dma, "DMA # for sc-6000 driver.");
78e307258dSKrzysztof Helt 
79e307258dSKrzysztof Helt /*
80e307258dSKrzysztof Helt  * Commands of SC6000's DSP (SBPRO+special).
81e307258dSKrzysztof Helt  * Some of them are COMMAND_xx, in the future they may change.
82e307258dSKrzysztof Helt  */
83e307258dSKrzysztof Helt #define WRITE_MDIRQ_CFG	0x50	/* Set M&I&DRQ mask (the real config)	*/
84e307258dSKrzysztof Helt #define COMMAND_52	0x52	/*					*/
85e307258dSKrzysztof Helt #define READ_HARD_CFG	0x58	/* Read Hardware Config (I/O base etc)	*/
86e307258dSKrzysztof Helt #define COMMAND_5C	0x5c	/*					*/
87e307258dSKrzysztof Helt #define COMMAND_60	0x60	/*					*/
88e307258dSKrzysztof Helt #define COMMAND_66	0x66	/*					*/
89e307258dSKrzysztof Helt #define COMMAND_6C	0x6c	/*					*/
90e307258dSKrzysztof Helt #define COMMAND_6E	0x6e	/*					*/
91e307258dSKrzysztof Helt #define COMMAND_88	0x88	/* Unknown command 			*/
92e307258dSKrzysztof Helt #define DSP_INIT_MSS	0x8c	/* Enable Microsoft Sound System mode	*/
93e307258dSKrzysztof Helt #define COMMAND_C5	0xc5	/*					*/
94e307258dSKrzysztof Helt #define GET_DSP_VERSION	0xe1	/* Get DSP Version			*/
95e307258dSKrzysztof Helt #define GET_DSP_COPYRIGHT 0xe3	/* Get DSP Copyright			*/
96e307258dSKrzysztof Helt 
97e307258dSKrzysztof Helt /*
98e307258dSKrzysztof Helt  * Offsets of SC6000 DSP I/O ports. The offset is added to base I/O port
99e307258dSKrzysztof Helt  * to have the actual I/O port.
100e307258dSKrzysztof Helt  * Register permissions are:
101e307258dSKrzysztof Helt  * (wo) == Write Only
102e307258dSKrzysztof Helt  * (ro) == Read  Only
103e307258dSKrzysztof Helt  * (w-) == Write
104e307258dSKrzysztof Helt  * (r-) == Read
105e307258dSKrzysztof Helt  */
106e307258dSKrzysztof Helt #define DSP_RESET	0x06	/* offset of DSP RESET		(wo) */
107e307258dSKrzysztof Helt #define DSP_READ	0x0a	/* offset of DSP READ		(ro) */
108e307258dSKrzysztof Helt #define DSP_WRITE	0x0c	/* offset of DSP WRITE		(w-) */
109e307258dSKrzysztof Helt #define DSP_COMMAND	0x0c	/* offset of DSP COMMAND	(w-) */
110e307258dSKrzysztof Helt #define DSP_STATUS	0x0c	/* offset of DSP STATUS		(r-) */
111e307258dSKrzysztof Helt #define DSP_DATAVAIL	0x0e	/* offset of DSP DATA AVAILABLE	(ro) */
112e307258dSKrzysztof Helt 
113e307258dSKrzysztof Helt #define PFX "sc6000: "
114e307258dSKrzysztof Helt #define DRV_NAME "SC-6000"
115e307258dSKrzysztof Helt 
116e307258dSKrzysztof Helt /* hardware dependent functions */
117e307258dSKrzysztof Helt 
118e307258dSKrzysztof Helt /*
119e307258dSKrzysztof Helt  * sc6000_irq_to_softcfg - Decode irq number into cfg code.
120e307258dSKrzysztof Helt  */
121e307258dSKrzysztof Helt static __devinit unsigned char sc6000_irq_to_softcfg(int irq)
122e307258dSKrzysztof Helt {
123e307258dSKrzysztof Helt 	unsigned char val = 0;
124e307258dSKrzysztof Helt 
125e307258dSKrzysztof Helt 	switch (irq) {
126e307258dSKrzysztof Helt 	case 5:
127e307258dSKrzysztof Helt 		val = 0x28;
128e307258dSKrzysztof Helt 		break;
129e307258dSKrzysztof Helt 	case 7:
130e307258dSKrzysztof Helt 		val = 0x8;
131e307258dSKrzysztof Helt 		break;
132e307258dSKrzysztof Helt 	case 9:
133e307258dSKrzysztof Helt 		val = 0x10;
134e307258dSKrzysztof Helt 		break;
135e307258dSKrzysztof Helt 	case 10:
136e307258dSKrzysztof Helt 		val = 0x18;
137e307258dSKrzysztof Helt 		break;
138e307258dSKrzysztof Helt 	case 11:
139e307258dSKrzysztof Helt 		val = 0x20;
140e307258dSKrzysztof Helt 		break;
141e307258dSKrzysztof Helt 	default:
142e307258dSKrzysztof Helt 		break;
143e307258dSKrzysztof Helt 	}
144e307258dSKrzysztof Helt 	return val;
145e307258dSKrzysztof Helt }
146e307258dSKrzysztof Helt 
147e307258dSKrzysztof Helt /*
148e307258dSKrzysztof Helt  * sc6000_dma_to_softcfg - Decode dma number into cfg code.
149e307258dSKrzysztof Helt  */
150e307258dSKrzysztof Helt static __devinit unsigned char sc6000_dma_to_softcfg(int dma)
151e307258dSKrzysztof Helt {
152e307258dSKrzysztof Helt 	unsigned char val = 0;
153e307258dSKrzysztof Helt 
154e307258dSKrzysztof Helt 	switch (dma) {
155e307258dSKrzysztof Helt 	case 0:
156e307258dSKrzysztof Helt 		val = 1;
157e307258dSKrzysztof Helt 		break;
158e307258dSKrzysztof Helt 	case 1:
159e307258dSKrzysztof Helt 		val = 2;
160e307258dSKrzysztof Helt 		break;
161e307258dSKrzysztof Helt 	case 3:
162e307258dSKrzysztof Helt 		val = 3;
163e307258dSKrzysztof Helt 		break;
164e307258dSKrzysztof Helt 	default:
165e307258dSKrzysztof Helt 		break;
166e307258dSKrzysztof Helt 	}
167e307258dSKrzysztof Helt 	return val;
168e307258dSKrzysztof Helt }
169e307258dSKrzysztof Helt 
170e307258dSKrzysztof Helt /*
171e307258dSKrzysztof Helt  * sc6000_mpu_irq_to_softcfg - Decode MPU-401 irq number into cfg code.
172e307258dSKrzysztof Helt  */
173e307258dSKrzysztof Helt static __devinit unsigned char sc6000_mpu_irq_to_softcfg(int mpu_irq)
174e307258dSKrzysztof Helt {
175e307258dSKrzysztof Helt 	unsigned char val = 0;
176e307258dSKrzysztof Helt 
177e307258dSKrzysztof Helt 	switch (mpu_irq) {
178e307258dSKrzysztof Helt 	case 5:
179e307258dSKrzysztof Helt 		val = 4;
180e307258dSKrzysztof Helt 		break;
181e307258dSKrzysztof Helt 	case 7:
182e307258dSKrzysztof Helt 		val = 0x44;
183e307258dSKrzysztof Helt 		break;
184e307258dSKrzysztof Helt 	case 9:
185e307258dSKrzysztof Helt 		val = 0x84;
186e307258dSKrzysztof Helt 		break;
187e307258dSKrzysztof Helt 	case 10:
188e307258dSKrzysztof Helt 		val = 0xc4;
189e307258dSKrzysztof Helt 		break;
190e307258dSKrzysztof Helt 	default:
191e307258dSKrzysztof Helt 		break;
192e307258dSKrzysztof Helt 	}
193e307258dSKrzysztof Helt 	return val;
194e307258dSKrzysztof Helt }
195e307258dSKrzysztof Helt 
196c2828661SKrzysztof Helt static int sc6000_wait_data(char __iomem *vport)
197e307258dSKrzysztof Helt {
198e307258dSKrzysztof Helt 	int loop = 1000;
199e307258dSKrzysztof Helt 	unsigned char val = 0;
200e307258dSKrzysztof Helt 
201e307258dSKrzysztof Helt 	do {
202e307258dSKrzysztof Helt 		val = ioread8(vport + DSP_DATAVAIL);
203e307258dSKrzysztof Helt 		if (val & 0x80)
204e307258dSKrzysztof Helt 			return 0;
205e307258dSKrzysztof Helt 		cpu_relax();
206e307258dSKrzysztof Helt 	} while (loop--);
207e307258dSKrzysztof Helt 
208e307258dSKrzysztof Helt 	return -EAGAIN;
209e307258dSKrzysztof Helt }
210e307258dSKrzysztof Helt 
211c2828661SKrzysztof Helt static int sc6000_read(char __iomem *vport)
212e307258dSKrzysztof Helt {
213e307258dSKrzysztof Helt 	if (sc6000_wait_data(vport))
214e307258dSKrzysztof Helt 		return -EBUSY;
215e307258dSKrzysztof Helt 
216e307258dSKrzysztof Helt 	return ioread8(vport + DSP_READ);
217e307258dSKrzysztof Helt 
218e307258dSKrzysztof Helt }
219e307258dSKrzysztof Helt 
220c2828661SKrzysztof Helt static int sc6000_write(char __iomem *vport, int cmd)
221e307258dSKrzysztof Helt {
222e307258dSKrzysztof Helt 	unsigned char val;
223e307258dSKrzysztof Helt 	int loop = 500000;
224e307258dSKrzysztof Helt 
225e307258dSKrzysztof Helt 	do {
226e307258dSKrzysztof Helt 		val = ioread8(vport + DSP_STATUS);
227e307258dSKrzysztof Helt 		/*
228e307258dSKrzysztof Helt 		 * DSP ready to receive data if bit 7 of val == 0
229e307258dSKrzysztof Helt 		 */
230e307258dSKrzysztof Helt 		if (!(val & 0x80)) {
231e307258dSKrzysztof Helt 			iowrite8(cmd, vport + DSP_COMMAND);
232e307258dSKrzysztof Helt 			return 0;
233e307258dSKrzysztof Helt 		}
234e307258dSKrzysztof Helt 		cpu_relax();
235e307258dSKrzysztof Helt 	} while (loop--);
236e307258dSKrzysztof Helt 
237e307258dSKrzysztof Helt 	snd_printk(KERN_ERR "DSP Command (0x%x) timeout.\n", cmd);
238e307258dSKrzysztof Helt 
239e307258dSKrzysztof Helt 	return -EIO;
240e307258dSKrzysztof Helt }
241e307258dSKrzysztof Helt 
242e307258dSKrzysztof Helt static int __devinit sc6000_dsp_get_answer(char __iomem *vport, int command,
243e307258dSKrzysztof Helt 					   char *data, int data_len)
244e307258dSKrzysztof Helt {
245e307258dSKrzysztof Helt 	int len = 0;
246e307258dSKrzysztof Helt 
247e307258dSKrzysztof Helt 	if (sc6000_write(vport, command)) {
248e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "CMD 0x%x: failed!\n", command);
249e307258dSKrzysztof Helt 		return -EIO;
250e307258dSKrzysztof Helt 	}
251e307258dSKrzysztof Helt 
252e307258dSKrzysztof Helt 	do {
253e307258dSKrzysztof Helt 		int val = sc6000_read(vport);
254e307258dSKrzysztof Helt 
255e307258dSKrzysztof Helt 		if (val < 0)
256e307258dSKrzysztof Helt 			break;
257e307258dSKrzysztof Helt 
258e307258dSKrzysztof Helt 		data[len++] = val;
259e307258dSKrzysztof Helt 
260e307258dSKrzysztof Helt 	} while (len < data_len);
261e307258dSKrzysztof Helt 
262e307258dSKrzysztof Helt 	/*
263e307258dSKrzysztof Helt 	 * If no more data available, return to the caller, no error if len>0.
264e307258dSKrzysztof Helt 	 * We have no other way to know when the string is finished.
265e307258dSKrzysztof Helt 	 */
266e307258dSKrzysztof Helt 	return len ? len : -EIO;
267e307258dSKrzysztof Helt }
268e307258dSKrzysztof Helt 
269e307258dSKrzysztof Helt static int __devinit sc6000_dsp_reset(char __iomem *vport)
270e307258dSKrzysztof Helt {
271e307258dSKrzysztof Helt 	iowrite8(1, vport + DSP_RESET);
272e307258dSKrzysztof Helt 	udelay(10);
273e307258dSKrzysztof Helt 	iowrite8(0, vport + DSP_RESET);
274e307258dSKrzysztof Helt 	udelay(20);
275e307258dSKrzysztof Helt 	if (sc6000_read(vport) == 0xaa)
276e307258dSKrzysztof Helt 		return 0;
277e307258dSKrzysztof Helt 	return -ENODEV;
278e307258dSKrzysztof Helt }
279e307258dSKrzysztof Helt 
280e307258dSKrzysztof Helt /* detection and initialization */
281c2828661SKrzysztof Helt static int __devinit sc6000_hw_cfg_write(char __iomem *vport, const int *cfg)
282c2828661SKrzysztof Helt {
283c2828661SKrzysztof Helt 	if (sc6000_write(vport, COMMAND_6C) < 0) {
284c2828661SKrzysztof Helt 		snd_printk(KERN_WARNING "CMD 0x%x: failed!\n", COMMAND_6C);
285c2828661SKrzysztof Helt 		return -EIO;
286c2828661SKrzysztof Helt 	}
287c2828661SKrzysztof Helt 	if (sc6000_write(vport, COMMAND_5C) < 0) {
288c2828661SKrzysztof Helt 		snd_printk(KERN_ERR "CMD 0x%x: failed!\n", COMMAND_5C);
289c2828661SKrzysztof Helt 		return -EIO;
290c2828661SKrzysztof Helt 	}
291c2828661SKrzysztof Helt 	if (sc6000_write(vport, cfg[0]) < 0) {
292c2828661SKrzysztof Helt 		snd_printk(KERN_ERR "DATA 0x%x: failed!\n", cfg[0]);
293c2828661SKrzysztof Helt 		return -EIO;
294c2828661SKrzysztof Helt 	}
295c2828661SKrzysztof Helt 	if (sc6000_write(vport, cfg[1]) < 0) {
296c2828661SKrzysztof Helt 		snd_printk(KERN_ERR "DATA 0x%x: failed!\n", cfg[1]);
297c2828661SKrzysztof Helt 		return -EIO;
298c2828661SKrzysztof Helt 	}
299c2828661SKrzysztof Helt 	if (sc6000_write(vport, COMMAND_C5) < 0) {
300c2828661SKrzysztof Helt 		snd_printk(KERN_ERR "CMD 0x%x: failed!\n", COMMAND_C5);
301c2828661SKrzysztof Helt 		return -EIO;
302c2828661SKrzysztof Helt 	}
303c2828661SKrzysztof Helt 
304c2828661SKrzysztof Helt 	return 0;
305c2828661SKrzysztof Helt }
306c2828661SKrzysztof Helt 
307c2828661SKrzysztof Helt static int sc6000_cfg_write(char __iomem *vport, unsigned char softcfg)
308e307258dSKrzysztof Helt {
309e307258dSKrzysztof Helt 
310e307258dSKrzysztof Helt 	if (sc6000_write(vport, WRITE_MDIRQ_CFG)) {
311e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "CMD 0x%x: failed!\n", WRITE_MDIRQ_CFG);
312e307258dSKrzysztof Helt 		return -EIO;
313e307258dSKrzysztof Helt 	}
314e307258dSKrzysztof Helt 	if (sc6000_write(vport, softcfg)) {
315e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_cfg_write: failed!\n");
316e307258dSKrzysztof Helt 		return -EIO;
317e307258dSKrzysztof Helt 	}
318e307258dSKrzysztof Helt 	return 0;
319e307258dSKrzysztof Helt }
320e307258dSKrzysztof Helt 
321c2828661SKrzysztof Helt static int sc6000_setup_board(char __iomem *vport, int config)
322e307258dSKrzysztof Helt {
323e307258dSKrzysztof Helt 	int loop = 10;
324e307258dSKrzysztof Helt 
325e307258dSKrzysztof Helt 	do {
326e307258dSKrzysztof Helt 		if (sc6000_write(vport, COMMAND_88)) {
327e307258dSKrzysztof Helt 			snd_printk(KERN_ERR "CMD 0x%x: failed!\n",
328e307258dSKrzysztof Helt 				   COMMAND_88);
329e307258dSKrzysztof Helt 			return -EIO;
330e307258dSKrzysztof Helt 		}
331e307258dSKrzysztof Helt 	} while ((sc6000_wait_data(vport) < 0) && loop--);
332e307258dSKrzysztof Helt 
333e307258dSKrzysztof Helt 	if (sc6000_read(vport) < 0) {
334e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_read after CMD 0x%x: failed\n",
335e307258dSKrzysztof Helt 			   COMMAND_88);
336e307258dSKrzysztof Helt 		return -EIO;
337e307258dSKrzysztof Helt 	}
338e307258dSKrzysztof Helt 
339e307258dSKrzysztof Helt 	if (sc6000_cfg_write(vport, config))
340e307258dSKrzysztof Helt 		return -ENODEV;
341e307258dSKrzysztof Helt 
342e307258dSKrzysztof Helt 	return 0;
343e307258dSKrzysztof Helt }
344e307258dSKrzysztof Helt 
345e307258dSKrzysztof Helt static int __devinit sc6000_init_mss(char __iomem *vport, int config,
346e307258dSKrzysztof Helt 				     char __iomem *vmss_port, int mss_config)
347e307258dSKrzysztof Helt {
348e307258dSKrzysztof Helt 	if (sc6000_write(vport, DSP_INIT_MSS)) {
349e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_init_mss [0x%x]: failed!\n",
350e307258dSKrzysztof Helt 			   DSP_INIT_MSS);
351e307258dSKrzysztof Helt 		return -EIO;
352e307258dSKrzysztof Helt 	}
353e307258dSKrzysztof Helt 
354e307258dSKrzysztof Helt 	msleep(10);
355e307258dSKrzysztof Helt 
356e307258dSKrzysztof Helt 	if (sc6000_cfg_write(vport, config))
357e307258dSKrzysztof Helt 		return -EIO;
358e307258dSKrzysztof Helt 
359e307258dSKrzysztof Helt 	iowrite8(mss_config, vmss_port);
360e307258dSKrzysztof Helt 
361e307258dSKrzysztof Helt 	return 0;
362e307258dSKrzysztof Helt }
363e307258dSKrzysztof Helt 
364c2828661SKrzysztof Helt static void __devinit sc6000_hw_cfg_encode(char __iomem *vport, int *cfg,
365c2828661SKrzysztof Helt 					   long xport, long xmpu,
366c2828661SKrzysztof Helt 					   long xmss_port)
367c2828661SKrzysztof Helt {
368c2828661SKrzysztof Helt 	cfg[0] = 0;
369c2828661SKrzysztof Helt 	cfg[1] = 0;
370c2828661SKrzysztof Helt 	if (xport == 0x240)
371c2828661SKrzysztof Helt 		cfg[0] |= 1;
372c2828661SKrzysztof Helt 	if (xmpu != SNDRV_AUTO_PORT) {
373c2828661SKrzysztof Helt 		cfg[0] |= (xmpu & 0x30) >> 2;
374c2828661SKrzysztof Helt 		cfg[1] |= 0x20;
375c2828661SKrzysztof Helt 	}
376c2828661SKrzysztof Helt 	if (xmss_port == 0xe80)
377c2828661SKrzysztof Helt 		cfg[0] |= 0x10;
378c2828661SKrzysztof Helt 	cfg[0] |= 0x40;		/* always set */
379c2828661SKrzysztof Helt 	cfg[1] |= 0x80;		/* enable WSS system */
380c2828661SKrzysztof Helt 	cfg[1] &= ~0x40;	/* disable IDE */
381c2828661SKrzysztof Helt 	snd_printd("hw cfg %x, %x\n", cfg[0], cfg[1]);
382c2828661SKrzysztof Helt }
383c2828661SKrzysztof Helt 
384c2828661SKrzysztof Helt static int __devinit sc6000_init_board(char __iomem *vport,
385c2828661SKrzysztof Helt 					char __iomem *vmss_port, int dev)
386e307258dSKrzysztof Helt {
387e307258dSKrzysztof Helt 	char answer[15];
388e307258dSKrzysztof Helt 	char version[2];
389c2828661SKrzysztof Helt 	int mss_config = sc6000_irq_to_softcfg(irq[dev]) |
390c2828661SKrzysztof Helt 			 sc6000_dma_to_softcfg(dma[dev]);
391e307258dSKrzysztof Helt 	int config = mss_config |
392c2828661SKrzysztof Helt 		     sc6000_mpu_irq_to_softcfg(mpu_irq[dev]);
393e307258dSKrzysztof Helt 	int err;
394c2828661SKrzysztof Helt 	int cfg[2];
395c2828661SKrzysztof Helt 	int old = 0;
396e307258dSKrzysztof Helt 
397e307258dSKrzysztof Helt 	err = sc6000_dsp_reset(vport);
398e307258dSKrzysztof Helt 	if (err < 0) {
399e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_dsp_reset: failed!\n");
400e307258dSKrzysztof Helt 		return err;
401e307258dSKrzysztof Helt 	}
402e307258dSKrzysztof Helt 
4031cf0bc7eSKrzysztof Helt 	memset(answer, 0, sizeof(answer));
404e307258dSKrzysztof Helt 	err = sc6000_dsp_get_answer(vport, GET_DSP_COPYRIGHT, answer, 15);
405e307258dSKrzysztof Helt 	if (err <= 0) {
406e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_dsp_copyright: failed!\n");
407e307258dSKrzysztof Helt 		return -ENODEV;
408e307258dSKrzysztof Helt 	}
409e307258dSKrzysztof Helt 	/*
410e307258dSKrzysztof Helt 	 * My SC-6000 card return "SC-6000" in DSPCopyright, so
411e307258dSKrzysztof Helt 	 * if we have something different, we have to be warned.
412e307258dSKrzysztof Helt 	 */
413e307258dSKrzysztof Helt 	if (strncmp("SC-6000", answer, 7))
414e307258dSKrzysztof Helt 		snd_printk(KERN_WARNING "Warning: non SC-6000 audio card!\n");
415e307258dSKrzysztof Helt 
416e307258dSKrzysztof Helt 	if (sc6000_dsp_get_answer(vport, GET_DSP_VERSION, version, 2) < 2) {
417e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_dsp_version: failed!\n");
418e307258dSKrzysztof Helt 		return -ENODEV;
419e307258dSKrzysztof Helt 	}
420e307258dSKrzysztof Helt 	printk(KERN_INFO PFX "Detected model: %s, DSP version %d.%d\n",
421e307258dSKrzysztof Helt 		answer, version[0], version[1]);
422e307258dSKrzysztof Helt 
423c2828661SKrzysztof Helt 	/* set configuration */
424c2828661SKrzysztof Helt 	sc6000_hw_cfg_encode(vport, &cfg[0], port[dev], mpu_port[dev],
425c2828661SKrzysztof Helt 			     mss_port[dev]);
426c2828661SKrzysztof Helt 	if (sc6000_hw_cfg_write(vport, cfg) < 0) {
427c2828661SKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_hw_cfg_write: failed!\n");
428c2828661SKrzysztof Helt 		return -EIO;
429c2828661SKrzysztof Helt 	}
430c2828661SKrzysztof Helt 	err = sc6000_setup_board(vport, config);
431e307258dSKrzysztof Helt 	if (err < 0) {
432c2828661SKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_setup_board: failed!\n");
433c2828661SKrzysztof Helt 		return -ENODEV;
434c2828661SKrzysztof Helt 	}
435c2828661SKrzysztof Helt 
436c2828661SKrzysztof Helt 	sc6000_dsp_reset(vport);
437c2828661SKrzysztof Helt 	sc6000_write(vport, COMMAND_5C);
438c2828661SKrzysztof Helt 	if (sc6000_read(vport) < 0)
439c2828661SKrzysztof Helt 		old = 1;
440c2828661SKrzysztof Helt 	sc6000_dsp_reset(vport);
441c2828661SKrzysztof Helt 
442c2828661SKrzysztof Helt 	if (!old) {
443c2828661SKrzysztof Helt 		sc6000_write(vport, COMMAND_60);
444c2828661SKrzysztof Helt 		sc6000_write(vport, 0x02);
445c2828661SKrzysztof Helt 		sc6000_dsp_reset(vport);
446e307258dSKrzysztof Helt 	}
447e307258dSKrzysztof Helt 
448e307258dSKrzysztof Helt 	err = sc6000_setup_board(vport, config);
449e307258dSKrzysztof Helt 	if (err < 0) {
450e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "sc6000_setup_board: failed!\n");
451e307258dSKrzysztof Helt 		return -ENODEV;
452e307258dSKrzysztof Helt 	}
453e307258dSKrzysztof Helt 	err = sc6000_init_mss(vport, config, vmss_port, mss_config);
454e307258dSKrzysztof Helt 	if (err < 0) {
455e307258dSKrzysztof Helt 		snd_printk(KERN_ERR "Cannot initialize "
456e307258dSKrzysztof Helt 			   "Microsoft Sound System mode.\n");
457e307258dSKrzysztof Helt 		return -ENODEV;
458e307258dSKrzysztof Helt 	}
459e307258dSKrzysztof Helt 
460e307258dSKrzysztof Helt 	return 0;
461e307258dSKrzysztof Helt }
462e307258dSKrzysztof Helt 
463241b3ee7SKrzysztof Helt static int __devinit snd_sc6000_mixer(struct snd_wss *chip)
464e307258dSKrzysztof Helt {
465e307258dSKrzysztof Helt 	struct snd_card *card = chip->card;
466e307258dSKrzysztof Helt 	struct snd_ctl_elem_id id1, id2;
467e307258dSKrzysztof Helt 	int err;
468e307258dSKrzysztof Helt 
469e307258dSKrzysztof Helt 	memset(&id1, 0, sizeof(id1));
470e307258dSKrzysztof Helt 	memset(&id2, 0, sizeof(id2));
471e307258dSKrzysztof Helt 	id1.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
472e307258dSKrzysztof Helt 	id2.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
473e307258dSKrzysztof Helt 	/* reassign AUX0 to FM */
474e307258dSKrzysztof Helt 	strcpy(id1.name, "Aux Playback Switch");
475e307258dSKrzysztof Helt 	strcpy(id2.name, "FM Playback Switch");
476e307258dSKrzysztof Helt 	err = snd_ctl_rename_id(card, &id1, &id2);
477e307258dSKrzysztof Helt 	if (err < 0)
478e307258dSKrzysztof Helt 		return err;
479e307258dSKrzysztof Helt 	strcpy(id1.name, "Aux Playback Volume");
480e307258dSKrzysztof Helt 	strcpy(id2.name, "FM Playback Volume");
481e307258dSKrzysztof Helt 	err = snd_ctl_rename_id(card, &id1, &id2);
482e307258dSKrzysztof Helt 	if (err < 0)
483e307258dSKrzysztof Helt 		return err;
484e307258dSKrzysztof Helt 	/* reassign AUX1 to CD */
485e307258dSKrzysztof Helt 	strcpy(id1.name, "Aux Playback Switch"); id1.index = 1;
486e307258dSKrzysztof Helt 	strcpy(id2.name, "CD Playback Switch");
487e307258dSKrzysztof Helt 	err = snd_ctl_rename_id(card, &id1, &id2);
488e307258dSKrzysztof Helt 	if (err < 0)
489e307258dSKrzysztof Helt 		return err;
490e307258dSKrzysztof Helt 	strcpy(id1.name, "Aux Playback Volume");
491e307258dSKrzysztof Helt 	strcpy(id2.name, "CD Playback Volume");
492e307258dSKrzysztof Helt 	err = snd_ctl_rename_id(card, &id1, &id2);
493e307258dSKrzysztof Helt 	if (err < 0)
494e307258dSKrzysztof Helt 		return err;
495e307258dSKrzysztof Helt 	return 0;
496e307258dSKrzysztof Helt }
497e307258dSKrzysztof Helt 
498e307258dSKrzysztof Helt static int __devinit snd_sc6000_match(struct device *devptr, unsigned int dev)
499e307258dSKrzysztof Helt {
500e307258dSKrzysztof Helt 	if (!enable[dev])
501e307258dSKrzysztof Helt 		return 0;
502e307258dSKrzysztof Helt 	if (port[dev] == SNDRV_AUTO_PORT) {
503e307258dSKrzysztof Helt 		printk(KERN_ERR PFX "specify IO port\n");
504e307258dSKrzysztof Helt 		return 0;
505e307258dSKrzysztof Helt 	}
506e307258dSKrzysztof Helt 	if (mss_port[dev] == SNDRV_AUTO_PORT) {
507e307258dSKrzysztof Helt 		printk(KERN_ERR PFX "specify MSS port\n");
508e307258dSKrzysztof Helt 		return 0;
509e307258dSKrzysztof Helt 	}
510e307258dSKrzysztof Helt 	if (port[dev] != 0x220 && port[dev] != 0x240) {
511e307258dSKrzysztof Helt 		printk(KERN_ERR PFX "Port must be 0x220 or 0x240\n");
512e307258dSKrzysztof Helt 		return 0;
513e307258dSKrzysztof Helt 	}
514e307258dSKrzysztof Helt 	if (mss_port[dev] != 0x530 && mss_port[dev] != 0xe80) {
515e307258dSKrzysztof Helt 		printk(KERN_ERR PFX "MSS port must be 0x530 or 0xe80\n");
516e307258dSKrzysztof Helt 		return 0;
517e307258dSKrzysztof Helt 	}
518e307258dSKrzysztof Helt 	if (irq[dev] != SNDRV_AUTO_IRQ && !sc6000_irq_to_softcfg(irq[dev])) {
519e307258dSKrzysztof Helt 		printk(KERN_ERR PFX "invalid IRQ %d\n", irq[dev]);
520e307258dSKrzysztof Helt 		return 0;
521e307258dSKrzysztof Helt 	}
522e307258dSKrzysztof Helt 	if (dma[dev] != SNDRV_AUTO_DMA && !sc6000_dma_to_softcfg(dma[dev])) {
523e307258dSKrzysztof Helt 		printk(KERN_ERR PFX "invalid DMA %d\n", dma[dev]);
524e307258dSKrzysztof Helt 		return 0;
525e307258dSKrzysztof Helt 	}
526e307258dSKrzysztof Helt 	if (mpu_port[dev] != SNDRV_AUTO_PORT &&
527e307258dSKrzysztof Helt 	    (mpu_port[dev] & ~0x30L) != 0x300) {
528e307258dSKrzysztof Helt 		printk(KERN_ERR PFX "invalid MPU-401 port %lx\n",
529e307258dSKrzysztof Helt 			mpu_port[dev]);
530e307258dSKrzysztof Helt 		return 0;
531e307258dSKrzysztof Helt 	}
532e307258dSKrzysztof Helt 	if (mpu_port[dev] != SNDRV_AUTO_PORT &&
533e307258dSKrzysztof Helt 	    mpu_irq[dev] != SNDRV_AUTO_IRQ && mpu_irq[dev] != 0 &&
534e307258dSKrzysztof Helt 	    !sc6000_mpu_irq_to_softcfg(mpu_irq[dev])) {
535e307258dSKrzysztof Helt 		printk(KERN_ERR PFX "invalid MPU-401 IRQ %d\n", mpu_irq[dev]);
536e307258dSKrzysztof Helt 		return 0;
537e307258dSKrzysztof Helt 	}
538e307258dSKrzysztof Helt 	return 1;
539e307258dSKrzysztof Helt }
540e307258dSKrzysztof Helt 
541e307258dSKrzysztof Helt static int __devinit snd_sc6000_probe(struct device *devptr, unsigned int dev)
542e307258dSKrzysztof Helt {
543e307258dSKrzysztof Helt 	static int possible_irqs[] = { 5, 7, 9, 10, 11, -1 };
544e307258dSKrzysztof Helt 	static int possible_dmas[] = { 1, 3, 0, -1 };
545e307258dSKrzysztof Helt 	int err;
546e307258dSKrzysztof Helt 	int xirq = irq[dev];
547e307258dSKrzysztof Helt 	int xdma = dma[dev];
548e307258dSKrzysztof Helt 	struct snd_card *card;
549241b3ee7SKrzysztof Helt 	struct snd_wss *chip;
550e307258dSKrzysztof Helt 	struct snd_opl3 *opl3;
551c2828661SKrzysztof Helt 	char __iomem **vport;
552e307258dSKrzysztof Helt 	char __iomem *vmss_port;
553e307258dSKrzysztof Helt 
554e307258dSKrzysztof Helt 
555c2828661SKrzysztof Helt 	err = snd_card_create(index[dev], id[dev], THIS_MODULE, sizeof(vport),
556c2828661SKrzysztof Helt 				&card);
557c95eadd2STakashi Iwai 	if (err < 0)
558c95eadd2STakashi Iwai 		return err;
559e307258dSKrzysztof Helt 
560c2828661SKrzysztof Helt 	vport = card->private_data;
561e307258dSKrzysztof Helt 	if (xirq == SNDRV_AUTO_IRQ) {
562e307258dSKrzysztof Helt 		xirq = snd_legacy_find_free_irq(possible_irqs);
563e307258dSKrzysztof Helt 		if (xirq < 0) {
564e307258dSKrzysztof Helt 			snd_printk(KERN_ERR PFX "unable to find a free IRQ\n");
565e307258dSKrzysztof Helt 			err = -EBUSY;
566e307258dSKrzysztof Helt 			goto err_exit;
567e307258dSKrzysztof Helt 		}
568e307258dSKrzysztof Helt 	}
569e307258dSKrzysztof Helt 
570e307258dSKrzysztof Helt 	if (xdma == SNDRV_AUTO_DMA) {
571e307258dSKrzysztof Helt 		xdma = snd_legacy_find_free_dma(possible_dmas);
572e307258dSKrzysztof Helt 		if (xdma < 0) {
573e307258dSKrzysztof Helt 			snd_printk(KERN_ERR PFX "unable to find a free DMA\n");
574e307258dSKrzysztof Helt 			err = -EBUSY;
575e307258dSKrzysztof Helt 			goto err_exit;
576e307258dSKrzysztof Helt 		}
577e307258dSKrzysztof Helt 	}
578e307258dSKrzysztof Helt 
579e307258dSKrzysztof Helt 	if (!request_region(port[dev], 0x10, DRV_NAME)) {
580e307258dSKrzysztof Helt 		snd_printk(KERN_ERR PFX
581e307258dSKrzysztof Helt 			   "I/O port region is already in use.\n");
582e307258dSKrzysztof Helt 		err = -EBUSY;
583e307258dSKrzysztof Helt 		goto err_exit;
584e307258dSKrzysztof Helt 	}
585c2828661SKrzysztof Helt 	*vport = devm_ioport_map(devptr, port[dev], 0x10);
586c2828661SKrzysztof Helt 	if (*vport == NULL) {
587e307258dSKrzysztof Helt 		snd_printk(KERN_ERR PFX
588e307258dSKrzysztof Helt 			   "I/O port cannot be iomaped.\n");
589e307258dSKrzysztof Helt 		err = -EBUSY;
590e307258dSKrzysztof Helt 		goto err_unmap1;
591e307258dSKrzysztof Helt 	}
592e307258dSKrzysztof Helt 
593e307258dSKrzysztof Helt 	/* to make it marked as used */
594e307258dSKrzysztof Helt 	if (!request_region(mss_port[dev], 4, DRV_NAME)) {
595e307258dSKrzysztof Helt 		snd_printk(KERN_ERR PFX
596e307258dSKrzysztof Helt 			   "SC-6000 port I/O port region is already in use.\n");
597e307258dSKrzysztof Helt 		err = -EBUSY;
5981cf0bc7eSKrzysztof Helt 		goto err_unmap1;
599e307258dSKrzysztof Helt 	}
600e307258dSKrzysztof Helt 	vmss_port = devm_ioport_map(devptr, mss_port[dev], 4);
601c2828661SKrzysztof Helt 	if (!vmss_port) {
602e307258dSKrzysztof Helt 		snd_printk(KERN_ERR PFX
603e307258dSKrzysztof Helt 			   "MSS port I/O cannot be iomaped.\n");
604e307258dSKrzysztof Helt 		err = -EBUSY;
605e307258dSKrzysztof Helt 		goto err_unmap2;
606e307258dSKrzysztof Helt 	}
607e307258dSKrzysztof Helt 
608e307258dSKrzysztof Helt 	snd_printd("Initializing BASE[0x%lx] IRQ[%d] DMA[%d] MIRQ[%d]\n",
609e307258dSKrzysztof Helt 		   port[dev], xirq, xdma,
610e307258dSKrzysztof Helt 		   mpu_irq[dev] == SNDRV_AUTO_IRQ ? 0 : mpu_irq[dev]);
611e307258dSKrzysztof Helt 
612c2828661SKrzysztof Helt 	err = sc6000_init_board(*vport, vmss_port, dev);
613e307258dSKrzysztof Helt 	if (err < 0)
614e307258dSKrzysztof Helt 		goto err_unmap2;
615e307258dSKrzysztof Helt 
616760fc6b8SKrzysztof Helt 	err = snd_wss_create(card, mss_port[dev] + 4,  -1, xirq, xdma, -1,
617760fc6b8SKrzysztof Helt 			     WSS_HW_DETECT, 0, &chip);
618e307258dSKrzysztof Helt 	if (err < 0)
619e307258dSKrzysztof Helt 		goto err_unmap2;
620e307258dSKrzysztof Helt 
621ead893c0SKrzysztof Helt 	err = snd_wss_pcm(chip, 0, NULL);
622e307258dSKrzysztof Helt 	if (err < 0) {
623e307258dSKrzysztof Helt 		snd_printk(KERN_ERR PFX
624ead893c0SKrzysztof Helt 			   "error creating new WSS PCM device\n");
625e307258dSKrzysztof Helt 		goto err_unmap2;
626e307258dSKrzysztof Helt 	}
6275664daa1SKrzysztof Helt 	err = snd_wss_mixer(chip);
628e307258dSKrzysztof Helt 	if (err < 0) {
6295664daa1SKrzysztof Helt 		snd_printk(KERN_ERR PFX "error creating new WSS mixer\n");
630e307258dSKrzysztof Helt 		goto err_unmap2;
631e307258dSKrzysztof Helt 	}
632e307258dSKrzysztof Helt 	err = snd_sc6000_mixer(chip);
633e307258dSKrzysztof Helt 	if (err < 0) {
634e307258dSKrzysztof Helt 		snd_printk(KERN_ERR PFX "the mixer rewrite failed\n");
635e307258dSKrzysztof Helt 		goto err_unmap2;
636e307258dSKrzysztof Helt 	}
637e307258dSKrzysztof Helt 	if (snd_opl3_create(card,
638e307258dSKrzysztof Helt 			    0x388, 0x388 + 2,
639e307258dSKrzysztof Helt 			    OPL3_HW_AUTO, 0, &opl3) < 0) {
640e307258dSKrzysztof Helt 		snd_printk(KERN_ERR PFX "no OPL device at 0x%x-0x%x ?\n",
641e307258dSKrzysztof Helt 			   0x388, 0x388 + 2);
642e307258dSKrzysztof Helt 	} else {
643e307258dSKrzysztof Helt 		err = snd_opl3_hwdep_new(opl3, 0, 1, NULL);
644e307258dSKrzysztof Helt 		if (err < 0)
645e307258dSKrzysztof Helt 			goto err_unmap2;
646e307258dSKrzysztof Helt 	}
647e307258dSKrzysztof Helt 
648e307258dSKrzysztof Helt 	if (mpu_port[dev] != SNDRV_AUTO_PORT) {
649e307258dSKrzysztof Helt 		if (mpu_irq[dev] == SNDRV_AUTO_IRQ)
650e307258dSKrzysztof Helt 			mpu_irq[dev] = -1;
651e307258dSKrzysztof Helt 		if (snd_mpu401_uart_new(card, 0,
652e307258dSKrzysztof Helt 					MPU401_HW_MPU401,
653e307258dSKrzysztof Helt 					mpu_port[dev], 0,
654e307258dSKrzysztof Helt 					mpu_irq[dev], IRQF_DISABLED,
655e307258dSKrzysztof Helt 					NULL) < 0)
656e307258dSKrzysztof Helt 			snd_printk(KERN_ERR "no MPU-401 device at 0x%lx ?\n",
657e307258dSKrzysztof Helt 					mpu_port[dev]);
658e307258dSKrzysztof Helt 	}
659e307258dSKrzysztof Helt 
660e307258dSKrzysztof Helt 	strcpy(card->driver, DRV_NAME);
661e307258dSKrzysztof Helt 	strcpy(card->shortname, "SC-6000");
662e307258dSKrzysztof Helt 	sprintf(card->longname, "Gallant SC-6000 at 0x%lx, irq %d, dma %d",
663e307258dSKrzysztof Helt 		mss_port[dev], xirq, xdma);
664e307258dSKrzysztof Helt 
665e307258dSKrzysztof Helt 	snd_card_set_dev(card, devptr);
666e307258dSKrzysztof Helt 
667e307258dSKrzysztof Helt 	err = snd_card_register(card);
668e307258dSKrzysztof Helt 	if (err < 0)
669e307258dSKrzysztof Helt 		goto err_unmap2;
670e307258dSKrzysztof Helt 
671e307258dSKrzysztof Helt 	dev_set_drvdata(devptr, card);
672e307258dSKrzysztof Helt 	return 0;
673e307258dSKrzysztof Helt 
674e307258dSKrzysztof Helt err_unmap2:
675c2828661SKrzysztof Helt 	sc6000_setup_board(*vport, 0);
676e307258dSKrzysztof Helt 	release_region(mss_port[dev], 4);
677e307258dSKrzysztof Helt err_unmap1:
678e307258dSKrzysztof Helt 	release_region(port[dev], 0x10);
679e307258dSKrzysztof Helt err_exit:
680e307258dSKrzysztof Helt 	snd_card_free(card);
681e307258dSKrzysztof Helt 	return err;
682e307258dSKrzysztof Helt }
683e307258dSKrzysztof Helt 
684e307258dSKrzysztof Helt static int __devexit snd_sc6000_remove(struct device *devptr, unsigned int dev)
685e307258dSKrzysztof Helt {
686c2828661SKrzysztof Helt 	struct snd_card *card = dev_get_drvdata(devptr);
687c2828661SKrzysztof Helt 	char __iomem **vport = card->private_data;
688c2828661SKrzysztof Helt 
689c2828661SKrzysztof Helt 	if (sc6000_setup_board(*vport, 0) < 0)
690c2828661SKrzysztof Helt 		snd_printk(KERN_WARNING "sc6000_setup_board failed on exit!\n");
691c2828661SKrzysztof Helt 
692e307258dSKrzysztof Helt 	release_region(port[dev], 0x10);
693e307258dSKrzysztof Helt 	release_region(mss_port[dev], 4);
694e307258dSKrzysztof Helt 
695e307258dSKrzysztof Helt 	dev_set_drvdata(devptr, NULL);
696c2828661SKrzysztof Helt 	snd_card_free(card);
697e307258dSKrzysztof Helt 	return 0;
698e307258dSKrzysztof Helt }
699e307258dSKrzysztof Helt 
700e307258dSKrzysztof Helt static struct isa_driver snd_sc6000_driver = {
701e307258dSKrzysztof Helt 	.match		= snd_sc6000_match,
702e307258dSKrzysztof Helt 	.probe		= snd_sc6000_probe,
703e307258dSKrzysztof Helt 	.remove		= __devexit_p(snd_sc6000_remove),
704e307258dSKrzysztof Helt 	/* FIXME: suspend/resume */
705e307258dSKrzysztof Helt 	.driver		= {
706e307258dSKrzysztof Helt 		.name	= DRV_NAME,
707e307258dSKrzysztof Helt 	},
708e307258dSKrzysztof Helt };
709e307258dSKrzysztof Helt 
710e307258dSKrzysztof Helt 
711e307258dSKrzysztof Helt static int __init alsa_card_sc6000_init(void)
712e307258dSKrzysztof Helt {
713e307258dSKrzysztof Helt 	return isa_register_driver(&snd_sc6000_driver, SNDRV_CARDS);
714e307258dSKrzysztof Helt }
715e307258dSKrzysztof Helt 
716e307258dSKrzysztof Helt static void __exit alsa_card_sc6000_exit(void)
717e307258dSKrzysztof Helt {
718e307258dSKrzysztof Helt 	isa_unregister_driver(&snd_sc6000_driver);
719e307258dSKrzysztof Helt }
720e307258dSKrzysztof Helt 
721e307258dSKrzysztof Helt module_init(alsa_card_sc6000_init)
722e307258dSKrzysztof Helt module_exit(alsa_card_sc6000_exit)
723