blob: 3705c3b16fc2075030cd87530c9df93f6b7d2b02 [file] [log] [blame]
Kevin O'Connorf076a3e2008-02-25 22:25:15 -05001// 32bit code to Power On Self Test (POST) a machine.
2//
Kevin O'Connorcadaf0e2010-07-26 23:47:26 -04003// Copyright (C) 2008-2010 Kevin O'Connor <kevin@koconnor.net>
Kevin O'Connorf076a3e2008-02-25 22:25:15 -05004// Copyright (C) 2002 MandrakeSoft S.A.
5//
Kevin O'Connorb1b7c2a2009-01-15 20:52:58 -05006// This file may be distributed under the terms of the GNU LGPLv3 license.
Kevin O'Connorf076a3e2008-02-25 22:25:15 -05007
8#include "ioport.h" // PORT_*
Kevin O'Connorf076a3e2008-02-25 22:25:15 -05009#include "config.h" // CONFIG_*
10#include "cmos.h" // CMOS_*
11#include "util.h" // memset
12#include "biosvar.h" // struct bios_data_area_s
Kevin O'Connor3bbcc142008-04-13 17:07:33 -040013#include "disk.h" // floppy_drive_setup
Kevin O'Connorc892b132009-08-11 21:59:37 -040014#include "ata.h" // ata_setup
Gerd Hoffmannd52fdf62010-11-29 09:42:13 +010015#include "ahci.h" // ahci_setup
Kevin O'Connorc7812932008-06-08 23:08:12 -040016#include "memmap.h" // add_e820
Kevin O'Connorf54c1502008-06-14 15:56:16 -040017#include "pic.h" // pic_setup
Kevin O'Connor0525d292008-07-04 06:18:30 -040018#include "pci.h" // create_pirtable
19#include "acpi.h" // acpi_bios_init
Kevin O'Connor9521e262008-07-04 13:04:29 -040020#include "bregs.h" // struct bregs
Kevin O'Connor35746442009-02-27 20:54:51 -050021#include "mptable.h" // mptable_init
Kevin O'Connorc659fde2008-12-28 23:43:20 -050022#include "boot.h" // IPL
Kevin O'Connor114592f2009-09-28 21:32:08 -040023#include "usb.h" // usb_setup
Kevin O'Connor01a85202009-10-18 09:49:59 -040024#include "smbios.h" // smbios_init
25#include "paravirt.h" // qemu_cfg_port_probe
Ian Campbell74c78782011-06-01 11:00:29 +010026#include "xen.h" // xen_probe_hvm_info
Kevin O'Connor57877482009-12-09 21:00:41 -050027#include "ps2port.h" // ps2port_setup
Gleb Natapov89acfa32010-05-10 11:36:37 +030028#include "virtio-blk.h" // virtio_blk_setup
Paolo Bonzinic5c488f2012-02-27 17:22:23 +010029#include "virtio-scsi.h" // virtio_scsi_setup
Gerd Hoffmann9d6bac12012-07-20 10:59:25 +020030#include "lsi-scsi.h" // lsi_scsi_setup
Paolo Bonzini7a39e722012-08-06 13:15:06 +020031#include "esp-scsi.h" // esp_scsi_setup
Hannes Reinecke2df70bf2012-11-13 15:03:31 +010032#include "megasas.h" // megasas_setup
Kevin O'Connor025cabd2010-09-15 21:59:11 -040033
34/****************************************************************
35 * BIOS init
36 ****************************************************************/
37
Kevin O'Connore3677b12008-07-04 15:29:23 -040038static void
Kevin O'Connor1ca05b02010-01-03 17:43:37 -050039init_ivt(void)
Kevin O'Connorf076a3e2008-02-25 22:25:15 -050040{
Kevin O'Connor8c0e3722009-01-02 14:19:43 -050041 dprintf(3, "init ivt\n");
Kevin O'Connorf076a3e2008-02-25 22:25:15 -050042
Kevin O'Connord67a7032009-01-17 19:37:26 -050043 // Initialize all vectors to the default handler.
Kevin O'Connorf076a3e2008-02-25 22:25:15 -050044 int i;
Kevin O'Connore3677b12008-07-04 15:29:23 -040045 for (i=0; i<256; i++)
Kevin O'Connorcc9e1bf2010-07-28 21:31:38 -040046 SET_IVT(i, FUNC16(entry_iret_official));
Kevin O'Connorf076a3e2008-02-25 22:25:15 -050047
Kevin O'Connord21c0892008-11-26 17:02:43 -050048 // Initialize all hw vectors to a default hw handler.
49 for (i=0x08; i<=0x0f; i++)
Kevin O'Connorcc9e1bf2010-07-28 21:31:38 -040050 SET_IVT(i, FUNC16(entry_hwpic1));
Kevin O'Connord21c0892008-11-26 17:02:43 -050051 for (i=0x70; i<=0x77; i++)
Kevin O'Connorcc9e1bf2010-07-28 21:31:38 -040052 SET_IVT(i, FUNC16(entry_hwpic2));
Kevin O'Connord21c0892008-11-26 17:02:43 -050053
54 // Initialize software handlers.
Kevin O'Connorcc9e1bf2010-07-28 21:31:38 -040055 SET_IVT(0x02, FUNC16(entry_02));
56 SET_IVT(0x10, FUNC16(entry_10));
57 SET_IVT(0x11, FUNC16(entry_11));
58 SET_IVT(0x12, FUNC16(entry_12));
59 SET_IVT(0x13, FUNC16(entry_13_official));
60 SET_IVT(0x14, FUNC16(entry_14));
61 SET_IVT(0x15, FUNC16(entry_15));
62 SET_IVT(0x16, FUNC16(entry_16));
63 SET_IVT(0x17, FUNC16(entry_17));
64 SET_IVT(0x18, FUNC16(entry_18));
65 SET_IVT(0x19, FUNC16(entry_19_official));
66 SET_IVT(0x1a, FUNC16(entry_1a));
67 SET_IVT(0x40, FUNC16(entry_40));
Kevin O'Connorf076a3e2008-02-25 22:25:15 -050068
Kevin O'Connorb164d2c2009-12-26 23:24:52 -050069 // INT 60h-66h reserved for user interrupt
70 for (i=0x60; i<=0x66; i++)
71 SET_IVT(i, SEGOFF(0, 0));
72
Kevin O'Connorf076a3e2008-02-25 22:25:15 -050073 // set vector 0x79 to zero
74 // this is used by 'gardian angel' protection system
Kevin O'Connor9f985422009-09-09 11:34:39 -040075 SET_IVT(0x79, SEGOFF(0, 0));
Kevin O'Connorf076a3e2008-02-25 22:25:15 -050076}
77
78static void
Kevin O'Connor1ca05b02010-01-03 17:43:37 -050079init_bda(void)
Kevin O'Connorf076a3e2008-02-25 22:25:15 -050080{
Kevin O'Connor8c0e3722009-01-02 14:19:43 -050081 dprintf(3, "init bda\n");
82
Kevin O'Connor35ae7262009-01-19 15:44:44 -050083 struct bios_data_area_s *bda = MAKE_FLATPTR(SEG_BDA, 0);
Kevin O'Connor8c0e3722009-01-02 14:19:43 -050084 memset(bda, 0, sizeof(*bda));
85
Kevin O'Connor49553a42009-05-17 10:31:34 -040086 int esize = EBDA_SIZE_START;
Kevin O'Connorf416fe92009-09-24 20:51:55 -040087 SET_BDA(mem_size_kb, BUILD_LOWRAM_END/1024 - esize);
Kevin O'Connor025cabd2010-09-15 21:59:11 -040088 u16 ebda_seg = EBDA_SEGMENT_START;
89 SET_BDA(ebda_seg, ebda_seg);
Kevin O'Connor4d7c37e2008-12-26 23:50:17 -050090
Kevin O'Connor9becbf12009-07-12 09:29:46 -040091 // Init ebda
Kevin O'Connor4d7c37e2008-12-26 23:50:17 -050092 struct extended_bios_data_area_s *ebda = get_ebda_ptr();
Kevin O'Connor38fcbfe2008-02-25 22:30:47 -050093 memset(ebda, 0, sizeof(*ebda));
Kevin O'Connor4d7c37e2008-12-26 23:50:17 -050094 ebda->size = esize;
Kevin O'Connor025cabd2010-09-15 21:59:11 -040095
Kevin O'Connor4bc49972012-05-13 22:58:08 -040096 add_e820((u32)MAKE_FLATPTR(ebda_seg, 0), GET_EBDA(ebda_seg, size) * 1024
Kevin O'Connor025cabd2010-09-15 21:59:11 -040097 , E820_RESERVED);
Kevin O'Connorbf2e8c22012-05-28 12:59:58 -040098
99 // Init extra stack
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400100 StackPos = (void*)(&ExtraStack[BUILD_EXTRA_STACK_SIZE] - datalow_base);
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500101}
102
103static void
Kevin O'Connor9571ac22008-05-17 22:20:27 -0400104ram_probe(void)
105{
Kevin O'Connor35192dd2008-06-08 19:18:33 -0400106 dprintf(3, "Find memory size\n");
Kevin O'Connorf64f0db2008-05-18 02:42:58 -0400107 if (CONFIG_COREBOOT) {
Kevin O'Connor4c0c85a2009-04-11 23:31:29 -0400108 coreboot_setup();
Ian Campbell74c78782011-06-01 11:00:29 +0100109 } else if (usingXen()) {
Kevin O'Connor7a08ae72012-03-14 21:11:39 -0400110 xen_setup();
Kevin O'Connorf64f0db2008-05-18 02:42:58 -0400111 } else {
112 // On emulators, get memory size from nvram.
Kevin O'Connor59c35f22008-10-25 23:05:42 -0400113 u32 rs = ((inb_cmos(CMOS_MEM_EXTMEM2_LOW) << 16)
114 | (inb_cmos(CMOS_MEM_EXTMEM2_HIGH) << 24));
Kevin O'Connorf64f0db2008-05-18 02:42:58 -0400115 if (rs)
116 rs += 16 * 1024 * 1024;
117 else
Kevin O'Connor59c35f22008-10-25 23:05:42 -0400118 rs = (((inb_cmos(CMOS_MEM_EXTMEM_LOW) << 10)
119 | (inb_cmos(CMOS_MEM_EXTMEM_HIGH) << 18))
Kevin O'Connorf64f0db2008-05-18 02:42:58 -0400120 + 1 * 1024 * 1024);
Kevin O'Connore7916362008-12-28 22:03:17 -0500121 RamSize = rs;
Kevin O'Connorc7812932008-06-08 23:08:12 -0400122 add_e820(0, rs, E820_RAM);
123
Kevin O'Connor59c35f22008-10-25 23:05:42 -0400124 // Check for memory over 4Gig
125 u64 high = ((inb_cmos(CMOS_MEM_HIGHMEM_LOW) << 16)
Kevin O'Connor669c9912010-01-05 19:50:04 -0500126 | ((u32)inb_cmos(CMOS_MEM_HIGHMEM_MID) << 24)
Kevin O'Connor59c35f22008-10-25 23:05:42 -0400127 | ((u64)inb_cmos(CMOS_MEM_HIGHMEM_HIGH) << 32));
Kevin O'Connore7916362008-12-28 22:03:17 -0500128 RamSizeOver4G = high;
Kevin O'Connor59c35f22008-10-25 23:05:42 -0400129 add_e820(0x100000000ull, high, E820_RAM);
130
Kevin O'Connorc7812932008-06-08 23:08:12 -0400131 /* reserve 256KB BIOS area at the end of 4 GB */
132 add_e820(0xfffc0000, 256*1024, E820_RESERVED);
Kevin O'Connorf64f0db2008-05-18 02:42:58 -0400133 }
Kevin O'Connor9571ac22008-05-17 22:20:27 -0400134
Kevin O'Connorb8d7a472008-06-21 11:43:32 -0400135 // Don't declare any memory between 0xa0000 and 0x100000
Kevin O'Connorf416fe92009-09-24 20:51:55 -0400136 add_e820(BUILD_LOWRAM_END, BUILD_BIOS_ADDR-BUILD_LOWRAM_END, E820_HOLE);
Kevin O'Connorb8d7a472008-06-21 11:43:32 -0400137
Kevin O'Connorc7812932008-06-08 23:08:12 -0400138 // Mark known areas as reserved.
Kevin O'Connore3677b12008-07-04 15:29:23 -0400139 add_e820(BUILD_BIOS_ADDR, BUILD_BIOS_SIZE, E820_RESERVED);
Kevin O'Connorc7812932008-06-08 23:08:12 -0400140
Jes Sorensen0360e8e2010-02-16 09:46:08 +0100141 u32 count = qemu_cfg_e820_entries();
142 if (count) {
143 struct e820_reservation entry;
144 int i;
145
146 for (i = 0; i < count; i++) {
147 qemu_cfg_e820_load_next(&entry);
148 add_e820(entry.address, entry.length, entry.type);
149 }
150 } else if (kvm_para_available()) {
151 // Backwards compatibility - provide hard coded range.
Kevin O'Connor7061eb62009-01-04 21:48:22 -0500152 // 4 pages before the bios, 3 pages for vmx tss pages, the
153 // other page for EPT real mode pagetable
154 add_e820(0xfffbc000, 4*4096, E820_RESERVED);
Jes Sorensen0360e8e2010-02-16 09:46:08 +0100155 }
Kevin O'Connor7061eb62009-01-04 21:48:22 -0500156
Kevin O'Connorc04090d2012-03-05 10:14:07 -0500157 dprintf(1, "Ram Size=0x%08x (0x%016llx high)\n", RamSize, RamSizeOver4G);
Kevin O'Connor9571ac22008-05-17 22:20:27 -0400158}
159
160static void
Kevin O'Connor0525d292008-07-04 06:18:30 -0400161init_bios_tables(void)
162{
Kevin O'Connordf5a5fd2009-07-28 20:46:03 -0400163 if (CONFIG_COREBOOT) {
164 coreboot_copy_biostable();
Kevin O'Connor0525d292008-07-04 06:18:30 -0400165 return;
Kevin O'Connordf5a5fd2009-07-28 20:46:03 -0400166 }
Ian Campbell74c78782011-06-01 11:00:29 +0100167 if (usingXen()) {
Kevin O'Connor7a08ae72012-03-14 21:11:39 -0400168 xen_copy_biostables();
169 return;
Ian Campbell74c78782011-06-01 11:00:29 +0100170 }
Kevin O'Connor0525d292008-07-04 06:18:30 -0400171
Kevin O'Connor0525d292008-07-04 06:18:30 -0400172 create_pirtable();
173
174 mptable_init();
175
176 smbios_init();
177
178 acpi_bios_init();
179}
180
Kevin O'Connore438b0c2010-05-01 12:20:33 -0400181// Initialize hardware devices
182static void
183init_hw(void)
184{
185 usb_setup();
186 ps2port_setup();
187 lpt_setup();
188 serial_setup();
189
190 floppy_setup();
191 ata_setup();
Gerd Hoffmannd52fdf62010-11-29 09:42:13 +0100192 ahci_setup();
Kevin O'Connor89a1efd2011-01-08 12:24:39 -0500193 cbfs_payload_setup();
Kevin O'Connore438b0c2010-05-01 12:20:33 -0400194 ramdisk_setup();
Gleb Natapov89acfa32010-05-10 11:36:37 +0300195 virtio_blk_setup();
Paolo Bonzinic5c488f2012-02-27 17:22:23 +0100196 virtio_scsi_setup();
Gerd Hoffmann9d6bac12012-07-20 10:59:25 +0200197 lsi_scsi_setup();
Paolo Bonzini7a39e722012-08-06 13:15:06 +0200198 esp_scsi_setup();
Hannes Reinecke2df70bf2012-11-13 15:03:31 +0100199 megasas_setup();
Kevin O'Connore438b0c2010-05-01 12:20:33 -0400200}
201
Kevin O'Connor025cabd2010-09-15 21:59:11 -0400202// Begin the boot process by invoking an int0x19 in 16bit mode.
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400203void VISIBLE32FLAT
Kevin O'Connor025cabd2010-09-15 21:59:11 -0400204startBoot(void)
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500205{
Kevin O'Connor025cabd2010-09-15 21:59:11 -0400206 // Clear low-memory allocations (required by PMM spec).
207 memset((void*)BUILD_STACK_ADDR, 0, BUILD_EBDA_MINIMUM - BUILD_STACK_ADDR);
208
209 dprintf(3, "Jump to int19\n");
210 struct bregs br;
211 memset(&br, 0, sizeof(br));
212 br.flags = F_IF;
213 call16_int(0x19, &br);
214}
215
216// Main setup code.
217static void
218maininit(void)
219{
Kevin O'Connor59d6ca52012-05-31 00:20:55 -0400220 // Setup romfile items.
221 qemu_cfg_romfile_setup();
222 coreboot_cbfs_setup();
223
Kevin O'Connor025cabd2010-09-15 21:59:11 -0400224 // Setup ivt/bda/ebda
Kevin O'Connor8c0e3722009-01-02 14:19:43 -0500225 init_ivt();
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500226 init_bda();
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500227
Kevin O'Connor969df602009-11-25 19:05:04 -0500228 // Init base pc hardware.
Kevin O'Connorf54c1502008-06-14 15:56:16 -0400229 pic_setup();
Kevin O'Connore6eb3f52008-04-13 17:37:41 -0400230 timer_setup();
Kevin O'Connor714325c2008-11-01 20:32:27 -0400231 mathcp_setup();
232
Kevin O'Connor969df602009-11-25 19:05:04 -0500233 // Initialize pci
Kevin O'Connor40f5b5a2009-09-13 10:46:57 -0400234 pci_setup();
235 smm_init();
236
Jason Barona39a9c32012-11-28 10:17:30 +0100237 // Initialize mtrr
238 mtrr_setup();
239
Ian Campbell7fc039e2011-07-13 11:46:40 +0100240 // Setup Xen hypercalls
241 xen_init_hypercalls();
242
Kevin O'Connore438b0c2010-05-01 12:20:33 -0400243 // Initialize internal tables
244 boot_setup();
Kevin O'Connore438b0c2010-05-01 12:20:33 -0400245
246 // Start hardware initialization (if optionrom threading)
247 if (CONFIG_THREADS && CONFIG_THREAD_OPTIONROMS)
248 init_hw();
249
250 // Find and initialize other cpus
251 smp_probe();
252
Kevin O'Connor98032802009-12-09 20:18:31 -0500253 // Setup interfaces that option roms may need
Kevin O'Connor871e0a02009-12-30 12:14:53 -0500254 bios32_setup();
Kevin O'Connor969df602009-11-25 19:05:04 -0500255 pmm_setup();
Kevin O'Connor0c3068d2008-12-21 17:51:36 -0500256 pnp_setup();
Kevin O'Connor57877482009-12-09 21:00:41 -0500257 kbd_setup();
258 mouse_setup();
Kevin O'Connor98032802009-12-09 20:18:31 -0500259 init_bios_tables();
260
Kevin O'Connore438b0c2010-05-01 12:20:33 -0400261 // Run vga option rom
262 vga_setup();
Kevin O'Connor714325c2008-11-01 20:32:27 -0400263
Kevin O'Connore438b0c2010-05-01 12:20:33 -0400264 // Do hardware initialization (if running synchronously)
265 if (!CONFIG_THREADS || !CONFIG_THREAD_OPTIONROMS) {
266 init_hw();
267 wait_threads();
268 }
Kevin O'Connora2e73802008-02-27 10:27:00 -0500269
Kevin O'Connor98032802009-12-09 20:18:31 -0500270 // Run option roms
Kevin O'Connore438b0c2010-05-01 12:20:33 -0400271 optionrom_setup();
Kevin O'Connore54ee382009-07-26 19:33:13 -0400272
Kevin O'Connor969df602009-11-25 19:05:04 -0500273 // Run BCVs and show optional boot menu
Kevin O'Connor0bf92702009-08-01 11:45:37 -0400274 boot_prep();
275
Kevin O'Connor969df602009-11-25 19:05:04 -0500276 // Finalize data structures before boot
Kevin O'Connord5d02b62010-06-06 16:18:03 -0400277 cdemu_setup();
Kevin O'Connore54ee382009-07-26 19:33:13 -0400278 pmm_finalize();
279 malloc_finalize();
280 memmap_finalize();
Kevin O'Connor025cabd2010-09-15 21:59:11 -0400281
282 // Setup bios checksum.
283 BiosChecksum -= checksum((u8*)BUILD_BIOS_ADDR, BUILD_BIOS_SIZE);
284
285 // Write protect bios memory.
286 make_bios_readonly();
287
288 // Invoke int 19 to start boot process.
289 startBoot();
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500290}
291
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400292
293/****************************************************************
Kevin O'Connor87b533b2011-07-10 22:35:07 -0400294 * POST entry and code relocation
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400295 ****************************************************************/
296
Kevin O'Connor46b82622012-05-13 12:10:30 -0400297// Relocation fixup code that runs at new address after relocation complete.
298static void
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400299afterReloc(void)
Kevin O'Connor46b82622012-05-13 12:10:30 -0400300{
301 // Running at new code address - do code relocation fixups
302 malloc_fixupreloc();
303
304 // Move low-memory initial variable content to new location.
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400305 extern u8 datalow_start[], datalow_end[], final_datalow_start[];
306 memmove(final_datalow_start, datalow_start, datalow_end - datalow_start);
Kevin O'Connor46b82622012-05-13 12:10:30 -0400307
308 // Run main code
309 maininit();
310}
311
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400312// Update given relocs for the code at 'dest' with a given 'delta'
313static void
314updateRelocs(void *dest, u32 *rstart, u32 *rend, u32 delta)
315{
316 u32 *reloc;
317 for (reloc = rstart; reloc < rend; reloc++)
318 *((u32*)(dest + *reloc)) += delta;
319}
320
Kevin O'Connor87b533b2011-07-10 22:35:07 -0400321// Relocate init code and then call maininit() at new address.
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400322static void
323reloc_init(void)
324{
325 if (!CONFIG_RELOCATE_INIT) {
326 maininit();
327 return;
328 }
329 // Symbols populated by the build.
330 extern u8 code32flat_start[];
Kevin O'Connor46b82622012-05-13 12:10:30 -0400331 extern u8 _reloc_min_align;
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400332 extern u32 _reloc_abs_start[], _reloc_abs_end[];
333 extern u32 _reloc_rel_start[], _reloc_rel_end[];
334 extern u32 _reloc_init_start[], _reloc_init_end[];
335 extern u8 code32init_start[], code32init_end[];
Kevin O'Connor46b82622012-05-13 12:10:30 -0400336 extern u32 _reloc_datalow_start[], _reloc_datalow_end[];
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400337 extern u8 datalow_start[], datalow_end[], final_datalow_start[];
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400338
339 // Allocate space for init code.
340 u32 initsize = code32init_end - code32init_start;
Kevin O'Connor46b82622012-05-13 12:10:30 -0400341 u32 codealign = (u32)&_reloc_min_align;
342 void *codedest = memalign_tmp(codealign, initsize);
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400343 if (!codedest)
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400344 panic("No space for init relocation.\n");
345
346 // Copy code and update relocs (init absolute, init relative, and runtime)
Kevin O'Connor46b82622012-05-13 12:10:30 -0400347 dprintf(1, "Relocating low data from %p to %p (size %d)\n"
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400348 , datalow_start, final_datalow_start, datalow_end - datalow_start);
Kevin O'Connor46b82622012-05-13 12:10:30 -0400349 updateRelocs(code32flat_start, _reloc_datalow_start, _reloc_datalow_end
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400350 , final_datalow_start - datalow_start);
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400351 dprintf(1, "Relocating init from %p to %p (size %d)\n"
Kevin O'Connor46b82622012-05-13 12:10:30 -0400352 , code32init_start, codedest, initsize);
353 s32 delta = codedest - (void*)code32init_start;
354 memcpy(codedest, code32init_start, initsize);
355 updateRelocs(codedest, _reloc_abs_start, _reloc_abs_end, delta);
356 updateRelocs(codedest, _reloc_rel_start, _reloc_rel_end, -delta);
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400357 updateRelocs(code32flat_start, _reloc_init_start, _reloc_init_end, delta);
358
359 // Call maininit() in relocated code.
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400360 void (*func)(void) = (void*)afterReloc + delta;
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400361 barrier();
Kevin O'Connorc91da7a2012-06-08 21:14:19 -0400362 func();
Kevin O'Connor7f55fd32010-09-25 11:34:06 -0400363}
364
Kevin O'Connor9acdc282011-09-20 19:42:14 -0400365// Setup for code relocation and then call reloc_init
Kevin O'Connor025cabd2010-09-15 21:59:11 -0400366void VISIBLE32INIT
Kevin O'Connor9acdc282011-09-20 19:42:14 -0400367dopost(void)
368{
369 HaveRunPost = 1;
370
371 // Detect ram and setup internal malloc.
372 qemu_cfg_port_probe();
373 ram_probe();
374 malloc_setup();
375
376 // Relocate initialization code and call maininit().
377 reloc_init();
378}
379
380// Entry point for Power On Self Test (POST) - the BIOS initilization
381// phase. This function makes the memory at 0xc0000-0xfffff
382// read/writable and then calls dopost().
383void VISIBLE32FLAT
Kevin O'Connor87b533b2011-07-10 22:35:07 -0400384handle_post(void)
Kevin O'Connor025cabd2010-09-15 21:59:11 -0400385{
Kevin O'Connor61d6b062008-06-21 12:15:10 -0400386 debug_serial_setup();
Kevin O'Connorc95d2ce2009-07-29 20:41:39 -0400387 dprintf(1, "Start bios (version %s)\n", VERSION);
Kevin O'Connorda4a6482008-06-08 13:48:06 -0400388
Kevin O'Connor87b533b2011-07-10 22:35:07 -0400389 // Enable CPU caching
390 setcr0(getcr0() & ~(CR0_CD|CR0_NW));
391
392 // Clear CMOS reboot flag.
393 outb_cmos(0, CMOS_RESET_CODE);
394
395 // Make sure legacy DMA isn't running.
396 init_dma();
Kevin O'Connoradaf3732010-09-13 20:22:07 -0400397
Ian Campbell74c78782011-06-01 11:00:29 +0100398 // Check if we are running under Xen.
399 xen_probe();
400
Kevin O'Connora8999452010-09-25 12:48:43 -0400401 // Allow writes to modify bios area (0xf0000)
402 make_bios_writable();
Kevin O'Connora8999452010-09-25 12:48:43 -0400403
Kevin O'Connor9acdc282011-09-20 19:42:14 -0400404 // Now that memory is read/writable - start post process.
405 dopost();
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500406}