522 строки
12 KiB
C
522 строки
12 KiB
C
/*
|
|
* eisa_enumerator.c - provide support for EISA adapters in PA-RISC machines
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version
|
|
* 2 of the License, or (at your option) any later version.
|
|
*
|
|
* Copyright (c) 2002 Daniel Engstrom <5116@telia.com>
|
|
*
|
|
*/
|
|
|
|
#include <linux/ioport.h>
|
|
#include <linux/init.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/slab.h>
|
|
#include <asm/io.h>
|
|
#include <asm/uaccess.h>
|
|
#include <asm/byteorder.h>
|
|
|
|
#include <asm/eisa_bus.h>
|
|
#include <asm/eisa_eeprom.h>
|
|
|
|
|
|
/*
|
|
* Todo:
|
|
*
|
|
* PORT init with MASK attr and other size than byte
|
|
* MEMORY with other decode than 20 bit
|
|
* CRC stuff
|
|
* FREEFORM stuff
|
|
*/
|
|
|
|
#define EPI 0xc80
|
|
#define NUM_SLOT 16
|
|
#define SLOT2PORT(x) (x<<12)
|
|
|
|
|
|
/* macros to handle unaligned accesses and
|
|
* byte swapping. The data in the EEPROM is
|
|
* little-endian on the big-endian PAROSC */
|
|
#define get_8(x) (*(u_int8_t*)(x))
|
|
|
|
static inline u_int16_t get_16(const unsigned char *x)
|
|
{
|
|
return (x[1] << 8) | x[0];
|
|
}
|
|
|
|
static inline u_int32_t get_32(const unsigned char *x)
|
|
{
|
|
return (x[3] << 24) | (x[2] << 16) | (x[1] << 8) | x[0];
|
|
}
|
|
|
|
static inline u_int32_t get_24(const unsigned char *x)
|
|
{
|
|
return (x[2] << 24) | (x[1] << 16) | (x[0] << 8);
|
|
}
|
|
|
|
static void print_eisa_id(char *s, u_int32_t id)
|
|
{
|
|
char vendor[4];
|
|
int rev;
|
|
int device;
|
|
|
|
rev = id & 0xff;
|
|
id >>= 8;
|
|
device = id & 0xff;
|
|
id >>= 8;
|
|
vendor[3] = '\0';
|
|
vendor[2] = '@' + (id & 0x1f);
|
|
id >>= 5;
|
|
vendor[1] = '@' + (id & 0x1f);
|
|
id >>= 5;
|
|
vendor[0] = '@' + (id & 0x1f);
|
|
id >>= 5;
|
|
|
|
sprintf(s, "%s%02X%02X", vendor, device, rev);
|
|
}
|
|
|
|
static int configure_memory(const unsigned char *buf,
|
|
struct resource *mem_parent,
|
|
char *name)
|
|
{
|
|
int len;
|
|
u_int8_t c;
|
|
int i;
|
|
struct resource *res;
|
|
|
|
len=0;
|
|
|
|
for (i=0;i<HPEE_MEMORY_MAX_ENT;i++) {
|
|
c = get_8(buf+len);
|
|
|
|
if (NULL != (res = kmalloc(sizeof(struct resource), GFP_KERNEL))) {
|
|
int result;
|
|
|
|
res->name = name;
|
|
res->start = mem_parent->start + get_24(buf+len+2);
|
|
res->end = res->start + get_16(buf+len+5)*1024;
|
|
res->flags = IORESOURCE_MEM;
|
|
printk("memory %lx-%lx ", res->start, res->end);
|
|
result = request_resource(mem_parent, res);
|
|
if (result < 0) {
|
|
printk("\n" KERN_ERR "EISA Enumerator: failed to claim EISA Bus address space!\n");
|
|
return result;
|
|
}
|
|
}
|
|
|
|
len+=7;
|
|
|
|
if (!(c & HPEE_MEMORY_MORE)) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
|
|
static int configure_irq(const unsigned char *buf)
|
|
{
|
|
int len;
|
|
u_int8_t c;
|
|
int i;
|
|
|
|
len=0;
|
|
|
|
for (i=0;i<HPEE_IRQ_MAX_ENT;i++) {
|
|
c = get_8(buf+len);
|
|
|
|
printk("IRQ %d ", c & HPEE_IRQ_CHANNEL_MASK);
|
|
if (c & HPEE_IRQ_TRIG_LEVEL) {
|
|
eisa_make_irq_level(c & HPEE_IRQ_CHANNEL_MASK);
|
|
} else {
|
|
eisa_make_irq_edge(c & HPEE_IRQ_CHANNEL_MASK);
|
|
}
|
|
|
|
len+=2;
|
|
/* hpux seems to allow for
|
|
* two bytes of irq data but only defines one of
|
|
* them, I think */
|
|
if (!(c & HPEE_IRQ_MORE)) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
|
|
static int configure_dma(const unsigned char *buf)
|
|
{
|
|
int len;
|
|
u_int8_t c;
|
|
int i;
|
|
|
|
len=0;
|
|
|
|
for (i=0;i<HPEE_DMA_MAX_ENT;i++) {
|
|
c = get_8(buf+len);
|
|
printk("DMA %d ", c&HPEE_DMA_CHANNEL_MASK);
|
|
/* fixme: maybe initialize the dma channel withthe timing ? */
|
|
len+=2;
|
|
if (!(c & HPEE_DMA_MORE)) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
static int configure_port(const unsigned char *buf, struct resource *io_parent,
|
|
char *board)
|
|
{
|
|
int len;
|
|
u_int8_t c;
|
|
int i;
|
|
struct resource *res;
|
|
int result;
|
|
|
|
len=0;
|
|
|
|
for (i=0;i<HPEE_PORT_MAX_ENT;i++) {
|
|
c = get_8(buf+len);
|
|
|
|
if (NULL != (res = kmalloc(sizeof(struct resource), GFP_KERNEL))) {
|
|
res->name = board;
|
|
res->start = get_16(buf+len+1);
|
|
res->end = get_16(buf+len+1)+(c&HPEE_PORT_SIZE_MASK)+1;
|
|
res->flags = IORESOURCE_IO;
|
|
printk("ioports %lx-%lx ", res->start, res->end);
|
|
result = request_resource(io_parent, res);
|
|
if (result < 0) {
|
|
printk("\n" KERN_ERR "EISA Enumerator: failed to claim EISA Bus address space!\n");
|
|
return result;
|
|
}
|
|
}
|
|
|
|
len+=3;
|
|
if (!(c & HPEE_PORT_MORE)) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
|
|
/* byte 1 and 2 is the port number to write
|
|
* and at byte 3 the value to write starts.
|
|
* I assume that there are and- and or- masks
|
|
* here when HPEE_PORT_INIT_MASK is set but I have
|
|
* not yet encountered this. */
|
|
static int configure_port_init(const unsigned char *buf)
|
|
{
|
|
int len=0;
|
|
u_int8_t c;
|
|
|
|
while (len<HPEE_PORT_INIT_MAX_LEN) {
|
|
int s=0;
|
|
c = get_8(buf+len);
|
|
|
|
switch (c & HPEE_PORT_INIT_WIDTH_MASK) {
|
|
case HPEE_PORT_INIT_WIDTH_BYTE:
|
|
s=1;
|
|
if (c & HPEE_PORT_INIT_MASK) {
|
|
printk("\n" KERN_WARNING "port_init: unverified mask attribute\n");
|
|
outb((inb(get_16(buf+len+1) &
|
|
get_8(buf+len+3)) |
|
|
get_8(buf+len+4)), get_16(buf+len+1));
|
|
|
|
} else {
|
|
outb(get_8(buf+len+3), get_16(buf+len+1));
|
|
|
|
}
|
|
break;
|
|
case HPEE_PORT_INIT_WIDTH_WORD:
|
|
s=2;
|
|
if (c & HPEE_PORT_INIT_MASK) {
|
|
printk(KERN_WARNING "port_init: unverified mask attribute\n");
|
|
outw((inw(get_16(buf+len+1)) &
|
|
get_16(buf+len+3)) |
|
|
get_16(buf+len+5),
|
|
get_16(buf+len+1));
|
|
} else {
|
|
outw(cpu_to_le16(get_16(buf+len+3)), get_16(buf+len+1));
|
|
}
|
|
break;
|
|
case HPEE_PORT_INIT_WIDTH_DWORD:
|
|
s=4;
|
|
if (c & HPEE_PORT_INIT_MASK) {
|
|
printk("\n" KERN_WARNING "port_init: unverified mask attribute\n");
|
|
outl((inl(get_16(buf+len+1) &
|
|
get_32(buf+len+3)) |
|
|
get_32(buf+len+7)), get_16(buf+len+1));
|
|
} else {
|
|
outl(cpu_to_le32(get_32(buf+len+3)), get_16(buf+len+1));
|
|
}
|
|
|
|
break;
|
|
default:
|
|
printk("\n" KERN_ERR "Invalid port init word %02x\n", c);
|
|
return 0;
|
|
}
|
|
|
|
if (c & HPEE_PORT_INIT_MASK) {
|
|
s*=2;
|
|
}
|
|
|
|
len+=s+3;
|
|
if (!(c & HPEE_PORT_INIT_MORE)) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
static int configure_choise(const unsigned char *buf, u_int8_t *info)
|
|
{
|
|
int len;
|
|
|
|
/* theis record contain the value of the functions
|
|
* configuration choises and an info byte which
|
|
* describes which other records to expect in this
|
|
* function */
|
|
len = get_8(buf);
|
|
*info=get_8(buf+len+1);
|
|
|
|
return len+2;
|
|
}
|
|
|
|
static int configure_type_string(const unsigned char *buf)
|
|
{
|
|
int len;
|
|
|
|
/* just skip past the type field */
|
|
len = get_8(buf);
|
|
if (len > 80) {
|
|
printk("\n" KERN_ERR "eisa_enumerator: type info field too long (%d, max is 80)\n", len);
|
|
}
|
|
|
|
return 1+len;
|
|
}
|
|
|
|
static int configure_function(const unsigned char *buf, int *more)
|
|
{
|
|
/* the init field seems to be a two-byte field
|
|
* which is non-zero if there are an other function following
|
|
* I think it is the length of the function def
|
|
*/
|
|
*more = get_16(buf);
|
|
|
|
return 2;
|
|
}
|
|
|
|
static int parse_slot_config(int slot,
|
|
const unsigned char *buf,
|
|
struct eeprom_eisa_slot_info *es,
|
|
struct resource *io_parent,
|
|
struct resource *mem_parent)
|
|
{
|
|
int res=0;
|
|
int function_len;
|
|
unsigned int pos=0;
|
|
unsigned int maxlen;
|
|
int num_func=0;
|
|
u_int8_t flags;
|
|
int p0;
|
|
|
|
char *board;
|
|
int id_string_used=0;
|
|
|
|
if (NULL == (board = kmalloc(8, GFP_KERNEL))) {
|
|
return -1;
|
|
}
|
|
print_eisa_id(board, es->eisa_slot_id);
|
|
printk(KERN_INFO "EISA slot %d: %s %s ",
|
|
slot, board, es->flags&HPEE_FLAG_BOARD_IS_ISA ? "ISA" : "EISA");
|
|
|
|
maxlen = es->config_data_length < HPEE_MAX_LENGTH ?
|
|
es->config_data_length : HPEE_MAX_LENGTH;
|
|
while ((pos < maxlen) && (num_func <= es->num_functions)) {
|
|
pos+=configure_function(buf+pos, &function_len);
|
|
|
|
if (!function_len) {
|
|
break;
|
|
}
|
|
num_func++;
|
|
p0 = pos;
|
|
pos += configure_choise(buf+pos, &flags);
|
|
|
|
if (flags & HPEE_FUNCTION_INFO_F_DISABLED) {
|
|
/* function disabled, skip silently */
|
|
pos = p0 + function_len;
|
|
continue;
|
|
}
|
|
if (flags & HPEE_FUNCTION_INFO_CFG_FREE_FORM) {
|
|
/* I have no idea how to handle this */
|
|
printk("function %d have free-form confgiuration, skipping ",
|
|
num_func);
|
|
pos = p0 + function_len;
|
|
continue;
|
|
}
|
|
|
|
/* the ordering of the sections need
|
|
* more investigation.
|
|
* Currently I think that memory comaed before IRQ
|
|
* I assume the order is LSB to MSB in the
|
|
* info flags
|
|
* eg type, memory, irq, dma, port, HPEE_PORT_init
|
|
*/
|
|
|
|
if (flags & HPEE_FUNCTION_INFO_HAVE_TYPE) {
|
|
pos += configure_type_string(buf+pos);
|
|
}
|
|
|
|
if (flags & HPEE_FUNCTION_INFO_HAVE_MEMORY) {
|
|
id_string_used=1;
|
|
pos += configure_memory(buf+pos, mem_parent, board);
|
|
}
|
|
|
|
if (flags & HPEE_FUNCTION_INFO_HAVE_IRQ) {
|
|
pos += configure_irq(buf+pos);
|
|
}
|
|
|
|
if (flags & HPEE_FUNCTION_INFO_HAVE_DMA) {
|
|
pos += configure_dma(buf+pos);
|
|
}
|
|
|
|
if (flags & HPEE_FUNCTION_INFO_HAVE_PORT) {
|
|
id_string_used=1;
|
|
pos += configure_port(buf+pos, io_parent, board);
|
|
}
|
|
|
|
if (flags & HPEE_FUNCTION_INFO_HAVE_PORT_INIT) {
|
|
pos += configure_port_init(buf+pos);
|
|
}
|
|
|
|
if (p0 + function_len < pos) {
|
|
printk("\n" KERN_ERR "eisa_enumerator: function %d length mis-match "
|
|
"got %d, expected %d\n",
|
|
num_func, pos-p0, function_len);
|
|
res=-1;
|
|
break;
|
|
}
|
|
pos = p0 + function_len;
|
|
}
|
|
printk("\n");
|
|
if (!id_string_used) {
|
|
kfree(board);
|
|
}
|
|
|
|
if (pos != es->config_data_length) {
|
|
printk(KERN_ERR "eisa_enumerator: config data length mis-match got %d, expected %d\n",
|
|
pos, es->config_data_length);
|
|
res=-1;
|
|
}
|
|
|
|
if (num_func != es->num_functions) {
|
|
printk(KERN_ERR "eisa_enumerator: number of functions mis-match got %d, expected %d\n",
|
|
num_func, es->num_functions);
|
|
res=-2;
|
|
}
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
static int init_slot(int slot, struct eeprom_eisa_slot_info *es)
|
|
{
|
|
unsigned int id;
|
|
|
|
char id_string[8];
|
|
|
|
if (!(es->slot_info&HPEE_SLOT_INFO_NO_READID)) {
|
|
/* try to read the id of the board in the slot */
|
|
id = le32_to_cpu(inl(SLOT2PORT(slot)+EPI));
|
|
|
|
if (0xffffffff == id) {
|
|
/* Maybe we didn't expect a card to be here... */
|
|
if (es->eisa_slot_id == 0xffffffff)
|
|
return -1;
|
|
|
|
/* this board is not here or it does not
|
|
* support readid
|
|
*/
|
|
printk(KERN_ERR "EISA slot %d a configured board was not detected (",
|
|
slot);
|
|
|
|
print_eisa_id(id_string, es->eisa_slot_id);
|
|
printk(" expected %s)\n", id_string);
|
|
|
|
return -1;
|
|
|
|
}
|
|
if (es->eisa_slot_id != id) {
|
|
print_eisa_id(id_string, id);
|
|
printk(KERN_ERR "EISA slot %d id mis-match: got %s",
|
|
slot, id_string);
|
|
|
|
print_eisa_id(id_string, es->eisa_slot_id);
|
|
printk(" expected %s \n", id_string);
|
|
|
|
return -1;
|
|
|
|
}
|
|
}
|
|
|
|
/* now: we need to enable the board if
|
|
* it supports enabling and run through
|
|
* the port init sction if present
|
|
* and finally record any interrupt polarity
|
|
*/
|
|
if (es->slot_features & HPEE_SLOT_FEATURES_ENABLE) {
|
|
/* enable board */
|
|
outb(0x01| inb(SLOT2PORT(slot)+EPI+4),
|
|
SLOT2PORT(slot)+EPI+4);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
int eisa_enumerator(unsigned long eeprom_addr,
|
|
struct resource *io_parent, struct resource *mem_parent)
|
|
{
|
|
int i;
|
|
struct eeprom_header *eh;
|
|
static char eeprom_buf[HPEE_MAX_LENGTH];
|
|
|
|
for (i=0; i < HPEE_MAX_LENGTH; i++) {
|
|
eeprom_buf[i] = gsc_readb(eeprom_addr+i);
|
|
}
|
|
|
|
printk(KERN_INFO "Enumerating EISA bus\n");
|
|
|
|
eh = (struct eeprom_header*)(eeprom_buf);
|
|
for (i=0;i<eh->num_slots;i++) {
|
|
struct eeprom_eisa_slot_info *es;
|
|
|
|
es = (struct eeprom_eisa_slot_info*)
|
|
(&eeprom_buf[HPEE_SLOT_INFO(i)]);
|
|
|
|
if (-1==init_slot(i+1, es)) {
|
|
continue;
|
|
}
|
|
|
|
if (es->config_data_offset < HPEE_MAX_LENGTH) {
|
|
if (parse_slot_config(i+1, &eeprom_buf[es->config_data_offset],
|
|
es, io_parent, mem_parent)) {
|
|
return -1;
|
|
}
|
|
} else {
|
|
printk (KERN_WARNING "EISA EEPROM offset 0x%x out of range\n",es->config_data_offset);
|
|
return -1;
|
|
}
|
|
}
|
|
return eh->num_slots;
|
|
}
|
|
|