|
|
1.1 root 1: // 32bit code to Power On Self Test (POST) a machine.
2: //
1.1.1.4 root 3: // Copyright (C) 2008-2010 Kevin O'Connor <[email protected]>
1.1 root 4: // Copyright (C) 2002 MandrakeSoft S.A.
5: //
6: // This file may be distributed under the terms of the GNU LGPLv3 license.
7:
8: #include "ioport.h" // PORT_*
9: #include "config.h" // CONFIG_*
10: #include "cmos.h" // CMOS_*
11: #include "util.h" // memset
12: #include "biosvar.h" // struct bios_data_area_s
13: #include "disk.h" // floppy_drive_setup
14: #include "ata.h" // ata_setup
1.1.1.5 ! root 15: #include "ahci.h" // ahci_setup
1.1 root 16: #include "memmap.h" // add_e820
17: #include "pic.h" // pic_setup
18: #include "pci.h" // create_pirtable
19: #include "acpi.h" // acpi_bios_init
20: #include "bregs.h" // struct bregs
21: #include "mptable.h" // mptable_init
22: #include "boot.h" // IPL
23: #include "usb.h" // usb_setup
24: #include "smbios.h" // smbios_init
25: #include "paravirt.h" // qemu_cfg_port_probe
26: #include "ps2port.h" // ps2port_setup
1.1.1.3 root 27: #include "virtio-blk.h" // virtio_blk_setup
1.1 root 28:
1.1.1.5 ! root 29:
! 30: /****************************************************************
! 31: * BIOS init
! 32: ****************************************************************/
! 33:
1.1 root 34: static void
1.1.1.2 root 35: init_ivt(void)
1.1 root 36: {
37: dprintf(3, "init ivt\n");
38:
39: // Initialize all vectors to the default handler.
40: int i;
41: for (i=0; i<256; i++)
1.1.1.4 root 42: SET_IVT(i, FUNC16(entry_iret_official));
1.1 root 43:
44: // Initialize all hw vectors to a default hw handler.
45: for (i=0x08; i<=0x0f; i++)
1.1.1.4 root 46: SET_IVT(i, FUNC16(entry_hwpic1));
1.1 root 47: for (i=0x70; i<=0x77; i++)
1.1.1.4 root 48: SET_IVT(i, FUNC16(entry_hwpic2));
1.1 root 49:
50: // Initialize software handlers.
1.1.1.4 root 51: SET_IVT(0x02, FUNC16(entry_02));
52: SET_IVT(0x10, FUNC16(entry_10));
53: SET_IVT(0x11, FUNC16(entry_11));
54: SET_IVT(0x12, FUNC16(entry_12));
55: SET_IVT(0x13, FUNC16(entry_13_official));
56: SET_IVT(0x14, FUNC16(entry_14));
57: SET_IVT(0x15, FUNC16(entry_15));
58: SET_IVT(0x16, FUNC16(entry_16));
59: SET_IVT(0x17, FUNC16(entry_17));
60: SET_IVT(0x18, FUNC16(entry_18));
61: SET_IVT(0x19, FUNC16(entry_19_official));
62: SET_IVT(0x1a, FUNC16(entry_1a));
63: SET_IVT(0x40, FUNC16(entry_40));
1.1 root 64:
1.1.1.2 root 65: // INT 60h-66h reserved for user interrupt
66: for (i=0x60; i<=0x66; i++)
67: SET_IVT(i, SEGOFF(0, 0));
68:
1.1 root 69: // set vector 0x79 to zero
70: // this is used by 'gardian angel' protection system
71: SET_IVT(0x79, SEGOFF(0, 0));
72:
1.1.1.4 root 73: SET_IVT(0x1E, SEGOFF(SEG_BIOS, (u32)&diskette_param_table2 - BUILD_BIOS_ADDR));
1.1 root 74: }
75:
76: static void
1.1.1.2 root 77: init_bda(void)
1.1 root 78: {
79: dprintf(3, "init bda\n");
80:
81: struct bios_data_area_s *bda = MAKE_FLATPTR(SEG_BDA, 0);
82: memset(bda, 0, sizeof(*bda));
83:
84: int esize = EBDA_SIZE_START;
85: SET_BDA(mem_size_kb, BUILD_LOWRAM_END/1024 - esize);
1.1.1.5 ! root 86: u16 ebda_seg = EBDA_SEGMENT_START;
! 87: SET_BDA(ebda_seg, ebda_seg);
1.1 root 88:
89: // Init ebda
90: struct extended_bios_data_area_s *ebda = get_ebda_ptr();
91: memset(ebda, 0, sizeof(*ebda));
92: ebda->size = esize;
1.1.1.5 ! root 93:
! 94: add_e820((u32)MAKE_FLATPTR(ebda_seg, 0), GET_EBDA2(ebda_seg, size) * 1024
! 95: , E820_RESERVED);
1.1 root 96: }
97:
98: static void
99: ram_probe(void)
100: {
101: dprintf(3, "Find memory size\n");
102: if (CONFIG_COREBOOT) {
103: coreboot_setup();
104: } else {
105: // On emulators, get memory size from nvram.
106: u32 rs = ((inb_cmos(CMOS_MEM_EXTMEM2_LOW) << 16)
107: | (inb_cmos(CMOS_MEM_EXTMEM2_HIGH) << 24));
108: if (rs)
109: rs += 16 * 1024 * 1024;
110: else
111: rs = (((inb_cmos(CMOS_MEM_EXTMEM_LOW) << 10)
112: | (inb_cmos(CMOS_MEM_EXTMEM_HIGH) << 18))
113: + 1 * 1024 * 1024);
114: RamSize = rs;
115: add_e820(0, rs, E820_RAM);
116:
117: // Check for memory over 4Gig
118: u64 high = ((inb_cmos(CMOS_MEM_HIGHMEM_LOW) << 16)
1.1.1.2 root 119: | ((u32)inb_cmos(CMOS_MEM_HIGHMEM_MID) << 24)
1.1 root 120: | ((u64)inb_cmos(CMOS_MEM_HIGHMEM_HIGH) << 32));
121: RamSizeOver4G = high;
122: add_e820(0x100000000ull, high, E820_RAM);
123:
124: /* reserve 256KB BIOS area at the end of 4 GB */
125: add_e820(0xfffc0000, 256*1024, E820_RESERVED);
126: }
127:
128: // Don't declare any memory between 0xa0000 and 0x100000
129: add_e820(BUILD_LOWRAM_END, BUILD_BIOS_ADDR-BUILD_LOWRAM_END, E820_HOLE);
130:
131: // Mark known areas as reserved.
132: add_e820(BUILD_BIOS_ADDR, BUILD_BIOS_SIZE, E820_RESERVED);
133:
1.1.1.3 root 134: u32 count = qemu_cfg_e820_entries();
135: if (count) {
136: struct e820_reservation entry;
137: int i;
138:
139: for (i = 0; i < count; i++) {
140: qemu_cfg_e820_load_next(&entry);
141: add_e820(entry.address, entry.length, entry.type);
142: }
143: } else if (kvm_para_available()) {
144: // Backwards compatibility - provide hard coded range.
1.1 root 145: // 4 pages before the bios, 3 pages for vmx tss pages, the
146: // other page for EPT real mode pagetable
147: add_e820(0xfffbc000, 4*4096, E820_RESERVED);
1.1.1.3 root 148: }
1.1 root 149:
1.1.1.2 root 150: dprintf(1, "Ram Size=0x%08x (0x%08x%08x high)\n"
151: , RamSize, (u32)(RamSizeOver4G >> 32), (u32)RamSizeOver4G);
1.1 root 152: }
153:
154: static void
155: init_bios_tables(void)
156: {
157: if (CONFIG_COREBOOT) {
158: coreboot_copy_biostable();
159: return;
160: }
161:
162: create_pirtable();
163:
164: mptable_init();
165:
166: smbios_init();
167:
168: acpi_bios_init();
169: }
170:
1.1.1.3 root 171: // Initialize hardware devices
172: static void
173: init_hw(void)
174: {
175: usb_setup();
176: ps2port_setup();
177: lpt_setup();
178: serial_setup();
179:
180: floppy_setup();
181: ata_setup();
1.1.1.5 ! root 182: ahci_setup();
! 183: cbfs_payload_setup();
1.1.1.3 root 184: ramdisk_setup();
185: virtio_blk_setup();
186: }
187:
1.1.1.5 ! root 188: // Begin the boot process by invoking an int0x19 in 16bit mode.
! 189: void VISIBLE32FLAT
! 190: startBoot(void)
! 191: {
! 192: // Clear low-memory allocations (required by PMM spec).
! 193: memset((void*)BUILD_STACK_ADDR, 0, BUILD_EBDA_MINIMUM - BUILD_STACK_ADDR);
! 194:
! 195: dprintf(3, "Jump to int19\n");
! 196: struct bregs br;
! 197: memset(&br, 0, sizeof(br));
! 198: br.flags = F_IF;
! 199: call16_int(0x19, &br);
! 200: }
! 201:
1.1 root 202: // Main setup code.
203: static void
1.1.1.5 ! root 204: maininit(void)
1.1 root 205: {
1.1.1.5 ! root 206: // Setup ivt/bda/ebda
1.1 root 207: init_ivt();
208: init_bda();
209:
210: // Init base pc hardware.
211: pic_setup();
212: timer_setup();
213: mathcp_setup();
214:
1.1.1.3 root 215: // Initialize mtrr
1.1 root 216: mtrr_setup();
217:
218: // Initialize pci
219: pci_setup();
1.1.1.5 ! root 220: pci_path_setup();
1.1 root 221: smm_init();
222:
1.1.1.3 root 223: // Initialize internal tables
224: boot_setup();
225:
226: // Start hardware initialization (if optionrom threading)
227: if (CONFIG_THREADS && CONFIG_THREAD_OPTIONROMS)
228: init_hw();
229:
230: // Find and initialize other cpus
231: smp_probe();
232:
1.1 root 233: // Setup interfaces that option roms may need
1.1.1.2 root 234: bios32_setup();
1.1 root 235: pmm_setup();
236: pnp_setup();
237: kbd_setup();
238: mouse_setup();
239: init_bios_tables();
240:
1.1.1.3 root 241: // Run vga option rom
242: vga_setup();
1.1 root 243:
1.1.1.3 root 244: // Do hardware initialization (if running synchronously)
245: if (!CONFIG_THREADS || !CONFIG_THREAD_OPTIONROMS) {
246: init_hw();
1.1 root 247: wait_threads();
248: }
249:
1.1.1.3 root 250: // Run option roms
251: optionrom_setup();
252:
1.1 root 253: // Run BCVs and show optional boot menu
254: boot_prep();
255:
256: // Finalize data structures before boot
1.1.1.3 root 257: cdemu_setup();
1.1 root 258: pmm_finalize();
259: malloc_finalize();
260: memmap_finalize();
1.1.1.5 ! root 261:
! 262: // Setup bios checksum.
! 263: BiosChecksum -= checksum((u8*)BUILD_BIOS_ADDR, BUILD_BIOS_SIZE);
! 264:
! 265: // Write protect bios memory.
! 266: make_bios_readonly();
! 267:
! 268: // Invoke int 19 to start boot process.
! 269: startBoot();
! 270: }
! 271:
! 272:
! 273: /****************************************************************
! 274: * Code relocation
! 275: ****************************************************************/
! 276:
! 277: // Update given relocs for the code at 'dest' with a given 'delta'
! 278: static void
! 279: updateRelocs(void *dest, u32 *rstart, u32 *rend, u32 delta)
! 280: {
! 281: u32 *reloc;
! 282: for (reloc = rstart; reloc < rend; reloc++)
! 283: *((u32*)(dest + *reloc)) += delta;
! 284: }
! 285:
! 286: // Start of Power On Self Test - the BIOS initilization. This
! 287: // function sets up for and attempts relocation of the init code.
! 288: static void
! 289: reloc_init(void)
! 290: {
! 291: if (!CONFIG_RELOCATE_INIT) {
! 292: maininit();
! 293: return;
! 294: }
! 295: // Symbols populated by the build.
! 296: extern u8 code32flat_start[];
! 297: extern u8 _reloc_min_align[];
! 298: extern u32 _reloc_abs_start[], _reloc_abs_end[];
! 299: extern u32 _reloc_rel_start[], _reloc_rel_end[];
! 300: extern u32 _reloc_init_start[], _reloc_init_end[];
! 301: extern u8 code32init_start[], code32init_end[];
! 302:
! 303: // Allocate space for init code.
! 304: u32 initsize = code32init_end - code32init_start;
! 305: u32 align = (u32)&_reloc_min_align;
! 306: void *dest = memalign_tmp(align, initsize);
! 307: if (!dest)
! 308: panic("No space for init relocation.\n");
! 309:
! 310: // Copy code and update relocs (init absolute, init relative, and runtime)
! 311: dprintf(1, "Relocating init from %p to %p (size %d)\n"
! 312: , code32init_start, dest, initsize);
! 313: s32 delta = dest - (void*)code32init_start;
! 314: memcpy(dest, code32init_start, initsize);
! 315: updateRelocs(dest, _reloc_abs_start, _reloc_abs_end, delta);
! 316: updateRelocs(dest, _reloc_rel_start, _reloc_rel_end, -delta);
! 317: updateRelocs(code32flat_start, _reloc_init_start, _reloc_init_end, delta);
! 318:
! 319: // Call maininit() in relocated code.
! 320: void (*func)(void) = (void*)maininit + delta;
! 321: barrier();
! 322: func();
! 323: }
! 324:
! 325: // Start of Power On Self Test (POST) - the BIOS initilization phase.
! 326: // This function sets up for and attempts relocation of the init code.
! 327: void VISIBLE32INIT
! 328: post(void)
! 329: {
! 330: // Detect ram and setup internal malloc.
! 331: qemu_cfg_port_probe();
! 332: ram_probe();
! 333: malloc_setup();
! 334:
! 335: reloc_init();
! 336: }
! 337:
! 338:
! 339: /****************************************************************
! 340: * POST entry point
! 341: ****************************************************************/
! 342:
! 343: static int HaveRunPost;
! 344:
! 345: // Attempt to invoke a hard-reboot.
! 346: static void
! 347: tryReboot(void)
! 348: {
! 349: dprintf(1, "Attempting a hard reboot\n");
! 350:
! 351: // Setup for reset on qemu.
! 352: if (! CONFIG_COREBOOT) {
! 353: qemu_prep_reset();
! 354: if (HaveRunPost)
! 355: apm_shutdown();
! 356: }
! 357:
! 358: // Try keyboard controller reboot.
! 359: i8042_reboot();
! 360:
! 361: // Try PCI 0xcf9 reboot
! 362: pci_reboot();
! 363:
! 364: // Try triple fault
! 365: asm volatile("int3");
! 366:
! 367: panic("Could not reboot");
1.1 root 368: }
369:
370: // 32-bit entry point.
1.1.1.2 root 371: void VISIBLE32FLAT
372: _start(void)
1.1 root 373: {
374: init_dma();
375:
376: debug_serial_setup();
377: dprintf(1, "Start bios (version %s)\n", VERSION);
378:
1.1.1.5 ! root 379: if (HaveRunPost)
! 380: // This is a soft reboot - invoke a hard reboot.
! 381: tryReboot();
! 382:
1.1 root 383: // Allow writes to modify bios area (0xf0000)
384: make_bios_writable();
1.1.1.5 ! root 385: HaveRunPost = 1;
1.1 root 386:
387: // Perform main setup code.
388: post();
389: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.