| /* | |
| * SMC 37C93X initialization code | |
| */ | |
| #include <linux/kernel.h> | |
| #include <linux/mm.h> | |
| #include <linux/init.h> | |
| #include <linux/delay.h> | |
| #include <asm/hwrpb.h> | |
| #include <asm/io.h> | |
| #include <asm/segment.h> | |
| #define SMC_DEBUG 0 | |
| #if SMC_DEBUG | |
| # define DBG_DEVS(args) printk args | |
| #else | |
| # define DBG_DEVS(args) | |
| #endif | |
| #define KB 1024 | |
| #define MB (1024*KB) | |
| #define GB (1024*MB) | |
| /* device "activate" register contents */ | |
| #define DEVICE_ON 1 | |
| #define DEVICE_OFF 0 | |
| /* configuration on/off keys */ | |
| #define CONFIG_ON_KEY 0x55 | |
| #define CONFIG_OFF_KEY 0xaa | |
| /* configuration space device definitions */ | |
| #define FDC 0 | |
| #define IDE1 1 | |
| #define IDE2 2 | |
| #define PARP 3 | |
| #define SER1 4 | |
| #define SER2 5 | |
| #define RTCL 6 | |
| #define KYBD 7 | |
| #define AUXIO 8 | |
| /* Chip register offsets from base */ | |
| #define CONFIG_CONTROL 0x02 | |
| #define INDEX_ADDRESS 0x03 | |
| #define LOGICAL_DEVICE_NUMBER 0x07 | |
| #define DEVICE_ID 0x20 | |
| #define DEVICE_REV 0x21 | |
| #define POWER_CONTROL 0x22 | |
| #define POWER_MGMT 0x23 | |
| #define OSC 0x24 | |
| #define ACTIVATE 0x30 | |
| #define ADDR_HI 0x60 | |
| #define ADDR_LO 0x61 | |
| #define INTERRUPT_SEL 0x70 | |
| #define INTERRUPT_SEL_2 0x72 /* KYBD/MOUS only */ | |
| #define DMA_CHANNEL_SEL 0x74 /* FDC/PARP only */ | |
| #define FDD_MODE_REGISTER 0x90 | |
| #define FDD_OPTION_REGISTER 0x91 | |
| /* values that we read back that are expected ... */ | |
| #define VALID_DEVICE_ID 2 | |
| /* default device addresses */ | |
| #define KYBD_INTERRUPT 1 | |
| #define MOUS_INTERRUPT 12 | |
| #define COM2_BASE 0x2f8 | |
| #define COM2_INTERRUPT 3 | |
| #define COM1_BASE 0x3f8 | |
| #define COM1_INTERRUPT 4 | |
| #define PARP_BASE 0x3bc | |
| #define PARP_INTERRUPT 7 | |
| static unsigned long __init SMCConfigState(unsigned long baseAddr) | |
| { | |
| unsigned char devId; | |
| unsigned long configPort; | |
| unsigned long indexPort; | |
| unsigned long dataPort; | |
| int i; | |
| configPort = indexPort = baseAddr; | |
| dataPort = configPort + 1; | |
| #define NUM_RETRIES 5 | |
| for (i = 0; i < NUM_RETRIES; i++) | |
| { | |
| outb(CONFIG_ON_KEY, configPort); | |
| outb(CONFIG_ON_KEY, configPort); | |
| outb(DEVICE_ID, indexPort); | |
| devId = inb(dataPort); | |
| if (devId == VALID_DEVICE_ID) { | |
| outb(DEVICE_REV, indexPort); | |
| /* unsigned char devRev = */ inb(dataPort); | |
| break; | |
| } | |
| else | |
| udelay(100); | |
| } | |
| return (i != NUM_RETRIES) ? baseAddr : 0L; | |
| } | |
| static void __init SMCRunState(unsigned long baseAddr) | |
| { | |
| outb(CONFIG_OFF_KEY, baseAddr); | |
| } | |
| static unsigned long __init SMCDetectUltraIO(void) | |
| { | |
| unsigned long baseAddr; | |
| baseAddr = 0x3F0; | |
| if ( ( baseAddr = SMCConfigState( baseAddr ) ) == 0x3F0 ) { | |
| return( baseAddr ); | |
| } | |
| baseAddr = 0x370; | |
| if ( ( baseAddr = SMCConfigState( baseAddr ) ) == 0x370 ) { | |
| return( baseAddr ); | |
| } | |
| return( ( unsigned long )0 ); | |
| } | |
| static void __init SMCEnableDevice(unsigned long baseAddr, | |
| unsigned long device, | |
| unsigned long portaddr, | |
| unsigned long interrupt) | |
| { | |
| unsigned long indexPort; | |
| unsigned long dataPort; | |
| indexPort = baseAddr; | |
| dataPort = baseAddr + 1; | |
| outb(LOGICAL_DEVICE_NUMBER, indexPort); | |
| outb(device, dataPort); | |
| outb(ADDR_LO, indexPort); | |
| outb(( portaddr & 0xFF ), dataPort); | |
| outb(ADDR_HI, indexPort); | |
| outb((portaddr >> 8) & 0xFF, dataPort); | |
| outb(INTERRUPT_SEL, indexPort); | |
| outb(interrupt, dataPort); | |
| outb(ACTIVATE, indexPort); | |
| outb(DEVICE_ON, dataPort); | |
| } | |
| static void __init SMCEnableKYBD(unsigned long baseAddr) | |
| { | |
| unsigned long indexPort; | |
| unsigned long dataPort; | |
| indexPort = baseAddr; | |
| dataPort = baseAddr + 1; | |
| outb(LOGICAL_DEVICE_NUMBER, indexPort); | |
| outb(KYBD, dataPort); | |
| outb(INTERRUPT_SEL, indexPort); /* Primary interrupt select */ | |
| outb(KYBD_INTERRUPT, dataPort); | |
| outb(INTERRUPT_SEL_2, indexPort); /* Secondary interrupt select */ | |
| outb(MOUS_INTERRUPT, dataPort); | |
| outb(ACTIVATE, indexPort); | |
| outb(DEVICE_ON, dataPort); | |
| } | |
| static void __init SMCEnableFDC(unsigned long baseAddr) | |
| { | |
| unsigned long indexPort; | |
| unsigned long dataPort; | |
| unsigned char oldValue; | |
| indexPort = baseAddr; | |
| dataPort = baseAddr + 1; | |
| outb(LOGICAL_DEVICE_NUMBER, indexPort); | |
| outb(FDC, dataPort); | |
| outb(FDD_MODE_REGISTER, indexPort); | |
| oldValue = inb(dataPort); | |
| oldValue |= 0x0E; /* Enable burst mode */ | |
| outb(oldValue, dataPort); | |
| outb(INTERRUPT_SEL, indexPort); /* Primary interrupt select */ | |
| outb(0x06, dataPort ); | |
| outb(DMA_CHANNEL_SEL, indexPort); /* DMA channel select */ | |
| outb(0x02, dataPort); | |
| outb(ACTIVATE, indexPort); | |
| outb(DEVICE_ON, dataPort); | |
| } | |
| #if SMC_DEBUG | |
| static void __init SMCReportDeviceStatus(unsigned long baseAddr) | |
| { | |
| unsigned long indexPort; | |
| unsigned long dataPort; | |
| unsigned char currentControl; | |
| indexPort = baseAddr; | |
| dataPort = baseAddr + 1; | |
| outb(POWER_CONTROL, indexPort); | |
| currentControl = inb(dataPort); | |
| printk(currentControl & (1 << FDC) | |
| ? "\t+FDC Enabled\n" : "\t-FDC Disabled\n"); | |
| printk(currentControl & (1 << IDE1) | |
| ? "\t+IDE1 Enabled\n" : "\t-IDE1 Disabled\n"); | |
| printk(currentControl & (1 << IDE2) | |
| ? "\t+IDE2 Enabled\n" : "\t-IDE2 Disabled\n"); | |
| printk(currentControl & (1 << PARP) | |
| ? "\t+PARP Enabled\n" : "\t-PARP Disabled\n"); | |
| printk(currentControl & (1 << SER1) | |
| ? "\t+SER1 Enabled\n" : "\t-SER1 Disabled\n"); | |
| printk(currentControl & (1 << SER2) | |
| ? "\t+SER2 Enabled\n" : "\t-SER2 Disabled\n"); | |
| printk( "\n" ); | |
| } | |
| #endif | |
| int __init SMC93x_Init(void) | |
| { | |
| unsigned long SMCUltraBase; | |
| unsigned long flags; | |
| local_irq_save(flags); | |
| if ((SMCUltraBase = SMCDetectUltraIO()) != 0UL) { | |
| #if SMC_DEBUG | |
| SMCReportDeviceStatus(SMCUltraBase); | |
| #endif | |
| SMCEnableDevice(SMCUltraBase, SER1, COM1_BASE, COM1_INTERRUPT); | |
| DBG_DEVS(("SMC FDC37C93X: SER1 done\n")); | |
| SMCEnableDevice(SMCUltraBase, SER2, COM2_BASE, COM2_INTERRUPT); | |
| DBG_DEVS(("SMC FDC37C93X: SER2 done\n")); | |
| SMCEnableDevice(SMCUltraBase, PARP, PARP_BASE, PARP_INTERRUPT); | |
| DBG_DEVS(("SMC FDC37C93X: PARP done\n")); | |
| /* On PC164, IDE on the SMC is not enabled; | |
| CMD646 (PCI) on MB */ | |
| SMCEnableKYBD(SMCUltraBase); | |
| DBG_DEVS(("SMC FDC37C93X: KYB done\n")); | |
| SMCEnableFDC(SMCUltraBase); | |
| DBG_DEVS(("SMC FDC37C93X: FDC done\n")); | |
| #if SMC_DEBUG | |
| SMCReportDeviceStatus(SMCUltraBase); | |
| #endif | |
| SMCRunState(SMCUltraBase); | |
| local_irq_restore(flags); | |
| printk("SMC FDC37C93X Ultra I/O Controller found @ 0x%lx\n", | |
| SMCUltraBase); | |
| return 1; | |
| } | |
| else { | |
| local_irq_restore(flags); | |
| DBG_DEVS(("No SMC FDC37C93X Ultra I/O Controller found\n")); | |
| return 0; | |
| } | |
| } |