mirror of
https://github.com/FEX-Emu/linux.git
synced 2024-12-23 18:07:03 +00:00
278 lines
6.3 KiB
C
278 lines
6.3 KiB
C
|
/*
|
||
|
* SMC 37C93X initialization code
|
||
|
*/
|
||
|
|
||
|
#include <linux/config.h>
|
||
|
#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;
|
||
|
}
|
||
|
}
|