diff --git a/src/arch/i386/boot/linuxbios_table.c b/src/arch/i386/boot/linuxbios_table.c index a625fe0473..402f7f90e0 100644 --- a/src/arch/i386/boot/linuxbios_table.c +++ b/src/arch/i386/boot/linuxbios_table.c @@ -349,15 +349,22 @@ static struct lb_memory *build_lb_mem(struct lb_header *head) } unsigned long write_linuxbios_table( - unsigned long low_table_start, unsigned long low_table_end, - unsigned long rom_table_startk, unsigned long rom_table_endk) + unsigned long low_table_start, unsigned long low_table_end, + unsigned long rom_table_start, unsigned long rom_table_end) { unsigned long table_size; struct lb_header *head; struct lb_memory *mem; - head = lb_table_init(low_table_end); - low_table_end = (unsigned long)head; + if(low_table_end > (0x1000 - sizeof(struct lb_header))) { /* after 4K */ + /* We need to put lbtable on to [0xf0000,0x100000) */ + head = lb_table_init(rom_table_end); + rom_table_end = (unsigned long)head; + } else { + head = lb_table_init(low_table_end); + low_table_end = (unsigned long)head; + } + if (HAVE_OPTION_TABLE == 1) { struct lb_record *rec_dest, *rec_src; /* Write the option config table... */ @@ -370,16 +377,13 @@ unsigned long write_linuxbios_table( /* Record where RAM is located */ mem = build_lb_mem(head); - /* Find the current mptable size */ - table_size = (low_table_end - low_table_start); - /* Record the mptable and the the lb_table (This will be adjusted later) */ lb_add_memory_range(mem, LB_MEM_TABLE, - low_table_start, table_size); + low_table_start, low_table_end - low_table_start); - /* Record the pirq table */ + /* Record the pirq table, acpi tables, and maybe the mptable */ lb_add_memory_range(mem, LB_MEM_TABLE, - rom_table_startk << 10, (rom_table_endk - rom_table_startk) << 10); + rom_table_start, rom_table_end - rom_table_start); /* Note: * I assume that there is always memory at immediately after @@ -393,8 +397,7 @@ unsigned long write_linuxbios_table( /* Record our various random string information */ lb_strings(head); - low_table_end = lb_table_fini(head); - /* Remember where my valid memory ranges are */ - return low_table_end; + return lb_table_fini(head); + } diff --git a/src/arch/i386/boot/tables.c b/src/arch/i386/boot/tables.c index d470abbd27..8abac2b748 100644 --- a/src/arch/i386/boot/tables.c +++ b/src/arch/i386/boot/tables.c @@ -1,3 +1,6 @@ + +/* 2006.1 yhlu add mptable cross 0x467 processing */ + #include #include #include @@ -13,8 +16,8 @@ extern uint8_t gdt_end; /* i386 lgdt argument */ struct gdtarg { - unsigned short limit; - unsigned int base; + unsigned short limit; + unsigned int base; } __attribute__((packed)); // Copy GDT to new location and reload it @@ -23,19 +26,19 @@ struct gdtarg { void move_gdt(unsigned long newgdt) { uint16_t num_gdt_bytes = &gdt_end - &gdt; - struct gdtarg gdtarg; + struct gdtarg gdtarg; - printk_debug("Moving GDT to %#lx...", newgdt); - memcpy((void*)newgdt, &gdt, num_gdt_bytes); - gdtarg.base = newgdt; - gdtarg.limit = num_gdt_bytes - 1; - __asm__ __volatile__ ("lgdt %0\n\t" : : "m" (gdtarg)); - printk_debug("ok\n"); + printk_debug("Moving GDT to %#lx...", newgdt); + memcpy((void*)newgdt, &gdt, num_gdt_bytes); + gdtarg.base = newgdt; + gdtarg.limit = num_gdt_bytes - 1; + __asm__ __volatile__ ("lgdt %0\n\t" : : "m" (gdtarg)); + printk_debug("ok\n"); } struct lb_memory *write_tables(void) { - unsigned long low_table_start, low_table_end; + unsigned long low_table_start, low_table_end, new_low_table_end; unsigned long rom_table_start, rom_table_end; rom_table_start = 0xf0000; @@ -52,12 +55,6 @@ struct lb_memory *write_tables(void) rom_table_end = write_pirq_routing_table(rom_table_end); rom_table_end = (rom_table_end + 1023) & ~1023; - /* copy the smp block to address 0 */ - post_code(0x96); - - /* The smp table must be in 0-1K, 639K-640K, or 960K-1M */ - low_table_end = write_smp_table(low_table_end); - /* Write ACPI tables */ /* write them in the rom area because DSDT can be large (8K on epia-m) which * pushes linuxbios table out of first 4K if set up in low table area @@ -66,6 +63,37 @@ struct lb_memory *write_tables(void) rom_table_end = write_acpi_tables(rom_table_end); rom_table_end = (rom_table_end+1023) & ~1023; + /* copy the smp block to address 0 */ + post_code(0x96); + + /* The smp table must be in 0-1K, 639K-640K, or 960K-1M */ + new_low_table_end = write_smp_table(low_table_end); + + /* Don't write anything in the traditional x86 BIOS data segment, + * for example the linux kernel smp need to use 0x467 to pass reset vector + */ + if(new_low_table_end>0x467){ + unsigned mptable_size = new_low_table_end - low_table_end - SMP_FLOATING_TABLE_LEN; + /* We can not put mptable here, we need to copy them to somewhere else*/ + if((rom_table_end+mptable_size)<0x100000) { + /* We can copy mptable on rom_table, and leave low space for lbtable */ + printk_debug("move mptable to 0x%0x\n", rom_table_end); + memcpy((unsigned char *)rom_table_end, (unsigned char *)(low_table_end+SMP_FLOATING_TABLE_LEN), mptable_size); + memset((unsigned char *)low_table_end, '\0', mptable_size + SMP_FLOATING_TABLE_LEN); + smp_write_floating_table_physaddr(low_table_end, rom_table_end); + low_table_end += SMP_FLOATING_TABLE_LEN; + rom_table_end += mptable_size; + rom_table_end = (rom_table_end+1023) & ~1023; + } else { + /* We can need to put mptable low and from 0x500 */ + printk_debug("move mptable to 0x%0x\n", 0x500); + memcpy((unsigned char *)0x500, (unsigned char *)(low_table_end+SMP_FLOATING_TABLE_LEN), mptable_size); + memset((unsigned char *)low_table_end, '\0', 0x500-low_table_end); + smp_write_floating_table_physaddr(low_table_end, 0x500); + low_table_end = 0x500 + mptable_size; + } + } + /* Don't write anything in the traditional x86 BIOS data segment */ if (low_table_end < 0x500) { low_table_end = 0x500; @@ -78,7 +106,7 @@ struct lb_memory *write_tables(void) /* The linuxbios table must be in 0-4K or 960K-1M */ write_linuxbios_table( low_table_start, low_table_end, - rom_table_start >> 10, rom_table_end >> 10); + rom_table_start, rom_table_end); return get_lb_mem(); } diff --git a/src/arch/i386/smp/mpspec.c b/src/arch/i386/smp/mpspec.c index daeb78435d..797dab43c6 100644 --- a/src/arch/i386/smp/mpspec.c +++ b/src/arch/i386/smp/mpspec.c @@ -48,6 +48,30 @@ void *smp_write_floating_table(unsigned long addr) return v; } +void *smp_write_floating_table_physaddr(unsigned long addr, unsigned long mpf_physptr) +{ + struct intel_mp_floating *mf; + void *v; + + v = (void *)addr; + mf = v; + mf->mpf_signature[0] = '_'; + mf->mpf_signature[1] = 'M'; + mf->mpf_signature[2] = 'P'; + mf->mpf_signature[3] = '_'; + mf->mpf_physptr = mpf_physptr; + mf->mpf_length = 1; + mf->mpf_specification = 4; + mf->mpf_checksum = 0; + mf->mpf_feature1 = 0; + mf->mpf_feature2 = 0; + mf->mpf_feature3 = 0; + mf->mpf_feature4 = 0; + mf->mpf_feature5 = 0; + mf->mpf_checksum = smp_compute_checksum(mf, mf->mpf_length*16); + return v; +} + void *smp_next_mpc_entry(struct mp_config_table *mc) { void *v; diff --git a/src/arch/ppc/boot/linuxbios_table.c b/src/arch/ppc/boot/linuxbios_table.c index 10d3b0ce9d..e8eefc6258 100644 --- a/src/arch/ppc/boot/linuxbios_table.c +++ b/src/arch/ppc/boot/linuxbios_table.c @@ -332,7 +332,7 @@ static struct lb_memory *build_lb_mem(struct lb_header *head) unsigned long write_linuxbios_table( unsigned long low_table_start, unsigned long low_table_end, - unsigned long rom_table_startk, unsigned long rom_table_endk) + unsigned long rom_table_start, unsigned long rom_table_end) { unsigned long table_size; struct lb_header *head; @@ -359,7 +359,7 @@ unsigned long write_linuxbios_table( /* Record the pirq table */ lb_add_memory_range(mem, LB_MEM_TABLE, - rom_table_startk << 10, (rom_table_endk - rom_table_startk) << 10); + rom_table_start, (rom_table_end - rom_table_start)); /* Note: * I assume that there is always memory at immediately after diff --git a/src/arch/ppc/boot/tables.c b/src/arch/ppc/boot/tables.c index 7d8bd318ba..6fde37da24 100644 --- a/src/arch/ppc/boot/tables.c +++ b/src/arch/ppc/boot/tables.c @@ -21,7 +21,7 @@ write_tables(void) /* The linuxbios table must be in 0-4K or 960K-1M */ write_linuxbios_table( low_table_start, low_table_end, - rom_table_start >> 10, rom_table_end >> 10); + rom_table_start, rom_table_end); return get_lb_mem(); }