diff options
Diffstat (limited to 'src/arch/i386/boot/tables.c')
-rw-r--r-- | src/arch/i386/boot/tables.c | 64 |
1 files changed, 46 insertions, 18 deletions
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 <console/console.h> #include <cpu/cpu.h> #include <boot/tables.h> @@ -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; - - 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 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"); } 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(); } |