Viewing file: isa.c (6 KB) -rw-r--r-- Select action/file-type: (+) | (+) | (+) | Code (+) | Session (+) | (+) | SDB (+) | (+) | (+) | (+) | (+) | (+) |
#include <linux/kernel.h> #include <linux/init.h> #include <linux/pci.h> #include <linux/slab.h> #include <asm/oplib.h> #include <asm/isa.h>
struct isa_bridge *isa_chain;
static void __init fatal_err(const char *reason) { prom_printf("ISA: fatal error, %s.\n", reason); }
static void __init report_dev(struct isa_device *isa_dev, int child) { if (child) printk(" (%s)", isa_dev->prom_name); else printk(" [%s", isa_dev->prom_name); }
static void __init isa_dev_get_resource(struct isa_device *isa_dev) { struct linux_prom_registers regs[PROMREG_MAX]; unsigned long base, len; int prop_len;
prop_len = prom_getproperty(isa_dev->prom_node, "reg", (char *) regs, sizeof(regs));
if (prop_len <= 0) return;
/* Only the first one is interesting. */ len = regs[0].reg_size; base = (((unsigned long)regs[0].which_io << 32) | (unsigned long)regs[0].phys_addr); base += isa_dev->bus->parent->io_space.start;
isa_dev->resource.start = base; isa_dev->resource.end = (base + len - 1UL); isa_dev->resource.flags = IORESOURCE_IO; isa_dev->resource.name = isa_dev->prom_name;
request_resource(&isa_dev->bus->parent->io_space, &isa_dev->resource); }
/* I can't believe they didn't put a real INO in the isa device * interrupts property. The whole point of the OBP properties * is to shield the kernel from IRQ routing details. * * The P1275 standard for ISA devices seems to also have been * totally ignored. */ static struct { int obp_irq; int pci_ino; } grover_irq_table[] = { { 1, 0x00 }, /* dma, unknown ino at this point */ { 2, 0x27 }, /* floppy */ { 3, 0x22 }, /* parallel */ { 4, 0x2b }, /* serial */ { 5, 0x25 }, /* acpi power management */
{ 0, 0x00 } /* end of table */ };
static void __init isa_dev_get_irq(struct isa_device *isa_dev) { int irq_prop;
irq_prop = prom_getintdefault(isa_dev->prom_node, "interrupts", -1); if (irq_prop <= 0) { isa_dev->irq = PCI_IRQ_NONE; } else { int i;
for (i = 0; grover_irq_table[i].obp_irq != 0; i++) { if (grover_irq_table[i].obp_irq == irq_prop) { struct pci_controller_info *pcic; struct pci_pbm_info *pbm; int ino = grover_irq_table[i].pci_ino;
if (ino == 0) { isa_dev->irq = PCI_IRQ_NONE; } else { pbm = isa_dev->bus->parent; pcic = pbm->parent; isa_dev->irq = pcic->irq_build(pbm, NULL, ino); } } } } }
static void __init isa_fill_children(struct isa_device *parent_isa_dev) { int node = prom_getchild(parent_isa_dev->prom_node);
if (node == 0) return;
printk(" ->"); while (node != 0) { struct isa_device *isa_dev; int prop_len;
isa_dev = kmalloc(sizeof(*isa_dev), GFP_KERNEL); if (!isa_dev) { fatal_err("cannot allocate child isa_dev"); prom_halt(); }
memset(isa_dev, 0, sizeof(*isa_dev));
/* Link it in to parent. */ isa_dev->next = parent_isa_dev->child; parent_isa_dev->child = isa_dev;
isa_dev->bus = parent_isa_dev->bus; isa_dev->prom_node = node; prop_len = prom_getproperty(node, "name", (char *) isa_dev->prom_name, sizeof(isa_dev->prom_name)); if (prop_len <= 0) { fatal_err("cannot get child isa_dev OBP node name"); prom_halt(); }
prop_len = prom_getproperty(node, "compatible", (char *) isa_dev->compatible, sizeof(isa_dev->compatible));
/* Not having this is OK. */ if (prop_len <= 0) isa_dev->compatible[0] = '\0';
isa_dev_get_resource(isa_dev); isa_dev_get_irq(isa_dev);
report_dev(isa_dev, 1);
node = prom_getsibling(node); } }
static void __init isa_fill_devices(struct isa_bridge *isa_br) { int node = prom_getchild(isa_br->prom_node);
while (node != 0) { struct isa_device *isa_dev; int prop_len;
isa_dev = kmalloc(sizeof(*isa_dev), GFP_KERNEL); if (!isa_dev) { fatal_err("cannot allocate isa_dev"); prom_halt(); }
memset(isa_dev, 0, sizeof(*isa_dev));
/* Link it in. */ isa_dev->next = NULL; if (isa_br->devices == NULL) { isa_br->devices = isa_dev; } else { struct isa_device *tmp = isa_br->devices;
while (tmp->next) tmp = tmp->next;
tmp->next = isa_dev; }
isa_dev->bus = isa_br; isa_dev->prom_node = node; prop_len = prom_getproperty(node, "name", (char *) isa_dev->prom_name, sizeof(isa_dev->prom_name)); if (prop_len <= 0) { fatal_err("cannot get isa_dev OBP node name"); prom_halt(); }
prop_len = prom_getproperty(node, "compatible", (char *) isa_dev->compatible, sizeof(isa_dev->compatible));
/* Not having this is OK. */ if (prop_len <= 0) isa_dev->compatible[0] = '\0';
isa_dev_get_resource(isa_dev); isa_dev_get_irq(isa_dev);
report_dev(isa_dev, 0);
isa_fill_children(isa_dev);
printk("]");
node = prom_getsibling(node); } }
void __init isa_init(void) { struct pci_dev *pdev; unsigned short vendor, device; int index = 0;
vendor = PCI_VENDOR_ID_AL; device = PCI_DEVICE_ID_AL_M1533;
pdev = NULL; while ((pdev = pci_find_device(vendor, device, pdev)) != NULL) { struct pcidev_cookie *pdev_cookie; struct pci_pbm_info *pbm; struct isa_bridge *isa_br; int prop_len;
pdev_cookie = pdev->sysdata; if (!pdev_cookie) { printk("ISA: Warning, ISA bridge ignored due to " "lack of OBP data.\n"); continue; } pbm = pdev_cookie->pbm;
isa_br = kmalloc(sizeof(*isa_br), GFP_KERNEL); if (!isa_br) { fatal_err("cannot allocate isa_bridge"); prom_halt(); }
memset(isa_br, 0, sizeof(*isa_br));
/* Link it in. */ isa_br->next = isa_chain; isa_chain = isa_br;
isa_br->parent = pbm; isa_br->self = pdev; isa_br->index = index++; isa_br->prom_node = pdev_cookie->prom_node; strncpy(isa_br->prom_name, pdev_cookie->prom_name, sizeof(isa_br->prom_name));
prop_len = prom_getproperty(isa_br->prom_node, "ranges", (char *) isa_br->isa_ranges, sizeof(isa_br->isa_ranges)); if (prop_len <= 0) isa_br->num_isa_ranges = 0; else isa_br->num_isa_ranges = (prop_len / sizeof(struct linux_prom_isa_ranges));
printk("isa%d:", isa_br->index);
isa_fill_devices(isa_br);
printk("\n"); } }
|