// 32bit code to Power On Self Test (POST) a machine.
//
-// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
+// Copyright (C) 2008-2010 Kevin O'Connor <kevin@koconnor.net>
// Copyright (C) 2002 MandrakeSoft S.A.
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "util.h" // memset
#include "biosvar.h" // struct bios_data_area_s
#include "disk.h" // floppy_drive_setup
+#include "ata.h" // ata_setup
+#include "ahci.h" // ahci_setup
#include "memmap.h" // add_e820
#include "pic.h" // pic_setup
#include "pci.h" // create_pirtable
#include "acpi.h" // acpi_bios_init
#include "bregs.h" // struct bregs
+#include "mptable.h" // mptable_init
#include "boot.h" // IPL
+#include "usb.h" // usb_setup
+#include "smbios.h" // smbios_init
+#include "paravirt.h" // qemu_cfg_port_probe
+#include "xen.h" // xen_probe_hvm_info
+#include "ps2port.h" // ps2port_setup
+#include "virtio-blk.h" // virtio_blk_setup
-void
-__set_irq(int vector, void *loc)
-{
- SET_IVT(vector, SEG_BIOS, (u32)loc - BUILD_BIOS_ADDR);
-}
-#define set_irq(vector, func) do { \
- extern void func (void); \
- __set_irq(vector, func); \
- } while (0)
+/****************************************************************
+ * BIOS init
+ ****************************************************************/
static void
-init_ivt()
+init_ivt(void)
{
dprintf(3, "init ivt\n");
// Initialize all vectors to the default handler.
int i;
for (i=0; i<256; i++)
- set_irq(i, entry_iret_official);
+ SET_IVT(i, FUNC16(entry_iret_official));
// Initialize all hw vectors to a default hw handler.
for (i=0x08; i<=0x0f; i++)
- set_irq(i, entry_hwpic1);
+ SET_IVT(i, FUNC16(entry_hwpic1));
for (i=0x70; i<=0x77; i++)
- set_irq(i, entry_hwpic2);
+ SET_IVT(i, FUNC16(entry_hwpic2));
// Initialize software handlers.
- set_irq(0x10, entry_10);
- set_irq(0x11, entry_11_official);
- set_irq(0x12, entry_12_official);
- set_irq(0x13, entry_13_official);
- set_irq(0x14, entry_14);
- set_irq(0x15, entry_15);
- set_irq(0x16, entry_16);
- set_irq(0x17, entry_17);
- set_irq(0x18, entry_18);
- set_irq(0x19, entry_19_official);
- set_irq(0x1a, entry_1a);
- set_irq(0x1c, entry_1c);
- set_irq(0x40, entry_40);
+ SET_IVT(0x02, FUNC16(entry_02));
+ SET_IVT(0x10, FUNC16(entry_10));
+ SET_IVT(0x11, FUNC16(entry_11));
+ SET_IVT(0x12, FUNC16(entry_12));
+ SET_IVT(0x13, FUNC16(entry_13_official));
+ SET_IVT(0x14, FUNC16(entry_14));
+ SET_IVT(0x15, FUNC16(entry_15));
+ SET_IVT(0x16, FUNC16(entry_16));
+ SET_IVT(0x17, FUNC16(entry_17));
+ SET_IVT(0x18, FUNC16(entry_18));
+ SET_IVT(0x19, FUNC16(entry_19_official));
+ SET_IVT(0x1a, FUNC16(entry_1a));
+ SET_IVT(0x40, FUNC16(entry_40));
+
+ // INT 60h-66h reserved for user interrupt
+ for (i=0x60; i<=0x66; i++)
+ SET_IVT(i, SEGOFF(0, 0));
// set vector 0x79 to zero
// this is used by 'gardian angel' protection system
- SET_IVT(0x79, 0, 0);
+ SET_IVT(0x79, SEGOFF(0, 0));
- __set_irq(0x1E, &diskette_param_table2);
+ SET_IVT(0x1E, SEGOFF(SEG_BIOS, (u32)&diskette_param_table2 - BUILD_BIOS_ADDR));
}
static void
-init_bda()
+init_bda(void)
{
dprintf(3, "init bda\n");
- struct bios_data_area_s *bda = MAKE_FARPTR(SEG_BDA, 0);
+ struct bios_data_area_s *bda = MAKE_FLATPTR(SEG_BDA, 0);
memset(bda, 0, sizeof(*bda));
- int esize = DIV_ROUND_UP(sizeof(struct extended_bios_data_area_s), 1024);
- SET_BDA(mem_size_kb, 640 - esize);
- u16 eseg = FARPTR_TO_SEG((640 - esize) * 1024);
- SET_BDA(ebda_seg, eseg);
+ int esize = EBDA_SIZE_START;
+ SET_BDA(mem_size_kb, BUILD_LOWRAM_END/1024 - esize);
+ u16 ebda_seg = EBDA_SEGMENT_START;
+ SET_BDA(ebda_seg, ebda_seg);
+ // Init ebda
struct extended_bios_data_area_s *ebda = get_ebda_ptr();
memset(ebda, 0, sizeof(*ebda));
ebda->size = esize;
- SET_IVT(0x41, eseg, offsetof(struct extended_bios_data_area_s, fdpt[0]));
- SET_IVT(0x46, eseg, offsetof(struct extended_bios_data_area_s, fdpt[1]));
+
+ add_e820((u32)MAKE_FLATPTR(ebda_seg, 0), GET_EBDA2(ebda_seg, size) * 1024
+ , E820_RESERVED);
}
static void
{
dprintf(3, "Find memory size\n");
if (CONFIG_COREBOOT) {
- coreboot_fill_map();
+ coreboot_setup();
+ } else if (usingXen()) {
+ xen_setup();
} else {
// On emulators, get memory size from nvram.
u32 rs = ((inb_cmos(CMOS_MEM_EXTMEM2_LOW) << 16)
// Check for memory over 4Gig
u64 high = ((inb_cmos(CMOS_MEM_HIGHMEM_LOW) << 16)
- | (inb_cmos(CMOS_MEM_HIGHMEM_MID) << 24)
+ | ((u32)inb_cmos(CMOS_MEM_HIGHMEM_MID) << 24)
| ((u64)inb_cmos(CMOS_MEM_HIGHMEM_HIGH) << 32));
RamSizeOver4G = high;
add_e820(0x100000000ull, high, E820_RAM);
}
// Don't declare any memory between 0xa0000 and 0x100000
- add_e820(0xa0000, 0x50000, E820_HOLE);
+ add_e820(BUILD_LOWRAM_END, BUILD_BIOS_ADDR-BUILD_LOWRAM_END, E820_HOLE);
// Mark known areas as reserved.
- u16 ebda_seg = get_ebda_seg();
- add_e820((u32)MAKE_FARPTR(ebda_seg, 0), GET_EBDA2(ebda_seg, size) * 1024
- , E820_RESERVED);
add_e820(BUILD_BIOS_ADDR, BUILD_BIOS_SIZE, E820_RESERVED);
- if (CONFIG_KVM)
+ u32 count = qemu_cfg_e820_entries();
+ if (count) {
+ struct e820_reservation entry;
+ int i;
+
+ for (i = 0; i < count; i++) {
+ qemu_cfg_e820_load_next(&entry);
+ add_e820(entry.address, entry.length, entry.type);
+ }
+ } else if (kvm_para_available()) {
+ // Backwards compatibility - provide hard coded range.
// 4 pages before the bios, 3 pages for vmx tss pages, the
// other page for EPT real mode pagetable
add_e820(0xfffbc000, 4*4096, E820_RESERVED);
+ }
- dprintf(1, "Ram Size=0x%08x\n", RamSize);
+ dprintf(1, "Ram Size=0x%08x (0x%08x%08x high)\n"
+ , RamSize, (u32)(RamSizeOver4G >> 32), (u32)RamSizeOver4G);
}
static void
init_bios_tables(void)
{
- if (CONFIG_COREBOOT)
- // XXX - not supported on coreboot yet.
+ if (CONFIG_COREBOOT) {
+ coreboot_copy_biostable();
return;
+ }
+ if (usingXen()) {
+ xen_copy_biostables();
+ return;
+ }
create_pirtable();
acpi_bios_init();
}
+// Initialize hardware devices
static void
-init_boot_vectors()
+init_hw(void)
{
- if (! CONFIG_BOOT)
- return;
- dprintf(3, "init boot device ordering\n");
-
- // Floppy drive
- struct ipl_entry_s *ip = &IPL.table[0];
- ip->type = IPL_TYPE_FLOPPY;
- ip++;
+ usb_setup();
+ ps2port_setup();
+ lpt_setup();
+ serial_setup();
- // First HDD
- ip->type = IPL_TYPE_HARDDISK;
- ip++;
+ floppy_setup();
+ ata_setup();
+ ahci_setup();
+ cbfs_payload_setup();
+ ramdisk_setup();
+ virtio_blk_setup();
+}
- // CDROM
- if (CONFIG_CDROM_BOOT) {
- ip->type = IPL_TYPE_CDROM;
- ip++;
- }
+// Begin the boot process by invoking an int0x19 in 16bit mode.
+void VISIBLE32FLAT
+startBoot(void)
+{
+ // Clear low-memory allocations (required by PMM spec).
+ memset((void*)BUILD_STACK_ADDR, 0, BUILD_EBDA_MINIMUM - BUILD_STACK_ADDR);
- IPL.count = ip - IPL.table;
- SET_EBDA(boot_sequence, 0xffff);
- if (CONFIG_COREBOOT) {
- // XXX - hardcode defaults for coreboot.
- IPL.bootorder = 0x00000231;
- IPL.checkfloppysig = 1;
- } else {
- // On emulators, get boot order from nvram.
- IPL.bootorder = (inb_cmos(CMOS_BIOS_BOOTFLAG2)
- | ((inb_cmos(CMOS_BIOS_BOOTFLAG1) & 0xf0) << 4));
- if (!(inb_cmos(CMOS_BIOS_BOOTFLAG1) & 1))
- IPL.checkfloppysig = 1;
- }
+ dprintf(3, "Jump to int19\n");
+ struct bregs br;
+ memset(&br, 0, sizeof(br));
+ br.flags = F_IF;
+ call16_int(0x19, &br);
}
// Main setup code.
static void
-post()
+maininit(void)
{
+ // Running at new code address - do code relocation fixups
+ malloc_fixupreloc();
+
+ // Setup ivt/bda/ebda
init_ivt();
init_bda();
+ // Init base pc hardware.
pic_setup();
timer_setup();
mathcp_setup();
- smp_probe_setup();
-
- memmap_setup();
- ram_probe();
+ // Initialize mtrr
mtrr_setup();
- pnp_setup();
- vga_setup();
+ // Initialize pci
+ pci_setup();
+ smm_init();
+
+ // Setup Xen hypercalls
+ xen_init_hypercalls();
+ // Initialize internal tables
+ boot_setup();
+
+ // Start hardware initialization (if optionrom threading)
+ if (CONFIG_THREADS && CONFIG_THREAD_OPTIONROMS)
+ init_hw();
+
+ // Find and initialize other cpus
+ smp_probe();
+
+ // Setup interfaces that option roms may need
+ bios32_setup();
+ pmm_setup();
+ pnp_setup();
kbd_setup();
- lpt_setup();
- serial_setup();
mouse_setup();
+ init_bios_tables();
- pci_bios_setup();
- smm_init();
+ // Run vga option rom
+ vga_setup();
- init_bios_tables();
+ // Do hardware initialization (if running synchronously)
+ if (!CONFIG_THREADS || !CONFIG_THREAD_OPTIONROMS) {
+ init_hw();
+ wait_threads();
+ }
+
+ // Run option roms
+ optionrom_setup();
+
+ // Run BCVs and show optional boot menu
+ boot_prep();
+
+ // Finalize data structures before boot
+ cdemu_setup();
+ pmm_finalize();
+ malloc_finalize();
memmap_finalize();
- floppy_drive_setup();
- hard_drive_setup();
+ // Setup bios checksum.
+ BiosChecksum -= checksum((u8*)BUILD_BIOS_ADDR, BUILD_BIOS_SIZE);
- init_boot_vectors();
+ // Write protect bios memory.
+ make_bios_readonly();
- optionrom_setup();
+ // Invoke int 19 to start boot process.
+ startBoot();
+}
+
+
+/****************************************************************
+ * POST entry and code relocation
+ ****************************************************************/
+
+// Update given relocs for the code at 'dest' with a given 'delta'
+static void
+updateRelocs(void *dest, u32 *rstart, u32 *rend, u32 delta)
+{
+ u32 *reloc;
+ for (reloc = rstart; reloc < rend; reloc++)
+ *((u32*)(dest + *reloc)) += delta;
}
-// 32-bit entry point.
-void VISIBLE32
-_start()
+// Relocate init code and then call maininit() at new address.
+static void
+reloc_init(void)
{
- init_dma();
+ if (!CONFIG_RELOCATE_INIT) {
+ maininit();
+ return;
+ }
+ // Symbols populated by the build.
+ extern u8 code32flat_start[];
+ extern u8 _reloc_min_align[];
+ extern u32 _reloc_abs_start[], _reloc_abs_end[];
+ extern u32 _reloc_rel_start[], _reloc_rel_end[];
+ extern u32 _reloc_init_start[], _reloc_init_end[];
+ extern u8 code32init_start[], code32init_end[];
+
+ // Allocate space for init code.
+ u32 initsize = code32init_end - code32init_start;
+ u32 align = (u32)&_reloc_min_align;
+ void *dest = memalign_tmp(align, initsize);
+ if (!dest)
+ panic("No space for init relocation.\n");
+
+ // Copy code and update relocs (init absolute, init relative, and runtime)
+ dprintf(1, "Relocating init from %p to %p (size %d)\n"
+ , code32init_start, dest, initsize);
+ s32 delta = dest - (void*)code32init_start;
+ memcpy(dest, code32init_start, initsize);
+ updateRelocs(dest, _reloc_abs_start, _reloc_abs_end, delta);
+ updateRelocs(dest, _reloc_rel_start, _reloc_rel_end, -delta);
+ updateRelocs(code32flat_start, _reloc_init_start, _reloc_init_end, delta);
+
+ // Call maininit() in relocated code.
+ void (*func)(void) = (void*)maininit + delta;
+ barrier();
+ func();
+}
+// Setup for code relocation and then call reloc_init
+void VISIBLE32INIT
+dopost(void)
+{
+ HaveRunPost = 1;
+
+ // Detect ram and setup internal malloc.
+ qemu_cfg_port_probe();
+ ram_probe();
+ malloc_setup();
+
+ // Relocate initialization code and call maininit().
+ reloc_init();
+}
+
+// Entry point for Power On Self Test (POST) - the BIOS initilization
+// phase. This function makes the memory at 0xc0000-0xfffff
+// read/writable and then calls dopost().
+void VISIBLE32FLAT
+handle_post(void)
+{
debug_serial_setup();
- dprintf(1, "Start bios\n");
+ dprintf(1, "Start bios (version %s)\n", VERSION);
- // Allow writes to modify bios area (0xf0000)
- make_bios_writable();
+ // Enable CPU caching
+ setcr0(getcr0() & ~(CR0_CD|CR0_NW));
- // Perform main setup code.
- post();
+ // Clear CMOS reboot flag.
+ outb_cmos(0, CMOS_RESET_CODE);
- // Present the user with a bootup menu.
- interactive_bootmenu();
+ // Make sure legacy DMA isn't running.
+ init_dma();
- // Setup bios checksum.
- BiosChecksum = -checksum((u8*)BUILD_BIOS_ADDR, BUILD_BIOS_SIZE - 1);
+ // Check if we are running under Xen.
+ xen_probe();
- // Prep for boot process.
- make_bios_readonly();
+ // Allow writes to modify bios area (0xf0000)
+ make_bios_writable();
- // Invoke int 19 to start boot process.
- dprintf(3, "Jump to int19\n");
- struct bregs br;
- memset(&br, 0, sizeof(br));
- call16_int(0x19, &br);
+ // Now that memory is read/writable - start post process.
+ dopost();
}
-
-// Ughh - some older gcc compilers have a bug which causes VISIBLE32
-// functions to not be exported as a global variable - force _start
-// to be global here.
-asm(".global _start");