| /* |
| * 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; |
| } |
| } |