Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

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