cregit-Linux how code gets into the kernel

Release 4.11 drivers/parisc/eisa_enumerator.c

Directory: drivers/parisc
/*
 * 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 <linux/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]; }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox28100.00%1100.00%
Total28100.00%1100.00%


static inline u_int32_t get_32(const unsigned char *x) { return (x[3] << 24) | (x[2] << 16) | (x[1] << 8) | x[0]; }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox46100.00%1100.00%
Total46100.00%1100.00%


static inline u_int32_t get_24(const unsigned char *x) { return (x[2] << 24) | (x[1] << 16) | (x[0] << 8); }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox41100.00%1100.00%
Total41100.00%1100.00%


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); }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox116100.00%1100.00%
Total116100.00%1100.00%


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 = kzalloc(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 ", (unsigned long)res->start, (unsigned long)res->end); result = request_resource(mem_parent, res); if (result < 0) { printk(KERN_ERR "EISA Enumerator: failed to claim EISA Bus address space!\n"); return result; } } len+=7; if (!(c & HPEE_MEMORY_MORE)) { break; } } return len; }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox19295.52%133.33%
Alexander Beregalov83.98%133.33%
Toshi Kani10.50%133.33%
Total201100.00%3100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox103100.00%1100.00%
Total103100.00%1100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox78100.00%1100.00%
Total78100.00%1100.00%


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 = kzalloc(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 ", (unsigned long)res->start, (unsigned long)res->end); result = request_resource(io_parent, res); if (result < 0) { printk(KERN_ERR "EISA Enumerator: failed to claim EISA Bus address space!\n"); return result; } } len+=3; if (!(c & HPEE_PORT_MORE)) { break; } } return len; }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox19095.48%133.33%
Alexander Beregalov84.02%133.33%
Toshi Kani10.50%133.33%
Total199100.00%3100.00%

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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox371100.00%1100.00%
Total371100.00%1100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox44100.00%1100.00%
Total44100.00%1100.00%


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(KERN_ERR "eisa_enumerator: type info field too long (%d, max is 80)\n", len); } return 1+len; }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox44100.00%1100.00%
Total44100.00%1100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox28100.00%1100.00%
Total28100.00%1100.00%


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 configuration, 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(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; }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox45799.78%150.00%
Masanari Iida10.22%150.00%
Total458100.00%2100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox17792.67%133.33%
Marc Zyngier136.81%133.33%
Frans Pop10.52%133.33%
Total191100.00%3100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox19297.96%150.00%
Marc Zyngier42.04%150.00%
Total196100.00%2100.00%


Overall Contributors

PersonTokensPropCommitsCommitProp
Matthew Wilcox215998.27%114.29%
Marc Zyngier170.77%114.29%
Alexander Beregalov160.73%114.29%
Toshi Kani20.09%114.29%
Masanari Iida10.05%114.29%
Linus Torvalds10.05%114.29%
Frans Pop10.05%114.29%
Total2197100.00%7100.00%
Directory: drivers/parisc
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.