diff --git a/platform-intel.c b/platform-intel.c index 3516a1b..a4f0f49 100644 --- a/platform-intel.c +++ b/platform-intel.c @@ -166,12 +166,30 @@ static int platform_has_intel_devices(void) return 0; } +/* + * PCI Expansion ROM Data Structure Format + */ +struct pciExpDataStructFormat { + __u8 ver[4]; + __u16 vendorID; + __u16 deviceID; +} __attribute__ ((packed)); + static struct imsm_orom imsm_orom; -static int scan(const void *start, const void *end) +static int scan(const void *start, const void *end, const void *data) { int offset; const struct imsm_orom *imsm_mem; int len = (end - start); + struct pciExpDataStructFormat *ptr= (struct pciExpDataStructFormat *)data; + + dprintf("ptr->vendorID: %lx __le16_to_cpu(ptr->deviceID): %lx \n", + (ulong) __le16_to_cpu(ptr->vendorID), + (ulong) __le16_to_cpu(ptr->deviceID)); + + if (!((__le16_to_cpu(ptr->vendorID) == 0x8086) && + (__le16_to_cpu(ptr->deviceID) == 0x2822))) + return 0; for (offset = 0; offset < len; offset += 4) { imsm_mem = start + offset; @@ -180,7 +198,6 @@ static int scan(const void *start, const void *end) return 1; } } - return 0; } diff --git a/probe_roms.c b/probe_roms.c index a8e3a58..6a0b98d 100644 --- a/probe_roms.c +++ b/probe_roms.c @@ -20,6 +20,7 @@ */ #include "probe_roms.h" +#include "mdadm.h" #include #include #include @@ -130,50 +131,60 @@ static void *isa_bus_to_virt(unsigned long addr) struct resource { unsigned long start; unsigned long end; + unsigned long data; const char *name; }; static struct resource system_rom_resource = { .name = "System ROM", .start = 0xf0000, + .data = 0, .end = 0xfffff, }; static struct resource extension_rom_resource = { .name = "Extension ROM", .start = 0xe0000, + .data = 0, .end = 0xeffff, }; static struct resource adapter_rom_resources[] = { { .name = "Adapter ROM", .start = 0xc8000, + .data = 0, .end = 0, }, { .name = "Adapter ROM", .start = 0, + .data = 0, .end = 0, }, { .name = "Adapter ROM", .start = 0, + .data = 0, .end = 0, }, { .name = "Adapter ROM", .start = 0, + .data = 0, .end = 0, }, { .name = "Adapter ROM", .start = 0, + .data = 0, .end = 0, }, { .name = "Adapter ROM", .start = 0, + .data = 0, .end = 0, } }; static struct resource video_rom_resource = { .name = "Video ROM", .start = 0xc0000, + .data = 0, .end = 0xc7fff, }; @@ -211,7 +222,8 @@ int scan_adapter_roms(scan_fn fn) if (res->start) { found = fn(isa_bus_to_virt(res->start), - isa_bus_to_virt(res->end)); + isa_bus_to_virt(res->end), + isa_bus_to_virt(res->data)); if (found) break; } else @@ -232,6 +244,7 @@ void probe_roms(void) unsigned long start, length, upper; unsigned char c; unsigned int i; + __u16 val=0; if (rom_fd < 0) return; @@ -284,14 +297,23 @@ void probe_roms(void) /* 0 < length <= 0x7f * 512, historically */ length = c * 512; + /* Retrieve 16-bit pointer to PCI Data Structure (offset 18h-19h) + * The data can be within 64KB forward of the first location + * of this code image. The pointer is in little-endian order + */ + + if (probe_address16(rom + 0x18, &val) != 0) + continue; + val = __le16_to_cpu(val); + /* but accept any length that fits if checksum okay */ if (!length || start + length > upper || !romchecksum(rom, length)) continue; adapter_rom_resources[i].start = start; + adapter_rom_resources[i].data = start + (unsigned long) val; adapter_rom_resources[i].end = start + length - 1; start = adapter_rom_resources[i++].end & ~(rom_align - 1); } } - diff --git a/probe_roms.h b/probe_roms.h index a1e291a..6d70411 100644 --- a/probe_roms.h +++ b/probe_roms.h @@ -19,6 +19,6 @@ void probe_roms_exit(void); int probe_roms_init(unsigned long align); -typedef int (*scan_fn)(const void *start, const void *end); +typedef int (*scan_fn)(const void *start, const void *end, const void *data); int scan_adapter_roms(scan_fn fn); void probe_roms(void);