URL
https://opencores.org/ocsvn/or1k_soc_on_altera_embedded_dev_kit/or1k_soc_on_altera_embedded_dev_kit/trunk
Subversion Repositories or1k_soc_on_altera_embedded_dev_kit
[/] [or1k_soc_on_altera_embedded_dev_kit/] [trunk/] [linux-2.6/] [linux-2.6.24/] [arch/] [alpha/] [kernel/] [smc37c93x.c] - Rev 3
Compare with Previous | Blame | View Log
/* * SMC 37C93X initialization code */ #include <linux/kernel.h> #include <linux/slab.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 char devRev; 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); 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; } }