Now obsolete. :)
This commit is contained in:
Michael Brown
parent
0effbefe6f
commit
daad093c40
|
|
@ -1,195 +0,0 @@
|
|||
#ifdef CONFIG_PCI
|
||||
|
||||
/*
|
||||
* 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, or (at
|
||||
* your option) any later version.
|
||||
*/
|
||||
|
||||
#include "etherboot.h"
|
||||
#include "pci.h"
|
||||
|
||||
/*#define DEBUG 1*/
|
||||
|
||||
static void scan_drivers(
|
||||
int type,
|
||||
uint32_t class, uint16_t vendor, uint16_t device,
|
||||
const struct pci_driver *last_driver, struct pci_device *dev)
|
||||
{
|
||||
const struct pci_driver *skip_driver = last_driver;
|
||||
/* Assume there is only one match of the correct type */
|
||||
const struct pci_driver *driver;
|
||||
|
||||
for(driver = pci_drivers; driver < pci_drivers_end; driver++) {
|
||||
int i;
|
||||
if (driver->type != type)
|
||||
continue;
|
||||
if (skip_driver) {
|
||||
if (skip_driver == driver)
|
||||
skip_driver = 0;
|
||||
continue;
|
||||
}
|
||||
for(i = 0; i < driver->id_count; i++) {
|
||||
if ((vendor == driver->ids[i].vendor) &&
|
||||
(device == driver->ids[i].dev_id)) {
|
||||
|
||||
dev->driver = driver;
|
||||
dev->name = driver->ids[i].name;
|
||||
|
||||
goto out;
|
||||
}
|
||||
}
|
||||
}
|
||||
if (!class) {
|
||||
goto out;
|
||||
}
|
||||
for(driver = pci_drivers; driver < pci_drivers_end; driver++) {
|
||||
if (driver->type != type)
|
||||
continue;
|
||||
if (skip_driver) {
|
||||
if (skip_driver == driver)
|
||||
skip_driver = 0;
|
||||
continue;
|
||||
}
|
||||
if (last_driver == driver)
|
||||
continue;
|
||||
if ((class >> 8) == driver->class) {
|
||||
dev->driver = driver;
|
||||
dev->name = driver->name;
|
||||
goto out;
|
||||
}
|
||||
}
|
||||
out:
|
||||
return;
|
||||
}
|
||||
|
||||
void scan_pci_bus(int type, struct pci_device *dev)
|
||||
{
|
||||
unsigned int first_bus, first_devfn;
|
||||
const struct pci_driver *first_driver;
|
||||
unsigned int devfn, bus, buses;
|
||||
unsigned char hdr_type = 0;
|
||||
uint32_t class;
|
||||
uint16_t vendor, device;
|
||||
uint32_t l, membase, ioaddr, romaddr;
|
||||
uint8_t irq;
|
||||
int reg;
|
||||
|
||||
first_bus = 0;
|
||||
first_devfn = 0;
|
||||
first_driver = 0;
|
||||
if (dev->driver || dev->use_specified) {
|
||||
first_driver = dev->driver;
|
||||
first_bus = dev->bus;
|
||||
first_devfn = dev->devfn;
|
||||
/* Re read the header type on a restart */
|
||||
pcibios_read_config_byte(first_bus, first_devfn & ~0x7,
|
||||
PCI_HEADER_TYPE, &hdr_type);
|
||||
dev->driver = 0;
|
||||
dev->bus = 0;
|
||||
dev->devfn = 0;
|
||||
}
|
||||
|
||||
/* Scan all PCI buses, until we find our card.
|
||||
* We could be smart only scan the required buses but that
|
||||
* is error prone, and tricky.
|
||||
* By scanning all possible pci buses in order we should find
|
||||
* our card eventually.
|
||||
*/
|
||||
buses=256;
|
||||
for (bus = first_bus; bus < buses; ++bus) {
|
||||
for (devfn = first_devfn; devfn < 0xff; ++devfn, first_driver = 0) {
|
||||
if (PCI_FUNC (devfn) == 0)
|
||||
pcibios_read_config_byte(bus, devfn, PCI_HEADER_TYPE, &hdr_type);
|
||||
else if (!(hdr_type & 0x80)) /* not a multi-function device */
|
||||
continue;
|
||||
pcibios_read_config_dword(bus, devfn, PCI_VENDOR_ID, &l);
|
||||
/* some broken boards return 0 if a slot is empty: */
|
||||
if (l == 0xffffffff || l == 0x00000000) {
|
||||
continue;
|
||||
}
|
||||
vendor = l & 0xffff;
|
||||
device = (l >> 16) & 0xffff;
|
||||
|
||||
pcibios_read_config_dword(bus, devfn, PCI_REVISION, &l);
|
||||
class = (l >> 8) & 0xffffff;
|
||||
#if DEBUG
|
||||
{
|
||||
int i;
|
||||
printf("%hhx:%hhx.%hhx [%hX/%hX] Class %hX\n",
|
||||
bus, PCI_SLOT(devfn), PCI_FUNC(devfn),
|
||||
vendor, device, class >> 8);
|
||||
#if DEBUG > 1
|
||||
for(i = 0; i < 256; i++) {
|
||||
unsigned char byte;
|
||||
if ((i & 0xf) == 0) {
|
||||
printf("%hhx: ", i);
|
||||
}
|
||||
pcibios_read_config_byte(bus, devfn, i, &byte);
|
||||
printf("%hhx ", byte);
|
||||
if ((i & 0xf) == 0xf) {
|
||||
printf("\n");
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
}
|
||||
#endif
|
||||
scan_drivers(type, class, vendor, device, first_driver, dev);
|
||||
if (!dev->driver)
|
||||
continue;
|
||||
|
||||
dev->devfn = devfn;
|
||||
dev->bus = bus;
|
||||
dev->class = class;
|
||||
dev->vendor = vendor;
|
||||
dev->dev_id = device;
|
||||
|
||||
|
||||
/* Get the ROM base address */
|
||||
pcibios_read_config_dword(bus, devfn,
|
||||
PCI_ROM_ADDRESS, &romaddr);
|
||||
romaddr >>= 10;
|
||||
dev->romaddr = romaddr;
|
||||
|
||||
/* Get the ``membase'' */
|
||||
pcibios_read_config_dword(bus, devfn,
|
||||
PCI_BASE_ADDRESS_1, &membase);
|
||||
dev->membase = membase;
|
||||
|
||||
/* Get the ``ioaddr'' */
|
||||
for (reg = PCI_BASE_ADDRESS_0; reg <= PCI_BASE_ADDRESS_5; reg += 4) {
|
||||
pcibios_read_config_dword(bus, devfn, reg, &ioaddr);
|
||||
if ((ioaddr & PCI_BASE_ADDRESS_IO_MASK) == 0 || (ioaddr & PCI_BASE_ADDRESS_SPACE_IO) == 0)
|
||||
continue;
|
||||
|
||||
|
||||
/* Strip the I/O address out of the returned value */
|
||||
ioaddr &= PCI_BASE_ADDRESS_IO_MASK;
|
||||
|
||||
/* Take the first one or the one that matches in boot ROM address */
|
||||
dev->ioaddr = ioaddr;
|
||||
}
|
||||
|
||||
/* Get the irq */
|
||||
pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq);
|
||||
if (irq) {
|
||||
pci_read_config_byte(dev, PCI_INTERRUPT_LINE,
|
||||
&irq);
|
||||
}
|
||||
dev->irq = irq;
|
||||
|
||||
#if DEBUG > 2
|
||||
printf("Found %s ROM address %#hx\n",
|
||||
dev->name, romaddr);
|
||||
#endif
|
||||
return;
|
||||
}
|
||||
first_devfn = 0;
|
||||
}
|
||||
first_bus = 0;
|
||||
}
|
||||
|
||||
|
||||
#endif /* CONFIG_PCI */
|
||||
Reference in New Issue