/* * Code to deal with the PReP residual data. * * Written by: Cort Dougan (cort@cs.nmt.edu) * Improved _greatly_ and rewritten by Gabriel Paubert (paubert@iram.es) * * This file is based on the following documentation: * * IBM Power Personal Systems Architecture * Residual Data * Document Number: PPS-AR-FW0001 * * This file is subject to the terms and conditions of the GNU General Public * License. See the file COPYING in the main directory of this archive * for more details. * */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include unsigned char __res[sizeof(RESIDUAL)] = {0,}; RESIDUAL *res = (RESIDUAL *)&__res; char * PnP_BASE_TYPES[] __initdata = { "Reserved", "MassStorageDevice", "NetworkInterfaceController", "DisplayController", "MultimediaController", "MemoryController", "BridgeController", "CommunicationsDevice", "SystemPeripheral", "InputDevice", "ServiceProcessor" }; /* Device Sub Type Codes */ unsigned char * PnP_SUB_TYPES[] __initdata = { "\001\000SCSIController", "\001\001IDEController", "\001\002FloppyController", "\001\003IPIController", "\001\200OtherMassStorageController", "\002\000EthernetController", "\002\001TokenRingController", "\002\002FDDIController", "\002\0x80OtherNetworkController", "\003\000VGAController", "\003\001SVGAController", "\003\002XGAController", "\003\200OtherDisplayController", "\004\000VideoController", "\004\001AudioController", "\004\200OtherMultimediaController", "\005\000RAM", "\005\001FLASH", "\005\200OtherMemoryDevice", "\006\000HostProcessorBridge", "\006\001ISABridge", "\006\002EISABridge", "\006\003MicroChannelBridge", "\006\004PCIBridge", "\006\005PCMCIABridge", "\006\006VMEBridge", "\006\200OtherBridgeDevice", "\007\000RS232Device", "\007\001ATCompatibleParallelPort", "\007\200OtherCommunicationsDevice", "\010\000ProgrammableInterruptController", "\010\001DMAController", "\010\002SystemTimer", "\010\003RealTimeClock", "\010\004L2Cache", "\010\005NVRAM", "\010\006PowerManagement", "\010\007CMOS", "\010\010OperatorPanel", "\010\011ServiceProcessorClass1", "\010\012ServiceProcessorClass2", "\010\013ServiceProcessorClass3", "\010\014GraphicAssist", "\010\017SystemPlanar", "\010\200OtherSystemPeripheral", "\011\000KeyboardController", "\011\001Digitizer", "\011\002MouseController", "\011\003TabletController", "\011\0x80OtherInputController", "\012\000GeneralMemoryController", NULL }; /* Device Interface Type Codes */ unsigned char * PnP_INTERFACES[] __initdata = { "\000\000\000General", "\001\000\000GeneralSCSI", "\001\001\000GeneralIDE", "\001\001\001ATACompatible", "\001\002\000GeneralFloppy", "\001\002\001Compatible765", "\001\002\002NS398_Floppy", /* NS Super I/O wired to use index register at port 398 and data register at port 399 */ "\001\002\003NS26E_Floppy", /* Ports 26E and 26F */ "\001\002\004NS15C_Floppy", /* Ports 15C and 15D */ "\001\002\005NS2E_Floppy", /* Ports 2E and 2F */ "\001\002\006CHRP_Floppy", /* CHRP Floppy in PR*P system */ "\001\003\000GeneralIPI", "\002\000\000GeneralEther", "\002\001\000GeneralToken", "\002\002\000GeneralFDDI", "\003\000\000GeneralVGA", "\003\001\000GeneralSVGA", "\003\002\000GeneralXGA", "\004\000\000GeneralVideo", "\004\001\000GeneralAudio", "\004\001\001CS4232Audio", /* CS 4232 Plug 'n Play Configured */ "\005\000\000GeneralRAM", /* This one is obviously wrong ! */ "\005\000\000PCIMemoryController", /* PCI Config Method */ "\005\000\001RS6KMemoryController", /* RS6K Config Method */ "\005\001\000GeneralFLASH", "\006\000\000GeneralHostBridge", "\006\001\000GeneralISABridge", "\006\002\000GeneralEISABridge", "\006\003\000GeneralMCABridge", /* GeneralPCIBridge = 0, */ "\006\004\000PCIBridgeDirect", "\006\004\001PCIBridgeIndirect", "\006\004\002PCIBridgeRS6K", "\006\005\000GeneralPCMCIABridge", "\006\006\000GeneralVMEBridge", "\007\000\000GeneralRS232", "\007\000\001COMx", "\007\000\002Compatible16450", "\007\000\003Compatible16550", "\007\000\004NS398SerPort", /* NS Super I/O wired to use index register at port 398 and data register at port 399 */ "\007\000\005NS26ESerPort", /* Ports 26E and 26F */ "\007\000\006NS15CSerPort", /* Ports 15C and 15D */ "\007\000\007NS2ESerPort", /* Ports 2E and 2F */ "\007\001\000GeneralParPort", "\007\001\001LPTx", "\007\001\002NS398ParPort", /* NS Super I/O wired to use index register at port 398 and data register at port 399 */ "\007\001\003NS26EParPort", /* Ports 26E and 26F */ "\007\001\004NS15CParPort", /* Ports 15C and 15D */ "\007\001\005NS2EParPort", /* Ports 2E and 2F */ "\010\000\000GeneralPIC", "\010\000\001ISA_PIC", "\010\000\002EISA_PIC", "\010\000\003MPIC", "\010\000\004RS6K_PIC", "\010\001\000GeneralDMA", "\010\001\001ISA_DMA", "\010\001\002EISA_DMA", "\010\002\000GeneralTimer", "\010\002\001ISA_Timer", "\010\002\002EISA_Timer", "\010\003\000GeneralRTC", "\010\003\001ISA_RTC", "\010\004\001StoreThruOnly", "\010\004\002StoreInEnabled", "\010\004\003RS6KL2Cache", "\010\005\000IndirectNVRAM", /* Indirectly addressed */ "\010\005\001DirectNVRAM", /* Memory Mapped */ "\010\005\002IndirectNVRAM24", /* Indirectly addressed - 24 bit */ "\010\006\000GeneralPowerManagement", "\010\006\001EPOWPowerManagement", "\010\006\002PowerControl", // d1378 "\010\007\000GeneralCMOS", "\010\010\000GeneralOPPanel", "\010\010\001HarddiskLight", "\010\010\002CDROMLight", "\010\010\003PowerLight", "\010\010\004KeyLock", "\010\010\005ANDisplay", /* AlphaNumeric Display */ "\010\010\006SystemStatusLED", /* 3 digit 7 segment LED */ "\010\010\007CHRP_SystemStatusLED", /* CHRP LEDs in PR*P system */ "\010\011\000GeneralServiceProcessor", "\010\012\000GeneralServiceProcessor", "\010\013\000GeneralServiceProcessor", "\010\014\001TransferData", "\010\014\002IGMC32", "\010\014\003IGMC64", "\010\017\000GeneralSystemPlanar", /* 10/5/95 */ NULL }; static const unsigned char __init *PnP_SUB_TYPE_STR(unsigned char BaseType, unsigned char SubType) { unsigned char ** s=PnP_SUB_TYPES; while (*s && !((*s)[0]==BaseType && (*s)[1]==SubType)) s++; if (*s) return *s+2; else return("Unknown !"); }; static const unsigned char __init *PnP_INTERFACE_STR(unsigned char BaseType, unsigned char SubType, unsigned char Interface) { unsigned char ** s=PnP_INTERFACES; while (*s && !((*s)[0]==BaseType && (*s)[1]==SubType && (*s)[2]==Interface)) s++; if (*s) return *s+3; else return NULL; }; static void __init printsmallvendor(PnP_TAG_PACKET *pkt, int size) { int i, c; char decomp[4]; #define p pkt->S14_Pack.S14_Data.S14_PPCPack switch(p.Type) { case 1: /* Decompress first 3 chars */ c = *(unsigned short *)p.PPCData; decomp[0]='A'-1+((c>>10)&0x1F); decomp[1]='A'-1+((c>>5)&0x1F); decomp[2]='A'-1+(c&0x1F); decomp[3]=0; printk(" Chip identification: %s%4.4X\n", decomp, ld_le16((unsigned short *)(p.PPCData+2))); break; default: printk(" Small vendor item type 0x%2.2x, data (hex): ", p.Type); for(i=0; iS1_Pack.Tag)) { case PnPVersion: printk(" PnPversion 0x%x.%x\n", pkt->S1_Pack.Version[0], /* How to interpret version ? */ pkt->S1_Pack.Version[1]); break; // case Logicaldevice: break; // case CompatibleDevice: break; case IRQFormat: #define p pkt->S4_Pack printk(" IRQ Mask 0x%4.4x, %s %s sensitive\n", ld_le16((unsigned short *)p.IRQMask), intlevel[(size>3) ? !(p.IRQInfo&0x05) : 0], intsense[(size>3) ? !(p.IRQInfo&0x03) : 0]); #undef p break; case DMAFormat: #define p pkt->S5_Pack printk(" DMA channel mask 0x%2.2x, info 0x%2.2x\n", p.DMAMask, p.DMAInfo); #undef p break; case StartDepFunc: printk("Start dependent function:\n"); break; case EndDepFunc: printk("End dependent function\n"); break; case IOPort: #define p pkt->S8_Pack printk(" Variable (%d decoded bits) I/O port\n" " from 0x%4.4x to 0x%4.4x, alignment %d, %d ports\n", p.IOInfo&ISAAddr16bit?16:10, ld_le16((unsigned short *)p.RangeMin), ld_le16((unsigned short *)p.RangeMax), p.IOAlign, p.IONum); #undef p break; case FixedIOPort: #define p pkt->S9_Pack printk(" Fixed (10 decoded bits) I/O port from %3.3x to %3.3x\n", (p.Range[1]<<8)|p.Range[0], ((p.Range[1]<<8)|p.Range[0])+p.IONum-1); #undef p break; case Res1: case Res2: case Res3: printk(" Undefined packet type %d!\n", tag_small_item_name(pkt->S1_Pack.Tag)); break; case SmallVendorItem: printsmallvendor(pkt,size); break; default: printk(" Type 0x2.2x%d, size=%d\n", pkt->S1_Pack.Tag, size); break; } } static void __init printlargevendor(PnP_TAG_PACKET * pkt, int size) { static const unsigned char * addrtype[] = {"I/O", "Memory", "System"}; static const unsigned char * inttype[] = {"8259", "MPIC", "RS6k BUID %d"}; static const unsigned char * convtype[] = {"Bus Memory", "Bus I/O", "DMA"}; static const unsigned char * transtype[] = {"direct", "mapped", "direct-store segment"}; static const unsigned char * L2type[] = {"WriteThru", "CopyBack"}; static const unsigned char * L2assoc[] = {"DirectMapped", "2-way set"}; int i; char tmpstr[30], *t; #define p pkt->L4_Pack.L4_Data.L4_PPCPack switch(p.Type) { case 2: printk(" %d K %s %s L2 cache, %d/%d bytes line/sector size\n", ld_le32((unsigned int *)p.PPCData), L2type[p.PPCData[10]-1], L2assoc[p.PPCData[4]-1], ld_le16((unsigned short *)p.PPCData+3), ld_le16((unsigned short *)p.PPCData+4)); break; case 3: printk(" PCI Bridge parameters\n" " ConfigBaseAddress %0x\n" " ConfigBaseData %0x\n" " Bus number %d\n", ld_le32((unsigned int *)p.PPCData), ld_le32((unsigned int *)(p.PPCData+8)), p.PPCData[16]); for(i=20; iS1_Pack.Tag)) { case LargeVendorItem: printlargevendor(pkt, size); break; default: printk(" Type 0x2.2x%d, size=%d\n", pkt->S1_Pack.Tag, size); break; } } static void __init printpackets(PnP_TAG_PACKET * pkt, const char * cat) { if (pkt->S1_Pack.Tag== END_TAG) { printk(" No packets describing %s resources.\n", cat); return; } printk( " Packets describing %s resources:\n",cat); do { int size; if (tag_type(pkt->S1_Pack.Tag)) { size= 3 + pkt->L1_Pack.Count0 + pkt->L1_Pack.Count1*256; printlargepacket(pkt, size); } else { size=tag_small_count(pkt->S1_Pack.Tag)+1; printsmallpacket(pkt, size); } pkt = (PnP_TAG_PACKET *)((unsigned char *) pkt + size); } while (pkt->S1_Pack.Tag != END_TAG); } void __init print_residual_device_info(void) { int i; PPC_DEVICE *dev; #define did dev->DeviceId /* make sure we have residual data first */ if (!have_residual_data) return; printk("Residual: %ld devices\n", res->ActualNumDevices); for ( i = 0; i < res->ActualNumDevices ; i++) { char decomp[4], sn[20]; const char * s; dev = &res->Devices[i]; s = PnP_INTERFACE_STR(did.BaseType, did.SubType, did.Interface); if(!s) { sprintf(sn, "interface %d", did.Interface); s=sn; } if ( did.BusId & PCIDEVICE ) printk("PCI Device, Bus %d, DevFunc 0x%x:", dev->BusAccess.PCIAccess.BusNumber, dev->BusAccess.PCIAccess.DevFuncNumber); if ( did.BusId & PNPISADEVICE ) printk("PNPISA Device:"); if ( did.BusId & ISADEVICE ) printk("ISA Device, Slot %d, LogicalDev %d:", dev->BusAccess.ISAAccess.SlotNumber, dev->BusAccess.ISAAccess.LogicalDevNumber); if ( did.BusId & EISADEVICE ) printk("EISA Device:"); if ( did.BusId & PROCESSORDEVICE ) printk("ProcBus Device, Bus %d, BUID %d: ", dev->BusAccess.ProcBusAccess.BusNumber, dev->BusAccess.ProcBusAccess.BUID); if ( did.BusId & PCMCIADEVICE ) printk("PCMCIA "); if ( did.BusId & VMEDEVICE ) printk("VME "); if ( did.BusId & MCADEVICE ) printk("MCA "); if ( did.BusId & MXDEVICE ) printk("MX "); /* Decompress first 3 chars */ decomp[0]='A'-1+((did.DevId>>26)&0x1F); decomp[1]='A'-1+((did.DevId>>21)&0x1F); decomp[2]='A'-1+((did.DevId>>16)&0x1F); decomp[3]=0; printk(" %s%4.4lX, %s, %s, %s\n", decomp, did.DevId&0xffff, PnP_BASE_TYPES[did.BaseType], PnP_SUB_TYPE_STR(did.BaseType,did.SubType), s); if ( dev->AllocatedOffset ) printpackets( (union _PnP_TAG_PACKET *) &res->DevicePnPHeap[dev->AllocatedOffset], "allocated"); if ( dev->PossibleOffset ) printpackets( (union _PnP_TAG_PACKET *) &res->DevicePnPHeap[dev->PossibleOffset], "possible"); if ( dev->CompatibleOffset ) printpackets( (union _PnP_TAG_PACKET *) &res->DevicePnPHeap[dev->CompatibleOffset], "compatible"); } } #if 0 static void __init printVPD(void) { #define vpd res->VitalProductData int ps=vpd.PageSize, i, j; static const char* Usage[]={ "FirmwareStack", "FirmwareHeap", "FirmwareCode", "BootImage", "Free", "Unpopulated", "ISAAddr", "PCIConfig", "IOMemory", "SystemIO", "SystemRegs", "PCIAddr", "UnPopSystemRom", "SystemROM", "ResumeBlock", "Other" }; static const unsigned char *FWMan[]={ "IBM", "Motorola", "FirmWorks", "Bull" }; static const unsigned char *FWFlags[]={ "Conventional", "OpenFirmware", "Diagnostics", "LowDebug", "MultiBoot", "LowClient", "Hex41", "FAT", "ISO9660", "SCSI_ID_Override", "Tape_Boot", "FW_Boot_Path" }; static const unsigned char *ESM[]={ "Port92", "PCIConfigA8", "FF001030", "????????" }; static const unsigned char *SIOM[]={ "Port850", "????????", "PCIConfigA8", "????????" }; printk("Model: %s\n",vpd.PrintableModel); printk("Serial: %s\n", vpd.Serial); printk("FirmwareSupplier: %s\n", FWMan[vpd.FirmwareSupplier]); printk("FirmwareFlags:"); for(j=0; j<12; j++) { if (vpd.FirmwareSupports & (1<2 ? 2 : vpd.EndianSwitchMethod]); printk("SpreadIOMethod: %s\n", SIOM[vpd.SpreadIOMethod>3 ? 3 : vpd.SpreadIOMethod]); printk("Processor/Bus frequencies (Hz): %ld/%ld\n", vpd.ProcessorHz, vpd.ProcessorBusHz); printk("Time Base Divisor: %ld\n", vpd.TimeBaseDivisor); printk("WordWidth, PageSize: %ld, %d\n", vpd.WordWidth, ps); printk("Cache sector size, Lock granularity: %ld, %ld\n", vpd.CoherenceBlockSize, vpd.GranuleSize); for (i=0; iActualNumMemSegs; i++) { int mask=res->Segs[i].Usage, first, j; printk("%8.8lx-%8.8lx ", res->Segs[i].BasePage*ps, (res->Segs[i].PageCount+res->Segs[i].BasePage)*ps-1); for(j=15, first=1; j>=0; j--) { if (mask&(1<DeviceId /* make sure we have residual data first */ if (!have_residual_data) return; printk("Residual: %ld devices\n", res->ActualNumDevices); for ( i = 0; i < res->ActualNumDevices ; i++) { dev = &res->Devices[i]; /* * pci devices */ if ( did.BusId & PCIDEVICE ) { printk("PCI Device:"); /* unknown vendor */ if ( !strncmp( "Unknown", pci_strvendor(did.DevId>>16), 7) ) printk(" id %08lx types %d/%d", did.DevId, did.BaseType, did.SubType); /* known vendor */ else printk(" %s %s", pci_strvendor(did.DevId>>16), pci_strdev(did.DevId>>16, did.DevId&0xffff) ); if ( did.BusId & PNPISADEVICE ) { printk(" pnp:"); /* get pnp info on the device */ pkt = (union _PnP_TAG_PACKET *) &res->DevicePnPHeap[dev->AllocatedOffset]; for (; pkt->S1_Pack.Tag != DF_END_TAG; pkt++ ) { if ( (pkt->S1_Pack.Tag == S4_Packet) || (pkt->S1_Pack.Tag == S4_Packet_flags) ) printk(" irq %02x%02x", pkt->S4_Pack.IRQMask[0], pkt->S4_Pack.IRQMask[1]); } } printk("\n"); continue; } /* * isa devices */ if ( did.BusId & ISADEVICE ) { printk("ISA Device: basetype: %d subtype: %d", did.BaseType, did.SubType); printk("\n"); continue; } /* * eisa devices */ if ( did.BusId & EISADEVICE ) { printk("EISA Device: basetype: %d subtype: %d", did.BaseType, did.SubType); printk("\n"); continue; } /* * proc bus devices */ if ( did.BusId & PROCESSORDEVICE ) { printk("ProcBus Device: basetype: %d subtype: %d", did.BaseType, did.SubType); printk("\n"); continue; } /* * pcmcia devices */ if ( did.BusId & PCMCIADEVICE ) { printk("PCMCIA Device: basetype: %d subtype: %d", did.BaseType, did.SubType); printk("\n"); continue; } printk("Unknown bus access device: busid %lx\n", did.BusId); } } #endif /* Returns the device index in the residual data, any of the search items may be set as -1 for wildcard, DevID number field (second halfword) is big endian ! Examples: - search for the Interrupt controller (8259 type), 2 methods: 1) i8259 = residual_find_device(~0, NULL, SystemPeripheral, ProgrammableInterruptController, ISA_PIC, 0); 2) i8259 = residual_find_device(~0, "PNP0000", -1, -1, -1, 0) - search for the first two serial devices, whatever their type) iserial1 = residual_find_device(~0,NULL, CommunicationsDevice, RS232Device, -1, 0) iserial2 = residual_find_device(~0,NULL, CommunicationsDevice, RS232Device, -1, 1) - but search for typical COM1 and COM2 is not easy due to the fact that the interface may be anything and the name "PNP0500" or "PNP0501". Quite bad. */ /* devid are easier to uncompress than to compress, so to minimize bloat in this rarely used area we unencode and compare */ /* in residual data number is big endian in the device table and little endian in the heap, so we use two parameters to avoid writing two very similar functions */ static int __init same_DevID(unsigned short vendor, unsigned short Number, char * str) { static unsigned const char hexdigit[]="0123456789ABCDEF"; if (strlen(str)!=7) return 0; if ( ( ((vendor>>10)&0x1f)+'A'-1 == str[0]) && ( ((vendor>>5)&0x1f)+'A'-1 == str[1]) && ( (vendor&0x1f)+'A'-1 == str[2]) && (hexdigit[(Number>>12)&0x0f] == str[3]) && (hexdigit[(Number>>8)&0x0f] == str[4]) && (hexdigit[(Number>>4)&0x0f] == str[5]) && (hexdigit[Number&0x0f] == str[6]) ) return 1; return 0; } PPC_DEVICE __init *residual_find_device(unsigned long BusMask, unsigned char * DevID, int BaseType, int SubType, int Interface, int n) { int i; if (!have_residual_data) return NULL; for (i=0; iActualNumDevices; i++) { #define Dev res->Devices[i].DeviceId if ( (Dev.BusId&BusMask) && (BaseType==-1 || Dev.BaseType==BaseType) && (SubType==-1 || Dev.SubType==SubType) && (Interface==-1 || Dev.Interface==Interface) && (DevID==NULL || same_DevID((Dev.DevId>>16)&0xffff, Dev.DevId&0xffff, DevID)) && !(n--) ) return res->Devices+i; #undef Dev } return NULL; } PPC_DEVICE __init *residual_find_device_id(unsigned long BusMask, unsigned short DevID, int BaseType, int SubType, int Interface, int n) { int i; if (!have_residual_data) return NULL; for (i=0; iActualNumDevices; i++) { #define Dev res->Devices[i].DeviceId if ( (Dev.BusId&BusMask) && (BaseType==-1 || Dev.BaseType==BaseType) && (SubType==-1 || Dev.SubType==SubType) && (Interface==-1 || Dev.Interface==Interface) && (DevID==0xffff || (Dev.DevId&0xffff) == DevID) && !(n--) ) return res->Devices+i; #undef Dev } return NULL; } static int __init residual_scan_pcibridge(PnP_TAG_PACKET * pkt, struct pci_dev *dev) { int irq = -1; #define data pkt->L4_Pack.L4_Data.L4_PPCPack.PPCData if (dev->bus->number == data[16]) { int i, size; size = 3 + ld_le16((u_short *) (&pkt->L4_Pack.Count0)); for (i = 20; i < size - 4; i += 12) { unsigned char pin; int line_irq; if (dev->devfn != data[i + 1]) continue; pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &pin); if (pin) { line_irq = ld_le16((unsigned short *) (&data[i + 4 + 2 * (pin - 1)])); irq = (line_irq == 0xffff) ? 0 : line_irq & 0x7fff; } else irq = 0; break; } } #undef data return irq; } int __init residual_pcidev_irq(struct pci_dev *dev) { int i = 0; int irq = -1; PPC_DEVICE *bridge; while ((bridge = residual_find_device (-1, NULL, BridgeController, PCIBridge, -1, i++))) { PnP_TAG_PACKET *pkt; if (bridge->AllocatedOffset) { pkt = PnP_find_large_vendor_packet(res->DevicePnPHeap + bridge->AllocatedOffset, 3, 0); if (!pkt) continue; irq = residual_scan_pcibridge(pkt, dev); if (irq != -1) break; } } return (irq < 0) ? 0 : irq; } void __init residual_irq_mask(char *irq_edge_mask_lo, char *irq_edge_mask_hi) { PPC_DEVICE *dev; int i = 0; unsigned short irq_mask = 0x000; /* default to edge */ while ((dev = residual_find_device(-1, NULL, -1, -1, -1, i++))) { PnP_TAG_PACKET *pkt; unsigned short mask; int size; int offset = dev->AllocatedOffset; if (!offset) continue; pkt = PnP_find_packet(res->DevicePnPHeap + offset, IRQFormat, 0); if (!pkt) continue; size = tag_small_count(pkt->S1_Pack.Tag) + 1; mask = ld_le16((unsigned short *)pkt->S4_Pack.IRQMask); if (size > 3 && (pkt->S4_Pack.IRQInfo & 0x0c)) irq_mask |= mask; } *irq_edge_mask_lo = irq_mask & 0xff; *irq_edge_mask_hi = irq_mask >> 8; } unsigned int __init residual_isapic_addr(void) { PPC_DEVICE *isapic; PnP_TAG_PACKET *pkt; unsigned int addr; isapic = residual_find_device(~0, NULL, SystemPeripheral, ProgrammableInterruptController, ISA_PIC, 0); if (!isapic) goto unknown; pkt = PnP_find_large_vendor_packet(res->DevicePnPHeap + isapic->AllocatedOffset, 9, 0); if (!pkt) goto unknown; #define p pkt->L4_Pack.L4_Data.L4_PPCPack /* Must be 32-bit system address */ if (!((p.PPCData[0] == 3) && (p.PPCData[1] == 32))) goto unknown; /* It doesn't seem to work where length != 1 (what can I say? :-/ ) */ if (ld_le32((unsigned int *)(p.PPCData + 12)) != 1) goto unknown; addr = ld_le32((unsigned int *) (p.PPCData + 4)); #undef p return addr; unknown: return 0; } PnP_TAG_PACKET *PnP_find_packet(unsigned char *p, unsigned packet_tag, int n) { unsigned mask, masked_tag, size; if(!p) return NULL; if (tag_type(packet_tag)) mask=0xff; else mask=0xF8; masked_tag = packet_tag&mask; for(; *p != END_TAG; p+=size) { if ((*p & mask) == masked_tag && !(n--)) return (PnP_TAG_PACKET *) p; if (tag_type(*p)) size=ld_le16((unsigned short *)(p+1))+3; else size=tag_small_count(*p)+1; } return NULL; /* not found */ } PnP_TAG_PACKET __init *PnP_find_small_vendor_packet(unsigned char *p, unsigned packet_type, int n) { int next=0; while (p) { p = (unsigned char *) PnP_find_packet(p, 0x70, next); if (p && p[1]==packet_type && !(n--)) return (PnP_TAG_PACKET *) p; next = 1; }; return NULL; /* not found */ } PnP_TAG_PACKET __init *PnP_find_large_vendor_packet(unsigned char *p, unsigned packet_type, int n) { int next=0; while (p) { p = (unsigned char *) PnP_find_packet(p, 0x84, next); if (p && p[3]==packet_type && !(n--)) return (PnP_TAG_PACKET *) p; next = 1; }; return NULL; /* not found */ } #ifdef CONFIG_PROC_PREPRESIDUAL static int proc_prep_residual_read(char * buf, char ** start, off_t off, int count, int *eof, void *data) { int n; n = res->ResidualLength - off; if (n < 0) { *eof = 1; n = 0; } else { if (n > count) n = count; else *eof = 1; memcpy(buf, (char *)res + off, n); *start = buf; } return n; } int __init proc_prep_residual_init(void) { if (have_residual_data) create_proc_read_entry("residual", S_IRUGO, NULL, proc_prep_residual_read, NULL); return 0; } __initcall(proc_prep_residual_init); #endif