Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 1 | // 32bit code to Power On Self Test (POST) a machine. |
| 2 | // |
| 3 | // Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net> |
| 4 | // Copyright (C) 2002 MandrakeSoft S.A. |
| 5 | // |
| 6 | // This file may be distributed under the terms of the GNU GPLv3 license. |
| 7 | |
| 8 | #include "ioport.h" // PORT_* |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 9 | #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'Connor | 2ad3744 | 2008-05-06 19:49:01 -0400 | [diff] [blame] | 13 | #include "ata.h" // hard_drive_setup |
Kevin O'Connor | 3bbcc14 | 2008-04-13 17:07:33 -0400 | [diff] [blame] | 14 | #include "disk.h" // floppy_drive_setup |
Kevin O'Connor | c781293 | 2008-06-08 23:08:12 -0400 | [diff] [blame] | 15 | #include "memmap.h" // add_e820 |
Kevin O'Connor | f54c150 | 2008-06-14 15:56:16 -0400 | [diff] [blame] | 16 | #include "pic.h" // pic_setup |
Kevin O'Connor | 0525d29 | 2008-07-04 06:18:30 -0400 | [diff] [blame] | 17 | #include "pci.h" // create_pirtable |
| 18 | #include "acpi.h" // acpi_bios_init |
Kevin O'Connor | 9521e26 | 2008-07-04 13:04:29 -0400 | [diff] [blame] | 19 | #include "bregs.h" // struct bregs |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 20 | |
Kevin O'Connor | 438f635 | 2008-03-30 21:46:53 -0400 | [diff] [blame] | 21 | #define bda ((struct bios_data_area_s *)MAKE_FARPTR(SEG_BDA, 0)) |
| 22 | #define ebda ((struct extended_bios_data_area_s *)MAKE_FARPTR(SEG_EBDA, 0)) |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 23 | |
Kevin O'Connor | d21c089 | 2008-11-26 17:02:43 -0500 | [diff] [blame] | 24 | void |
| 25 | __set_irq(int vector, void *loc) |
Kevin O'Connor | e3677b1 | 2008-07-04 15:29:23 -0400 | [diff] [blame] | 26 | { |
| 27 | SET_BDA(ivecs[vector].seg, SEG_BIOS); |
Kevin O'Connor | 2fda7cb | 2008-07-05 20:41:53 -0400 | [diff] [blame] | 28 | SET_BDA(ivecs[vector].offset, (u32)loc - BUILD_BIOS_ADDR); |
Kevin O'Connor | e3677b1 | 2008-07-04 15:29:23 -0400 | [diff] [blame] | 29 | } |
| 30 | |
Kevin O'Connor | d21c089 | 2008-11-26 17:02:43 -0500 | [diff] [blame] | 31 | #define set_irq(vector, func) do { \ |
| 32 | extern void func (void); \ |
| 33 | __set_irq(vector, func); \ |
| 34 | } while (0) |
Kevin O'Connor | 2fda7cb | 2008-07-05 20:41:53 -0400 | [diff] [blame] | 35 | |
Kevin O'Connor | e3677b1 | 2008-07-04 15:29:23 -0400 | [diff] [blame] | 36 | static void |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 37 | init_bda() |
| 38 | { |
Kevin O'Connor | 35192dd | 2008-06-08 19:18:33 -0400 | [diff] [blame] | 39 | dprintf(3, "init bda\n"); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 40 | memset(bda, 0, sizeof(*bda)); |
| 41 | |
Kevin O'Connor | f54c150 | 2008-06-14 15:56:16 -0400 | [diff] [blame] | 42 | SET_BDA(mem_size_kb, BASE_MEM_IN_K); |
| 43 | |
Kevin O'Connor | d21c089 | 2008-11-26 17:02:43 -0500 | [diff] [blame] | 44 | // Initialize all vectors to a dummy handler. |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 45 | int i; |
Kevin O'Connor | e3677b1 | 2008-07-04 15:29:23 -0400 | [diff] [blame] | 46 | for (i=0; i<256; i++) |
Kevin O'Connor | d21c089 | 2008-11-26 17:02:43 -0500 | [diff] [blame] | 47 | set_irq(i, dummy_iret_handler); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 48 | |
Kevin O'Connor | d21c089 | 2008-11-26 17:02:43 -0500 | [diff] [blame] | 49 | // Initialize all hw vectors to a default hw handler. |
| 50 | for (i=0x08; i<=0x0f; i++) |
| 51 | set_irq(i, entry_hwirq); |
| 52 | for (i=0x70; i<=0x77; i++) |
| 53 | set_irq(i, entry_hwirq); |
| 54 | |
| 55 | // Initialize software handlers. |
| 56 | set_irq(0x10, entry_10); |
| 57 | set_irq(0x11, entry_11); |
| 58 | set_irq(0x12, entry_12); |
| 59 | set_irq(0x13, entry_13); |
| 60 | set_irq(0x14, entry_14); |
| 61 | set_irq(0x15, entry_15); |
| 62 | set_irq(0x16, entry_16); |
| 63 | set_irq(0x17, entry_17); |
| 64 | set_irq(0x18, entry_18); |
| 65 | set_irq(0x19, entry_19); |
| 66 | set_irq(0x1a, entry_1a); |
| 67 | set_irq(0x1c, entry_1c); |
| 68 | set_irq(0x40, entry_40); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 69 | |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 70 | // set vector 0x79 to zero |
| 71 | // this is used by 'gardian angel' protection system |
Kevin O'Connor | e906149 | 2008-03-11 21:54:18 -0400 | [diff] [blame] | 72 | SET_BDA(ivecs[0x79].seg, 0); |
| 73 | SET_BDA(ivecs[0x79].offset, 0); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 74 | |
Kevin O'Connor | d21c089 | 2008-11-26 17:02:43 -0500 | [diff] [blame] | 75 | __set_irq(0x1E, &diskette_param_table2); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 76 | } |
| 77 | |
| 78 | static void |
| 79 | init_ebda() |
| 80 | { |
Kevin O'Connor | 38fcbfe | 2008-02-25 22:30:47 -0500 | [diff] [blame] | 81 | memset(ebda, 0, sizeof(*ebda)); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 82 | ebda->size = EBDA_SIZE; |
Kevin O'Connor | 438f635 | 2008-03-30 21:46:53 -0400 | [diff] [blame] | 83 | SET_BDA(ebda_seg, SEG_EBDA); |
| 84 | SET_BDA(ivecs[0x41].seg, SEG_EBDA); |
Kevin O'Connor | e906149 | 2008-03-11 21:54:18 -0400 | [diff] [blame] | 85 | SET_BDA(ivecs[0x41].offset |
Kevin O'Connor | 9f0d94d | 2008-04-13 17:25:30 -0400 | [diff] [blame] | 86 | , offsetof(struct extended_bios_data_area_s, fdpt[0])); |
Kevin O'Connor | 438f635 | 2008-03-30 21:46:53 -0400 | [diff] [blame] | 87 | SET_BDA(ivecs[0x46].seg, SEG_EBDA); |
Kevin O'Connor | e906149 | 2008-03-11 21:54:18 -0400 | [diff] [blame] | 88 | SET_BDA(ivecs[0x41].offset |
Kevin O'Connor | 9f0d94d | 2008-04-13 17:25:30 -0400 | [diff] [blame] | 89 | , offsetof(struct extended_bios_data_area_s, fdpt[1])); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 90 | } |
| 91 | |
| 92 | static void |
Kevin O'Connor | 9571ac2 | 2008-05-17 22:20:27 -0400 | [diff] [blame] | 93 | ram_probe(void) |
| 94 | { |
Kevin O'Connor | 35192dd | 2008-06-08 19:18:33 -0400 | [diff] [blame] | 95 | dprintf(3, "Find memory size\n"); |
Kevin O'Connor | f64f0db | 2008-05-18 02:42:58 -0400 | [diff] [blame] | 96 | if (CONFIG_COREBOOT) { |
Kevin O'Connor | c781293 | 2008-06-08 23:08:12 -0400 | [diff] [blame] | 97 | coreboot_fill_map(); |
Kevin O'Connor | f64f0db | 2008-05-18 02:42:58 -0400 | [diff] [blame] | 98 | } else { |
| 99 | // On emulators, get memory size from nvram. |
Kevin O'Connor | 59c35f2 | 2008-10-25 23:05:42 -0400 | [diff] [blame] | 100 | u32 rs = ((inb_cmos(CMOS_MEM_EXTMEM2_LOW) << 16) |
| 101 | | (inb_cmos(CMOS_MEM_EXTMEM2_HIGH) << 24)); |
Kevin O'Connor | f64f0db | 2008-05-18 02:42:58 -0400 | [diff] [blame] | 102 | if (rs) |
| 103 | rs += 16 * 1024 * 1024; |
| 104 | else |
Kevin O'Connor | 59c35f2 | 2008-10-25 23:05:42 -0400 | [diff] [blame] | 105 | rs = (((inb_cmos(CMOS_MEM_EXTMEM_LOW) << 10) |
| 106 | | (inb_cmos(CMOS_MEM_EXTMEM_HIGH) << 18)) |
Kevin O'Connor | f64f0db | 2008-05-18 02:42:58 -0400 | [diff] [blame] | 107 | + 1 * 1024 * 1024); |
Kevin O'Connor | c781293 | 2008-06-08 23:08:12 -0400 | [diff] [blame] | 108 | SET_EBDA(ram_size, rs); |
| 109 | add_e820(0, rs, E820_RAM); |
| 110 | |
Kevin O'Connor | 59c35f2 | 2008-10-25 23:05:42 -0400 | [diff] [blame] | 111 | // Check for memory over 4Gig |
| 112 | u64 high = ((inb_cmos(CMOS_MEM_HIGHMEM_LOW) << 16) |
| 113 | | (inb_cmos(CMOS_MEM_HIGHMEM_MID) << 24) |
| 114 | | ((u64)inb_cmos(CMOS_MEM_HIGHMEM_HIGH) << 32)); |
| 115 | SET_EBDA(ram_size_over4G, high); |
| 116 | add_e820(0x100000000ull, high, E820_RAM); |
| 117 | |
Kevin O'Connor | c781293 | 2008-06-08 23:08:12 -0400 | [diff] [blame] | 118 | /* reserve 256KB BIOS area at the end of 4 GB */ |
| 119 | add_e820(0xfffc0000, 256*1024, E820_RESERVED); |
Kevin O'Connor | f64f0db | 2008-05-18 02:42:58 -0400 | [diff] [blame] | 120 | } |
Kevin O'Connor | 9571ac2 | 2008-05-17 22:20:27 -0400 | [diff] [blame] | 121 | |
Kevin O'Connor | b8d7a47 | 2008-06-21 11:43:32 -0400 | [diff] [blame] | 122 | // Don't declare any memory between 0xa0000 and 0x100000 |
| 123 | add_e820(0xa0000, 0x50000, E820_HOLE); |
| 124 | |
Kevin O'Connor | c781293 | 2008-06-08 23:08:12 -0400 | [diff] [blame] | 125 | // Mark known areas as reserved. |
| 126 | add_e820((u32)MAKE_FARPTR(SEG_EBDA, 0), EBDA_SIZE * 1024, E820_RESERVED); |
Kevin O'Connor | e3677b1 | 2008-07-04 15:29:23 -0400 | [diff] [blame] | 127 | add_e820(BUILD_BIOS_ADDR, BUILD_BIOS_SIZE, E820_RESERVED); |
Kevin O'Connor | c781293 | 2008-06-08 23:08:12 -0400 | [diff] [blame] | 128 | |
| 129 | dprintf(1, "ram_size=0x%08x\n", GET_EBDA(ram_size)); |
Kevin O'Connor | 9571ac2 | 2008-05-17 22:20:27 -0400 | [diff] [blame] | 130 | } |
| 131 | |
| 132 | static void |
Kevin O'Connor | 0525d29 | 2008-07-04 06:18:30 -0400 | [diff] [blame] | 133 | init_bios_tables(void) |
| 134 | { |
| 135 | if (CONFIG_COREBOOT) |
| 136 | // XXX - not supported on coreboot yet. |
| 137 | return; |
| 138 | |
Kevin O'Connor | 0525d29 | 2008-07-04 06:18:30 -0400 | [diff] [blame] | 139 | create_pirtable(); |
| 140 | |
| 141 | mptable_init(); |
| 142 | |
| 143 | smbios_init(); |
| 144 | |
| 145 | acpi_bios_init(); |
| 146 | } |
| 147 | |
| 148 | static void |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 149 | init_boot_vectors() |
| 150 | { |
Kevin O'Connor | 4096702 | 2008-07-21 22:23:05 -0400 | [diff] [blame] | 151 | if (! CONFIG_BOOT) |
| 152 | return; |
Kevin O'Connor | 35192dd | 2008-06-08 19:18:33 -0400 | [diff] [blame] | 153 | dprintf(3, "init boot device ordering\n"); |
| 154 | |
Kevin O'Connor | 38fcbfe | 2008-02-25 22:30:47 -0500 | [diff] [blame] | 155 | // Floppy drive |
Kevin O'Connor | 56a506d | 2008-03-29 13:15:36 -0400 | [diff] [blame] | 156 | struct ipl_entry_s *ip = &ebda->ipl.table[0]; |
Kevin O'Connor | 38fcbfe | 2008-02-25 22:30:47 -0500 | [diff] [blame] | 157 | ip->type = IPL_TYPE_FLOPPY; |
| 158 | ip++; |
| 159 | |
| 160 | // First HDD |
| 161 | ip->type = IPL_TYPE_HARDDISK; |
| 162 | ip++; |
| 163 | |
| 164 | // CDROM |
Kevin O'Connor | 180a959 | 2008-03-04 22:50:53 -0500 | [diff] [blame] | 165 | if (CONFIG_CDROM_BOOT) { |
Kevin O'Connor | 38fcbfe | 2008-02-25 22:30:47 -0500 | [diff] [blame] | 166 | ip->type = IPL_TYPE_CDROM; |
| 167 | ip++; |
| 168 | } |
| 169 | |
Kevin O'Connor | 56a506d | 2008-03-29 13:15:36 -0400 | [diff] [blame] | 170 | ebda->ipl.count = ip - ebda->ipl.table; |
| 171 | ebda->ipl.sequence = 0xffff; |
Kevin O'Connor | f64f0db | 2008-05-18 02:42:58 -0400 | [diff] [blame] | 172 | if (CONFIG_COREBOOT) { |
| 173 | // XXX - hardcode defaults for coreboot. |
| 174 | ebda->ipl.bootorder = 0x00000231; |
Kevin O'Connor | abc7597 | 2008-05-18 00:20:53 -0400 | [diff] [blame] | 175 | ebda->ipl.checkfloppysig = 1; |
Kevin O'Connor | f64f0db | 2008-05-18 02:42:58 -0400 | [diff] [blame] | 176 | } else { |
| 177 | // On emulators, get boot order from nvram. |
| 178 | ebda->ipl.bootorder = (inb_cmos(CMOS_BIOS_BOOTFLAG2) |
| 179 | | ((inb_cmos(CMOS_BIOS_BOOTFLAG1) & 0xf0) << 4)); |
| 180 | if (!(inb_cmos(CMOS_BIOS_BOOTFLAG1) & 1)) |
| 181 | ebda->ipl.checkfloppysig = 1; |
| 182 | } |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 183 | } |
| 184 | |
Kevin O'Connor | da4a648 | 2008-06-08 13:48:06 -0400 | [diff] [blame] | 185 | // Main setup code. |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 186 | static void |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 187 | post() |
| 188 | { |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 189 | init_bda(); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 190 | init_ebda(); |
| 191 | |
Kevin O'Connor | f54c150 | 2008-06-14 15:56:16 -0400 | [diff] [blame] | 192 | pic_setup(); |
Kevin O'Connor | e6eb3f5 | 2008-04-13 17:37:41 -0400 | [diff] [blame] | 193 | timer_setup(); |
Kevin O'Connor | 714325c | 2008-11-01 20:32:27 -0400 | [diff] [blame] | 194 | mathcp_setup(); |
| 195 | |
Kevin O'Connor | acf1374 | 2008-11-29 11:19:19 -0500 | [diff] [blame] | 196 | smp_probe_setup(); |
Kevin O'Connor | cf89e66 | 2008-11-28 11:56:37 -0500 | [diff] [blame] | 197 | |
Kevin O'Connor | ceea03c | 2008-11-08 21:36:35 -0500 | [diff] [blame] | 198 | memmap_setup(); |
| 199 | ram_probe(); |
| 200 | |
Kevin O'Connor | 714325c | 2008-11-01 20:32:27 -0400 | [diff] [blame] | 201 | vga_setup(); |
| 202 | |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 203 | kbd_setup(); |
| 204 | lpt_setup(); |
| 205 | serial_setup(); |
Kevin O'Connor | f54c150 | 2008-06-14 15:56:16 -0400 | [diff] [blame] | 206 | mouse_setup(); |
Kevin O'Connor | a2e7380 | 2008-02-27 10:27:00 -0500 | [diff] [blame] | 207 | |
Kevin O'Connor | 0525d29 | 2008-07-04 06:18:30 -0400 | [diff] [blame] | 208 | pci_bios_setup(); |
Kevin O'Connor | 4bbd3b3 | 2008-12-10 21:01:00 -0500 | [diff] [blame^] | 209 | smm_init(); |
| 210 | |
Kevin O'Connor | 0525d29 | 2008-07-04 06:18:30 -0400 | [diff] [blame] | 211 | init_bios_tables(); |
Kevin O'Connor | c781293 | 2008-06-08 23:08:12 -0400 | [diff] [blame] | 212 | memmap_finalize(); |
| 213 | |
Kevin O'Connor | 3bbcc14 | 2008-04-13 17:07:33 -0400 | [diff] [blame] | 214 | floppy_drive_setup(); |
Kevin O'Connor | 9f0d94d | 2008-04-13 17:25:30 -0400 | [diff] [blame] | 215 | hard_drive_setup(); |
Kevin O'Connor | a2e7380 | 2008-02-27 10:27:00 -0500 | [diff] [blame] | 216 | |
| 217 | init_boot_vectors(); |
Kevin O'Connor | a4d3576 | 2008-03-08 15:43:03 -0500 | [diff] [blame] | 218 | |
Kevin O'Connor | 714325c | 2008-11-01 20:32:27 -0400 | [diff] [blame] | 219 | optionrom_setup(); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 220 | } |
| 221 | |
Kevin O'Connor | da4a648 | 2008-06-08 13:48:06 -0400 | [diff] [blame] | 222 | // 32-bit entry point. |
Kevin O'Connor | 1978676 | 2008-03-05 21:09:59 -0500 | [diff] [blame] | 223 | void VISIBLE32 |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 224 | _start() |
| 225 | { |
Kevin O'Connor | 95576e7 | 2008-03-01 09:57:51 -0500 | [diff] [blame] | 226 | init_dma(); |
Kevin O'Connor | 95576e7 | 2008-03-01 09:57:51 -0500 | [diff] [blame] | 227 | |
Kevin O'Connor | 61d6b06 | 2008-06-21 12:15:10 -0400 | [diff] [blame] | 228 | debug_serial_setup(); |
Kevin O'Connor | da4a648 | 2008-06-08 13:48:06 -0400 | [diff] [blame] | 229 | dprintf(1, "Start bios\n"); |
| 230 | |
Kevin O'Connor | acf1374 | 2008-11-29 11:19:19 -0500 | [diff] [blame] | 231 | // Allow writes to modify bios area (0xf0000) |
Kevin O'Connor | da4a648 | 2008-06-08 13:48:06 -0400 | [diff] [blame] | 232 | make_bios_writable(); |
| 233 | |
| 234 | // Perform main setup code. |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 235 | post(); |
Kevin O'Connor | da4a648 | 2008-06-08 13:48:06 -0400 | [diff] [blame] | 236 | |
| 237 | // Present the user with a bootup menu. |
| 238 | interactive_bootmenu(); |
| 239 | |
Kevin O'Connor | e90f264 | 2008-06-28 12:18:39 -0400 | [diff] [blame] | 240 | // Setup bios checksum. |
Kevin O'Connor | 2fda7cb | 2008-07-05 20:41:53 -0400 | [diff] [blame] | 241 | extern char bios_checksum; |
| 242 | bios_checksum = -checksum((u8*)BUILD_BIOS_ADDR, BUILD_BIOS_SIZE - 1); |
Kevin O'Connor | e90f264 | 2008-06-28 12:18:39 -0400 | [diff] [blame] | 243 | |
Kevin O'Connor | da4a648 | 2008-06-08 13:48:06 -0400 | [diff] [blame] | 244 | // Prep for boot process. |
| 245 | make_bios_readonly(); |
Kevin O'Connor | da4a648 | 2008-06-08 13:48:06 -0400 | [diff] [blame] | 246 | |
| 247 | // Invoke int 19 to start boot process. |
| 248 | dprintf(3, "Jump to int19\n"); |
| 249 | struct bregs br; |
| 250 | memset(&br, 0, sizeof(br)); |
| 251 | call16_int(0x19, &br); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 252 | } |
Kevin O'Connor | 4b39b82 | 2008-05-08 21:47:33 -0400 | [diff] [blame] | 253 | |
Kevin O'Connor | 2fda7cb | 2008-07-05 20:41:53 -0400 | [diff] [blame] | 254 | // Ughh - some older gcc compilers have a bug which causes VISIBLE32 |
| 255 | // functions to not be exported as a global variable - force _start |
| 256 | // to be global here. |
| 257 | asm(".global _start"); |