GNUBoot
/
coreboot-kgpe-d16
2
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
coreboot-kgpe-d16/util/mptable/mptable.c

1321 lines
31 KiB
C
Raw Blame History

/*
* Copyright (c) 1996, by Steve Passe
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. The name of the developer may NOT be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
/*
* mptable.c
*/
#define VMAJOR 2
#define VMINOR 0
#define VDELTA 15
/*
* this will cause the raw mp table to be dumped to /tmp/mpdump
*
#define RAW_DUMP
*/
#define MP_SIG 0x5f504d5f /* _MP_ */
#define EXTENDED_PROCESSING_READY
#define OEM_PROCESSING_READY_NOT
#include <sys/types.h>
#include <err.h>
#include <fcntl.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <stdint.h>
#define SEP_LINE \
"\n-------------------------------------------------------------------------------\n"
#define SEP_LINE2 \
"\n===============================================================================\n"
/* EBDA is @ 40:0e in real-mode terms */
#define EBDA_POINTER 0x040e /* location of EBDA pointer */
/* CMOS 'top of mem' is @ 40:13 in real-mode terms */
#define TOPOFMEM_POINTER 0x0413 /* BIOS: base memory size */
#define DEFAULT_TOPOFMEM 0xa0000
#define BIOS_BASE 0xf0000
#define BIOS_BASE2 0xe0000
#define BIOS_SIZE 0x10000
#define ONE_KBYTE 1024
#define GROPE_AREA1 0x80000
#define GROPE_AREA2 0x90000
#define GROPE_SIZE 0x10000
#define PROCENTRY_FLAG_EN 0x01
#define PROCENTRY_FLAG_BP 0x02
#define IOAPICENTRY_FLAG_EN 0x01
#define MAXPNSTR 132
#define COREBOOT_MP_TABLE 0
enum busTypes {
CBUS = 1,
CBUSII = 2,
EISA = 3,
ISA = 6,
PCI = 13,
XPRESS = 18,
MAX_BUSTYPE = 18,
UNKNOWN_BUSTYPE = 0xff
};
typedef struct BUSTYPENAME {
uint8_t type;
char name[ 7 ];
} busTypeName;
static busTypeName busTypeTable[] =
{
{ CBUS, "CBUS" },
{ CBUSII, "CBUSII" },
{ EISA, "EISA" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ ISA, "ISA" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ PCI, "PCI" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" },
{ UNKNOWN_BUSTYPE, "---" }
};
char* whereStrings[] = {
"Extended BIOS Data Area",
"BIOS top of memory",
"Default top of memory",
"BIOS",
"Extended BIOS",
"GROPE AREA #1",
"GROPE AREA #2"
};
typedef struct TABLE_ENTRY {
uint8_t type;
uint8_t length;
char name[ 32 ];
} tableEntry;
tableEntry basetableEntryTypes[] =
{
{ 0, 20, "Processor" },
{ 1, 8, "Bus" },
{ 2, 8, "I/O APIC" },
{ 3, 8, "I/O INT" },
{ 4, 8, "Local INT" }
};
tableEntry extendedtableEntryTypes[] =
{
{ 128, 20, "System Address Space" },
{ 129, 8, "Bus Heirarchy" },
{ 130, 8, "Compatibility Bus Address" }
};
/* MP Floating Pointer Structure */
typedef struct MPFPS {
uint8_t signature[ 4 ];
uint32_t pap;
uint8_t length;
uint8_t spec_rev;
uint8_t checksum;
uint8_t mpfb1;
uint8_t mpfb2;
uint8_t mpfb3;
uint8_t mpfb4;
uint8_t mpfb5;
} mpfps_t;
/* MP Configuration Table Header */
typedef struct MPCTH {
uint8_t signature[ 4 ];
uint16_t base_table_length;
uint8_t spec_rev;
uint8_t checksum;
uint8_t oem_id[ 8 ];
uint8_t product_id[ 12 ];
uint32_t oem_table_pointer;
uint16_t oem_table_size;
uint16_t entry_count;
uint32_t apic_address;
uint16_t extended_table_length;
uint8_t extended_table_checksum;
uint8_t reserved;
} mpcth_t;
typedef struct PROCENTRY {
uint8_t type;
uint8_t apicID;
uint8_t apicVersion;
uint8_t cpuFlags;
uint32_t cpuSignature;
uint32_t featureFlags;
uint32_t reserved1;
uint32_t reserved2;
} ProcEntry;
typedef struct BUSENTRY {
uint8_t type;
uint8_t busID;
uint8_t busType[ 6 ];
} BusEntry;
typedef struct IOAPICENTRY {
uint8_t type;
uint8_t apicID;
uint8_t apicVersion;
uint8_t apicFlags;
uint32_t apicAddress;
} IOApicEntry;
typedef struct INTENTRY {
uint8_t type;
uint8_t intType;
uint16_t intFlags;
uint8_t srcBusID;
uint8_t srcBusIRQ;
uint8_t dstApicID;
uint8_t dstApicINT;
} IntEntry;
/*
* extended entry type structures
*/
typedef struct SASENTRY {
uint8_t type;
uint8_t length;
uint8_t busID;
uint8_t addressType;
uint64_t addressBase;
uint64_t addressLength;
} SasEntry;
typedef struct BHDENTRY {
uint8_t type;
uint8_t length;
uint8_t busID;
uint8_t busInfo;
uint8_t busParent;
uint8_t reserved[ 3 ];
} BhdEntry;
typedef struct CBASMENTRY {
uint8_t type;
uint8_t length;
uint8_t busID;
uint8_t addressMod;
uint32_t predefinedRange;
} CbasmEntry;
typedef uint32_t vm_offset_t;
static void apic_probe( vm_offset_t* paddr, int* where );
static void MPConfigDefault( int featureByte );
static void MPFloatingPointer( vm_offset_t paddr, int where, mpfps_t* mpfps );
static void MPConfigTableHeader( uint32_t pap );
static int readType( void );
static void seekEntry( vm_offset_t addr );
static void readEntry( void* entry, int size );
static void processorEntry( void );
static void busEntry( void );
static void ioApicEntry( void );
static void intEntry( void );
static void lintEntry( void );
static void sasEntry( void );
static void bhdEntry( void );
static void cbasmEntry( void );
static void doOptionList( void );
static void doDmesg( void );
static void pnstr( uint8_t* s, int c );
/* global data */
int pfd; /* physical /dev/mem fd */
int busses[ 16 ];
int apics[ 16 ];
int ncpu;
int nbus;
int napic;
int nintr;
int dmesg = 0;
int grope = 0;
int verbose = 0;
int noisy = 0;
/* preamble to the mptable. This is fixed for all coreboots */
char *preamble[] = {
"#include <console/console.h>",
"#include <arch/smp/mpspec.h>",
"#include <arch/ioapic.h>",
"#include <device/pci.h>",
"#include <string.h>",
"#include <stdint.h>",
"",
"static void *smp_write_config_table(void *v)",
"{",
" static const char sig[4] = \"PCMP\";",
" static const char oem[8] = \"LNXI \";",
" static const char productid[12] = \"P4DPE \";",
" struct mp_config_table *mc;",
"",
" mc = (void *)(((char *)v) + SMP_FLOATING_TABLE_LEN);",
" memset(mc, 0, sizeof(*mc));",
"",
" memcpy(mc->mpc_signature, sig, sizeof(sig));",
" mc->mpc_length = sizeof(*mc); /* initially just the header */",
" mc->mpc_spec = 0x04;",
" mc->mpc_checksum = 0; /* not yet computed */",
" memcpy(mc->mpc_oem, oem, sizeof(oem));",
" memcpy(mc->mpc_productid, productid, sizeof(productid));",
" mc->mpc_oemptr = 0;",
" mc->mpc_oemsize = 0;",
" mc->mpc_entry_count = 0; /* No entries yet... */",
" mc->mpc_lapic = LAPIC_ADDR;",
" mc->mpe_length = 0;",
" mc->mpe_checksum = 0;",
" mc->reserved = 0;",
"",
" smp_write_processors(mc);",
"",
"",
0
};
char *postamble[] = {
" /* There is no extension information... */",
"",
" /* Compute the checksums */",
" mc->mpe_checksum = smp_compute_checksum(smp_next_mpc_entry(mc), mc->mpe_length);",
" mc->mpc_checksum = smp_compute_checksum(mc, mc->mpc_length);",
" printk(BIOS_DEBUG, \"Wrote the mp table end at: %p - %p\\n\",",
" mc, smp_next_mpe_entry(mc));",
" return smp_next_mpe_entry(mc);",
"}",
"",
"unsigned long write_smp_table(unsigned long addr)",
"{",
" void *v;",
" v = smp_write_floating_table(addr);",
" return (unsigned long)smp_write_config_table(v);",
"}",
0
};
char *ioapic_code[] = {
" smp_write_ioapic(mc, 2, 0x20, IO_APIC_ADDR);",
" {",
" device_t dev;",
" struct resource *res;",
" dev = dev_find_slot(1, PCI_DEVFN(0x1e,0));",
" if (dev) {",
" res = find_resource(dev, PCI_BASE_ADDRESS_0);",
" if (res) {",
" smp_write_ioapic(mc, 3, 0x20, res->base);",
" }",
" }",
" dev = dev_find_slot(1, PCI_DEVFN(0x1c,0));",
" if (dev) {",
" res = find_resource(dev, PCI_BASE_ADDRESS_0);",
" if (res) {",
" smp_write_ioapic(mc, 4, 0x20, res->base);",
" }",
" }",
" dev = dev_find_slot(4, PCI_DEVFN(0x1e,0));",
" if (dev) {",
" res = find_resource(dev, PCI_BASE_ADDRESS_0);",
" if (res) {",
" smp_write_ioapic(mc, 5, 0x20, res->base);",
" }",
" }",
" dev = dev_find_slot(4, PCI_DEVFN(0x1c,0));",
" if (dev) {",
" res = find_resource(dev, PCI_BASE_ADDRESS_0);",
" if (res) {",
" smp_write_ioapic(mc, 8, 0x20, res->base);",
" }",
" }",
" }",
0
};
static void
usage( void )
{
fprintf( stderr, "usage: mptable [-dmesg] [-verbose] [-grope] [-help]\n" );
exit( 0 );
}
void
write_code(char **code)
{
while (*code)
printf("%s\n", *code++);
}
/*
*
*/
int
main( int argc, char *argv[] )
{
vm_offset_t paddr;
int where;
mpfps_t mpfps;
int defaultConfig;
/* announce ourselves */
if (verbose) puts( SEP_LINE2 );
printf( "/* generated by MPTable, version %d.%d.%d*/\n", VMAJOR, VMINOR, VDELTA );
printf("/* as modified by RGM for coreboot */\n");
write_code(preamble);
/* Ron hates getopt() */
for(argc--, argv++; argc; argc--, argv++){
if ( strcmp( argv[0], "-dmesg") == 0 ) {
dmesg = 1;
} else
if ( strcmp( argv[0], "-help") == 0 )
{
usage();
} else
if ( strcmp( argv[0], "-grope") == 0 ){
grope = 1;
} else if ( strcmp( argv[0], "-verbose") == 0 )
verbose = 1;
else if ( strcmp( argv[0], "-noisy") == 0 )
noisy = 1;
else usage();
}
/* open physical memory for access to MP structures */
if ( (pfd = open( "/dev/mem", O_RDONLY )) < 0 )
err( 1, "mem open" );
/* probe for MP structures */
apic_probe( &paddr, &where );
if ( where <= 0 ) {
fprintf( stderr, "\n MP FPS NOT found,\n" );
fprintf( stderr, " suggest trying -grope option!!!\n\n" );
return 1;
}
if ( verbose )
printf( "\n MP FPS found in %s @ physical addr: 0x%08x\n",
whereStrings[ where - 1 ], paddr );
if (verbose) puts( SEP_LINE );
/* analyze the MP Floating Pointer Structure */
MPFloatingPointer( paddr, where, &mpfps );
if (verbose) puts( SEP_LINE );
/* check whether an MP config table exists */
if ( (defaultConfig = mpfps.mpfb1) )
MPConfigDefault( defaultConfig );
else
MPConfigTableHeader( mpfps.pap );
/* build "options" entries for the kernel config file */
if (noisy)
doOptionList();
write_code(postamble);
/* do a dmesg output */
if ( dmesg )
doDmesg();
if (verbose) puts( SEP_LINE2 );
return 0;
}
/*
* set PHYSICAL address of MP floating pointer structure
*/
#define NEXT(X) ((X) += 4)
static void
apic_probe( vm_offset_t* paddr, int* where )
{
/*
* c rewrite of apic_probe() by Jack F. Vogel
*/
int x;
u_short segment;
vm_offset_t target;
u_int buffer[ BIOS_SIZE / sizeof( int ) ];
if ( verbose )
printf( "\n" );
/* search Extended Bios Data Area, if present */
if ( verbose )
printf( " looking for EBDA pointer @ 0x%04x, ", EBDA_POINTER );
seekEntry( (vm_offset_t)EBDA_POINTER );
readEntry( &segment, 2 );
if ( segment ) { /* search EBDA */
target = (vm_offset_t)segment << 4;
if ( verbose )
printf( "found, searching EBDA @ 0x%08x\n", target );
seekEntry( target );
readEntry( buffer, ONE_KBYTE );
for ( x = 0; x < ONE_KBYTE / sizeof ( unsigned int ); NEXT(x) ) {
if ( buffer[ x ] == MP_SIG ) {
*where = 1;
*paddr = (x * sizeof( unsigned int )) + target;
return;
}
}
}
else {
if ( verbose )
printf( "NOT found\n" );
}
target = 0;
segment = 0;
if ( verbose )
printf( " searching for coreboot MP table @ 0x%08x (%dK)\n",
target, segment );
seekEntry( target );
readEntry( buffer, ONE_KBYTE );
for ( x = 0; x < ONE_KBYTE / sizeof ( unsigned int ); NEXT(x) ) {
if ( buffer[ x ] == MP_SIG ) {
*where = 2;
*paddr = (x * sizeof( unsigned int )) + target;
return;
}
}
/* read CMOS for real top of mem */
seekEntry( (vm_offset_t)TOPOFMEM_POINTER );
readEntry( &segment, 2 );
--segment; /* less ONE_KBYTE */
target = segment * 1024;
if ( verbose )
printf( " searching CMOS 'top of mem' @ 0x%08x (%dK)\n",
target, segment );
seekEntry( target );
readEntry( buffer, ONE_KBYTE );
for ( x = 0; x < ONE_KBYTE / sizeof ( unsigned int ); NEXT(x) ) {
if ( buffer[ x ] == MP_SIG ) {
*where = 2;
*paddr = (x * sizeof( unsigned int )) + target;
return;
}
}
/* we don't necessarily believe CMOS, check base of the last 1K of 640K */
if ( target != (DEFAULT_TOPOFMEM - 1024)) {
target = (DEFAULT_TOPOFMEM - 1024);
if ( verbose )
printf( " searching default 'top of mem' @ 0x%08x (%dK)\n",
target, (target / 1024) );
seekEntry( target );
readEntry( buffer, ONE_KBYTE );
for ( x = 0; x < ONE_KBYTE / sizeof ( unsigned int ); NEXT(x) ) {
if ( buffer[ x ] == MP_SIG ) {
*where = 3;
*paddr = (x * sizeof( unsigned int )) + target;
return;
}
}
}
/* search the BIOS */
if ( verbose )
printf( " searching BIOS @ 0x%08x\n", BIOS_BASE );
seekEntry( BIOS_BASE );
readEntry( buffer, BIOS_SIZE );
for ( x = 0; x < BIOS_SIZE / sizeof( unsigned int ); NEXT(x) ) {
if ( buffer[ x ] == MP_SIG ) {
*where = 4;
*paddr = (x * sizeof( unsigned int )) + BIOS_BASE;
return;
}
}
/* search the extended BIOS */
if ( verbose )
printf( " searching extended BIOS @ 0x%08x\n", BIOS_BASE2 );
seekEntry( BIOS_BASE2 );
readEntry( buffer, BIOS_SIZE );
for ( x = 0; x < BIOS_SIZE / sizeof( unsigned int ); NEXT(x) ) {
if ( buffer[ x ] == MP_SIG ) {
*where = 5;
*paddr = (x * sizeof( unsigned int )) + BIOS_BASE2;
return;
}
}
if ( grope ) {
/* search additional memory */
target = GROPE_AREA1;
if ( verbose )
printf( " groping memory @ 0x%08x\n", target );
seekEntry( target );
readEntry( buffer, GROPE_SIZE );
for ( x = 0; x < GROPE_SIZE / sizeof( unsigned int ); NEXT(x) ) {
if ( buffer[ x ] == MP_SIG ) {
*where = 6;
*paddr = (x * sizeof( unsigned int )) + GROPE_AREA1;
return;
}
}
target = GROPE_AREA2;
if ( verbose )
printf( " groping memory @ 0x%08x\n", target );
seekEntry( target );
readEntry( buffer, GROPE_SIZE );
for ( x = 0; x < GROPE_SIZE / sizeof( unsigned int ); NEXT(x) ) {
if ( buffer[ x ] == MP_SIG ) {
*where = 7;
*paddr = (x * sizeof( unsigned int )) + GROPE_AREA2;
return;
}
}
}
*where = 0;
*paddr = (vm_offset_t)0;
}
/*
*
*/
static void
MPFloatingPointer( vm_offset_t paddr, int where, mpfps_t* mpfps )
{
/* read in mpfps structure*/
seekEntry( paddr );
readEntry( mpfps, sizeof( mpfps_t ) );
/* show its contents */
if (verbose) {
printf( "MP Floating Pointer Structure:\n\n" );
printf( " location:\t\t\t" );
switch ( where )
{
case 1:
printf( "EBDA\n" );
break;
case 2:
printf( "BIOS base memory\n" );
break;
case 3:
printf( "DEFAULT base memory (639K)\n" );
break;
case 4:
printf( "BIOS\n" );
break;
case 5:
printf( "Extended BIOS\n" );
break;
case 0:
printf( "NOT found!\n" );
exit( 1 );
default:
printf( "BOGUS!\n" );
exit( 1 );
}
printf( " physical address:\t\t0x%08x\n", paddr );
printf( " signature:\t\t\t'" );
pnstr( mpfps->signature, 4 );
printf( "'\n" );
printf( " length:\t\t\t%d bytes\n", mpfps->length * 16 );
printf( " version:\t\t\t1.%1d\n", mpfps->spec_rev );
printf( " checksum:\t\t\t0x%02x\n", mpfps->checksum );
/* bits 0:6 are RESERVED */
if ( mpfps->mpfb2 & 0x7f ) {
printf( " warning, MP feature byte 2: 0x%02x\n", mpfps->mpfb2 );
}
/* bit 7 is IMCRP */
printf( " mode:\t\t\t\t%s\n", (mpfps->mpfb2 & 0x80) ?
"PIC" : "Virtual Wire" );
/* MP feature bytes 3-5 are expected to be ZERO */
if ( mpfps->mpfb3 )
printf( " warning, MP feature byte 3 NONZERO!\n" );
if ( mpfps->mpfb4 )
printf( " warning, MP feature byte 4 NONZERO!\n" );
if ( mpfps->mpfb5 )
printf( " warning, MP feature byte 5 NONZERO!\n" );
}
}
/*
*
*/
static void
MPConfigDefault( int featureByte )
{
printf( " MP default config type: %d\n\n", featureByte );
switch ( featureByte ) {
case 1:
printf( " bus: ISA, APIC: 82489DX\n" );
break;
case 2:
printf( " bus: EISA, APIC: 82489DX\n" );
break;
case 3:
printf( " bus: EISA, APIC: 82489DX\n" );
break;
case 4:
printf( " bus: MCA, APIC: 82489DX\n" );
break;
case 5:
printf( " bus: ISA+PCI, APIC: Integrated\n" );
break;
case 6:
printf( " bus: EISA+PCI, APIC: Integrated\n" );
break;
case 7:
printf( " bus: MCA+PCI, APIC: Integrated\n" );
break;
default:
printf( " future type\n" );
break;
}
switch ( featureByte ) {
case 1:
case 2:
case 3:
case 4:
nbus = 1;
break;
case 5:
case 6:
case 7:
nbus = 2;
break;
default:
printf( " future type\n" );
break;
}
ncpu = 2;
napic = 1;
nintr = 16;
}
/*
*
*/
static void
MPConfigTableHeader( uint32_t pap )
{
vm_offset_t paddr;
mpcth_t cth;
int x;
int totalSize, t;
int count, c;
int type;
if ( pap == 0 ) {
printf( "MP Configuration Table Header MISSING!\n" );
exit( 1 );
}
/* convert physical address to virtual address */
paddr = (vm_offset_t)pap;
/* read in cth structure */
seekEntry( paddr );
readEntry( &cth, sizeof( cth ) );
if (verbose) {
printf( "MP Config Table Header:\n\n" );
printf( " physical address:\t\t0x%08x\n", pap );
printf( " signature:\t\t\t'" );
pnstr( cth.signature, 4 );
printf( "'\n" );
printf( " base table length:\t\t%d\n", cth.base_table_length );
printf( " version:\t\t\t1.%1d\n", cth.spec_rev );
printf( " checksum:\t\t\t0x%02x\n", cth.checksum );
printf( " OEM ID:\t\t\t'" );
pnstr( cth.oem_id, 8 );
printf( "'\n" );
printf( " Product ID:\t\t\t'" );
pnstr( cth.product_id, 12 );
printf( "'\n" );
printf( " OEM table pointer:\t\t0x%08x\n", cth.oem_table_pointer );
printf( " OEM table size:\t\t%d\n", cth.oem_table_size );
printf( " entry count:\t\t\t%d\n", cth.entry_count );
printf( " local APIC address:\t\t0x%08x\n", cth.apic_address );
printf( " extended table length:\t%d\n", cth.extended_table_length );
printf( " extended table checksum:\t%d\n", cth.extended_table_checksum );
}
totalSize = cth.base_table_length - sizeof( struct MPCTH );
count = cth.entry_count;
if (verbose) {
if (verbose) puts( SEP_LINE );
printf( "MP Config Base Table Entries:\n\n" );
}
/* initialze tables */
for ( x = 0; x < 16; ++x ) {
busses[ x ] = apics[ x ] = 0xff;
}
ncpu = 0;
nbus = 0;
napic = 0;
nintr = 0;
/* process all the CPUs */
if (verbose) {
printf( "--\nProcessors:\tAPIC ID\tVersion\tState"
"\t\tFamily\tModel\tStep\tFlags\n" );
}
for ( t = totalSize, c = count; c; c-- ) {
if ( readType() == 0 )
processorEntry();
totalSize -= basetableEntryTypes[ 0 ].length;
}
/* process all the busses */
printf( "/*Bus:\t\tBus ID\tType*/\n" );
for ( t = totalSize, c = count; c; c-- ) {
if ( readType() == 1 )
busEntry();
totalSize -= basetableEntryTypes[ 1 ].length;
}
/* process all the apics */
printf( "/*I/O APICs:\tAPIC ID\tVersion\tState\t\tAddress*/\n" );
for ( t = totalSize, c = count; c; c-- ) {
if ( readType() == 2 )
ioApicEntry();
totalSize -= basetableEntryTypes[ 2 ].length;
}
write_code(ioapic_code);
/* process all the I/O Ints */
printf( "/*I/O Ints:\tType\tPolarity Trigger\tBus ID\t IRQ\tAPIC ID\tPIN#\n*/" );
for ( t = totalSize, c = count; c; c-- ) {
if ( readType() == 3 )
intEntry();
totalSize -= basetableEntryTypes[ 3 ].length;
}
/* process all the Local Ints */
printf( "/*Local Ints:\tType\tPolarity Trigger\tBus ID\t IRQ\tAPIC ID\tPIN#*/\n" );
for ( t = totalSize, c = count; c; c-- ) {
if ( readType() == 4 )
lintEntry();
totalSize -= basetableEntryTypes[ 4 ].length;
}
#if defined( EXTENDED_PROCESSING_READY )
/* process any extended data */
if ( (totalSize = cth.extended_table_length) ) {
if (verbose) puts( SEP_LINE );
printf( "MP Config Extended Table Entries:\n\n" );
while ( totalSize > 0 ) {
switch ( type = readType() ) {
case 128:
sasEntry();
break;
case 129:
bhdEntry();
break;
case 130:
cbasmEntry();
break;
default:
printf( "Extended Table HOSED!\n" );
exit( 1 );
}
totalSize -= extendedtableEntryTypes[ type-128 ].length;
}
}
#endif /* EXTENDED_PROCESSING_READY */
/* process any OEM data */
if ( cth.oem_table_pointer && (cth.oem_table_size > 0) ) {
#if defined( OEM_PROCESSING_READY )
# error your on your own here!
/* convert OEM table pointer to virtual address */
poemtp = (vm_offset_t)cth.oem_table_pointer;
/* read in oem table structure */
if ( (oemdata = (void*)malloc( cth.oem_table_size )) == NULL )
err( 1, "oem malloc" );
seekEntry( poemtp );
readEntry( oemdata, cth.oem_table_size );
/** process it */
free( oemdata );
#else
printf( "\nyou need to modify the source to handle OEM data!\n\n" );
#endif /* OEM_PROCESSING_READY */
}
fflush( stdout );
#if defined( RAW_DUMP )
{
int ofd;
u_char dumpbuf[ 4096 ];
ofd = open( "/tmp/mpdump", O_CREAT | O_RDWR );
seekEntry( paddr );
readEntry( dumpbuf, 1024 );
write( ofd, dumpbuf, 1024 );
close( ofd );
}
#endif /* RAW_DUMP */
}
/*
*
*/
static int
readType( void )
{
u_char type;
if ( read( pfd, &type, sizeof( u_char ) ) != sizeof( u_char ) )
err( 1, "type read; pfd: %d", pfd );
if ( lseek( pfd, -1, SEEK_CUR ) < 0 )
err( 1, "type seek" );
return (int)type;
}
/*
*
*/
static void
seekEntry( vm_offset_t addr )
{
if ( lseek( pfd, (off_t)addr, SEEK_SET ) < 0 )
err( 1, "/dev/mem seek" );
}
/*
*
*/
static void
readEntry( void* entry, int size )
{
if ( read( pfd, entry, size ) != size )
err( 1, "readEntry" );
}
static void
processorEntry( void )
{
ProcEntry entry;
/* read it into local memory */
readEntry( &entry, sizeof( entry ) );
/* count it */
++ncpu;
if (noisy) {
printf( "\t\t%2d", entry.apicID );
printf( "\t 0x%2x", entry.apicVersion );
printf( "\t %s, %s",
(entry.cpuFlags & PROCENTRY_FLAG_BP) ? "BSP" : "AP",
(entry.cpuFlags & PROCENTRY_FLAG_EN) ? "usable" : "unusable" );
printf( "\t %d\t %d\t %d",
(entry.cpuSignature >> 8) & 0x0f,
(entry.cpuSignature >> 4) & 0x0f,
entry.cpuSignature & 0x0f );
printf( "\t 0x%04x\n", entry.featureFlags );
}
}
/*
*
*/
static int
lookupBusType( char* name )
{
int x;
for ( x = 0; x < MAX_BUSTYPE; ++x )
if ( strcmp( busTypeTable[ x ].name, name ) == 0 )
return busTypeTable[ x ].type;
return UNKNOWN_BUSTYPE;
}
static void
busEntry( void )
{
int x;
char name[ 8 ];
char c;
BusEntry entry;
/* read it into local memory */
readEntry( &entry, sizeof( entry ) );
/* count it */
++nbus;
if (verbose) {
printf( "\t\t%2d", entry.busID );
printf( "\t " ); pnstr( entry.busType, 6 ); printf( "\n" );
}
for ( x = 0; x < 6; ++x ) {
// if ( (c = entry.busType[ x ]) == ' ' )
//break;
name[ x ] = c;
}
name[ x ] = '\0';
busses[ entry.busID ] = lookupBusType( name );
printf("\tsmp_write_bus(mc, %d, \"", entry.busID);
pnstr( entry.busType, 6 );
printf("\");\n");
}
static void
ioApicEntry( void )
{
IOApicEntry entry;
/* read it into local memory */
readEntry( &entry, sizeof( entry ) );
/* count it */
++napic;
if (noisy) {
printf( "\t\t%2d", entry.apicID );
printf( "\t 0x%02x", entry.apicVersion );
printf( "\t %s",
(entry.apicFlags & IOAPICENTRY_FLAG_EN) ? "usable" : "unusable" );
printf( "\t\t 0x%x\n", entry.apicAddress );
}
apics[ entry.apicID ] = entry.apicID;
// the numbering and setup of ioapics is so irrational
// that for now we will punt.
#if 0
if (entry.apicFlags & IOAPICENTRY_FLAG_EN)
printf("\tsmp_write_ioapic(mc, 0x%x, 0x%x, 0x%x);\n",
entry.apicID, entry.apicVersion, entry.apicAddress);
#endif
}
char* intTypes[] = {
"mp_INT", "mp_NMI", "mp_SMI", "mp_ExtINT"
};
char* polarityMode[] = {
"MP_IRQ_POLARITY_DEFAULT", "MP_IRQ_POLARITY_HIGH", "reserved", "MP_IRQ_POLARITY_LOW"
};
char* triggerMode[] = {
"MP_IRQ_TRIGGER_DEFAULT", "MP_IRQ_TRIGGER_EDGE", "reserved", "MP_IRQ_TRIGGER_LEVEL"
};
static void
intEntry( void )
{
IntEntry entry;
/* read it into local memory */
readEntry( &entry, sizeof( entry ) );
/* count it */
if ( (int)entry.type == 3 )
++nintr;
if (noisy) {
printf( "\n\t\t%s", intTypes[ (int)entry.intType ] );
printf( "\t%9s", polarityMode[ (int)entry.intFlags & 0x03 ] );
printf( "%12s", triggerMode[ ((int)entry.intFlags >> 2) & 0x03 ] );
printf( "\t %5d", (int)entry.srcBusID );
if ( busses[ (int)entry.srcBusID ] == PCI )
printf( "\t%2d:%c",
((int)entry.srcBusIRQ >> 2) & 0x1f,
((int)entry.srcBusIRQ & 0x03) + 'A' );
else
printf( "\t 0x%x:0x%x(0x%x)",
(int)entry.srcBusIRQ>>2,
(int)entry.srcBusIRQ & 3,
(int)entry.srcBusIRQ );
printf( "\t %6d", (int)entry.dstApicID );
printf( "\t %3d\n", (int)entry.dstApicINT );
}
printf("\tsmp_write_intsrc(mc, %s, %s|%s, 0x%x, 0x%x, 0x%x, 0x%x);\n",
intTypes[ (int)entry.intType ],
triggerMode[ ((int)entry.intFlags >> 2) & 0x03 ] ,
polarityMode[ (int)entry.intFlags & 0x03 ],
(int)entry.srcBusID,
(int)entry.srcBusIRQ,
(int)entry.dstApicID ,
(int)entry.dstApicINT );
}
static void
lintEntry( void )
{
IntEntry entry;
/* read it into local memory */
readEntry( &entry, sizeof( entry ) );
/* count it */
if ( (int)entry.type == 3 )
++nintr;
if (noisy) {
printf( "\t\t%s", intTypes[ (int)entry.intType ] );
printf( "\t%9s", polarityMode[ (int)entry.intFlags & 0x03 ] );
printf( "%12s", triggerMode[ ((int)entry.intFlags >> 2) & 0x03 ] );
printf( "\t %5d", (int)entry.srcBusID );
if ( busses[ (int)entry.srcBusID ] == PCI )
printf( "\t%2d:%c",
((int)entry.srcBusIRQ >> 2) & 0x1f,
((int)entry.srcBusIRQ & 0x03) + 'A' );
else
printf( "\t %3d", (int)entry.srcBusIRQ );
printf( "\t %6d", (int)entry.dstApicID );
printf( "\t %3d\n", (int)entry.dstApicINT );
}
printf("\tsmp_write_intsrc(mc, %s, %s|%s, 0x%x, 0x%x, MP_APIC_ALL, 0x%x);\n",
intTypes[ (int)entry.intType ],
triggerMode[ ((int)entry.intFlags >> 2) & 0x03 ] ,
polarityMode[ (int)entry.intFlags & 0x03 ],
(int)entry.srcBusID,
(int)entry.srcBusIRQ,
(int)entry.dstApicINT );
}
static void
sasEntry( void )
{
SasEntry entry;
/* read it into local memory */
readEntry( &entry, sizeof( entry ) );
printf( "--\n%s\n", extendedtableEntryTypes[ entry.type - 128 ].name );
printf( " bus ID: %d", entry.busID );
printf( " address type: " );
switch ( entry.addressType ) {
case 0:
printf( "I/O address\n" );
break;
case 1:
printf( "memory address\n" );
break;
case 2:
printf( "prefetch address\n" );
break;
default:
printf( "UNKNOWN type\n" );
break;
}
printf( " address base: 0x%lx\n", entry.addressBase );
printf( " address range: 0x%lx\n", entry.addressLength );
}
static void
bhdEntry( void )
{
BhdEntry entry;
/* read it into local memory */
readEntry( &entry, sizeof( entry ) );
printf( "--\n%s\n", extendedtableEntryTypes[ entry.type - 128 ].name );
printf( " bus ID: %d", entry.busID );
printf( " bus info: 0x%02x", entry.busInfo );
printf( " parent bus ID: %d", entry.busParent );
}
static void
cbasmEntry( void )
{
CbasmEntry entry;
/* read it into local memory */
readEntry( &entry, sizeof( entry ) );
printf( "--\n%s\n", extendedtableEntryTypes[ entry.type - 128 ].name );
printf( " bus ID: %d", entry.busID );
printf( " address modifier: %s\n", (entry.addressMod & 0x01) ?
"subtract" : "add" );
printf( " predefined range: 0x%08x", entry.predefinedRange );
}
/*
* do a dmesg output
*/
static void
doDmesg( void )
{
if (verbose) puts( SEP_LINE );
printf( "dmesg output:\n\n" );
fflush( stdout );
system( "dmesg" );
}
/*
* build "options" entries for the kernel config file
*/
static void
doOptionList( void )
{
if (verbose) puts( SEP_LINE );
printf( "# SMP kernel config file options:\n\n" );
printf( "\n# Required:\n" );
printf( "options SMP\t\t\t# Symmetric MultiProcessor Kernel\n" );
printf( "options APIC_IO\t\t\t# Symmetric (APIC) I/O\n" );
printf( "\n# Optional (built-in defaults will work in most cases):\n" );
printf( "#options NCPU=%d\t\t\t# number of CPUs\n", ncpu );
printf( "#options NBUS=%d\t\t\t# number of busses\n", nbus );
printf( "#options NAPIC=%d\t\t\t# number of IO APICs\n", napic );
printf( "#options NINTR=%d\t\t# number of INTs\n",
(nintr < 24) ? 24 : nintr );
}
/*
*
*/
static void
pnstr( uint8_t* s, int c )
{
uint8_t string[ MAXPNSTR + 1 ];
if ( c > MAXPNSTR )
c = MAXPNSTR;
strncpy( (char *)string, (char *)s, c );
string[ c ] = '\0';
printf( "%s", string );
}
Reference in New Issue View Git Blame Copy Permalink