932e0c201d
This patch probes for the Super IO chip and reserves the IO range when found. It avoids enabling the IDE interface on the Avanti family, since none has IDE. It enables the Enhanced Parallel Port v1.9 feature. Signed-off-by: Morten H. Larsen <m-larsen@post6.tele.dk> Signed-off-by: Matt Turner <mattst88@gmail.com>
89 lines
1.7 KiB
C
89 lines
1.7 KiB
C
#include <linux/ioport.h>
|
|
#include <asm/io.h>
|
|
|
|
#include "pc873xx.h"
|
|
|
|
static unsigned pc873xx_probelist[] = {0x398, 0x26e, 0};
|
|
|
|
static char *pc873xx_names[] = {
|
|
"PC87303", "PC87306", "PC87312", "PC87332", "PC87334"
|
|
};
|
|
|
|
static unsigned int base, model;
|
|
|
|
|
|
unsigned int __init pc873xx_get_base()
|
|
{
|
|
return base;
|
|
}
|
|
|
|
char *__init pc873xx_get_model()
|
|
{
|
|
return pc873xx_names[model];
|
|
}
|
|
|
|
static unsigned char __init pc873xx_read(unsigned int base, int reg)
|
|
{
|
|
outb(reg, base);
|
|
return inb(base + 1);
|
|
}
|
|
|
|
static void __init pc873xx_write(unsigned int base, int reg, unsigned char data)
|
|
{
|
|
unsigned long flags;
|
|
|
|
local_irq_save(flags);
|
|
outb(reg, base);
|
|
outb(data, base + 1);
|
|
outb(data, base + 1); /* Must be written twice */
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
int __init pc873xx_probe(void)
|
|
{
|
|
int val, index = 0;
|
|
|
|
while ((base = pc873xx_probelist[index++])) {
|
|
|
|
if (request_region(base, 2, "Super IO PC873xx") == NULL)
|
|
continue;
|
|
|
|
val = pc873xx_read(base, REG_SID);
|
|
if ((val & 0xf0) == 0x10) {
|
|
model = PC87332;
|
|
break;
|
|
} else if ((val & 0xf8) == 0x70) {
|
|
model = PC87306;
|
|
break;
|
|
} else if ((val & 0xf8) == 0x50) {
|
|
model = PC87334;
|
|
break;
|
|
} else if ((val & 0xf8) == 0x40) {
|
|
model = PC87303;
|
|
break;
|
|
}
|
|
|
|
release_region(base, 2);
|
|
}
|
|
|
|
return (base == 0) ? -1 : 1;
|
|
}
|
|
|
|
void __init pc873xx_enable_epp19(void)
|
|
{
|
|
unsigned char data;
|
|
|
|
printk(KERN_INFO "PC873xx enabling EPP v1.9\n");
|
|
data = pc873xx_read(base, REG_PCR);
|
|
pc873xx_write(base, REG_PCR, (data & 0xFC) | 0x02);
|
|
}
|
|
|
|
void __init pc873xx_enable_ide(void)
|
|
{
|
|
unsigned char data;
|
|
|
|
printk(KERN_INFO "PC873xx enabling IDE interrupt\n");
|
|
data = pc873xx_read(base, REG_FER);
|
|
pc873xx_write(base, REG_FER, data | 0x40);
|
|
}
|