ia64/xen-unstable

annotate tools/firmware/hvmloader/hvmloader.c @ 14391:f233456b89d5

AMD HVM: Fix enter-realmode stub to initialise 32-bit GPRs.

This fixes booting Ubuntu live ISO, which assumes the upper half of
%esp is zero on entry.

Signed-off-by: Keir Fraser <keir@xensource.com>
author kfraser@localhost.localdomain
date Wed Mar 14 11:09:13 2007 +0000 (2007-03-14)
parents 1721f90e1422
children cf32c9e54c8f
rev   line source
kaf24@8708 1 /*
kaf24@8708 2 * hvmloader.c: HVM ROMBIOS/VGABIOS/ACPI/VMXAssist image loader.
kaf24@8708 3 *
kaf24@8708 4 * Leendert van Doorn, leendert@watson.ibm.com
kaf24@8708 5 * Copyright (c) 2005, International Business Machines Corporation.
kaf24@8708 6 *
kfraser@12554 7 * Copyright (c) 2006, Keir Fraser, XenSource Inc.
kfraser@12554 8 *
kaf24@8708 9 * This program is free software; you can redistribute it and/or modify it
kaf24@8708 10 * under the terms and conditions of the GNU General Public License,
kaf24@8708 11 * version 2, as published by the Free Software Foundation.
kaf24@8708 12 *
kaf24@8708 13 * This program is distributed in the hope it will be useful, but WITHOUT
kaf24@8708 14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
kaf24@8708 15 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
kaf24@8708 16 * more details.
kaf24@8708 17 *
kaf24@8708 18 * You should have received a copy of the GNU General Public License along with
kaf24@8708 19 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
kaf24@8708 20 * Place - Suite 330, Boston, MA 02111-1307 USA.
kaf24@8708 21 */
kaf24@8708 22 #include "roms.h"
kfraser@12057 23 #include "acpi/acpi2_0.h" /* for ACPI_PHYSICAL_ADDRESS */
kfraser@10976 24 #include "hypercall.h"
kfraser@10976 25 #include "util.h"
kfraser@11115 26 #include "smbios.h"
kfraser@12548 27 #include "config.h"
kaf24@12571 28 #include "apic_regs.h"
kfraser@12554 29 #include "pci_regs.h"
kfraser@10976 30 #include <xen/version.h>
kfraser@11081 31 #include <xen/hvm/params.h>
kfraser@12554 32 #include <xen/hvm/e820.h>
kaf24@8708 33
kaf24@8708 34 /* memory map */
kfraser@12548 35 #define HYPERCALL_PHYSICAL_ADDRESS 0x00080000
kfraser@12548 36 #define VGABIOS_PHYSICAL_ADDRESS 0x000C0000
Tim@13140 37 #define ETHERBOOT_PHYSICAL_ADDRESS 0x000C8000
kfraser@12548 38 #define VMXASSIST_PHYSICAL_ADDRESS 0x000D0000
kfraser@12548 39 #define ROMBIOS_PHYSICAL_ADDRESS 0x000F0000
kaf24@8708 40
kaf24@8708 41 asm(
kfraser@12548 42 " .text \n"
kfraser@12548 43 " .globl _start \n"
kfraser@12548 44 "_start: \n"
kfraser@14373 45 /* C runtime kickoff. */
kfraser@12548 46 " cld \n"
kfraser@12548 47 " cli \n"
kfraser@14373 48 " movl $stack_top,%esp \n"
kfraser@14373 49 " movl %esp,%ebp \n"
kfraser@14373 50 " call main \n"
kfraser@14373 51 /* Relocate real-mode trampoline to 0x0. */
kfraser@14373 52 " mov $trampoline_start,%esi \n"
kfraser@14373 53 " xor %edi,%edi \n"
kfraser@14373 54 " mov $trampoline_end,%ecx \n"
kfraser@14373 55 " sub %esi,%ecx \n"
kfraser@14373 56 " rep movsb \n"
kfraser@14373 57 /* Load real-mode compatible segment state (base 0x0000, limit 0xffff). */
kfraser@12548 58 " lgdt gdt_desr \n"
kfraser@14373 59 " mov $0x0010,%ax \n"
kfraser@14373 60 " mov %ax,%ds \n"
kfraser@14373 61 " mov %ax,%es \n"
kfraser@14373 62 " mov %ax,%fs \n"
kfraser@14373 63 " mov %ax,%gs \n"
kfraser@14373 64 " mov %ax,%ss \n"
kfraser@14391 65 /* Initialise all 32-bit GPRs to zero. */
kfraser@14391 66 " xor %eax,%eax \n"
kfraser@14391 67 " xor %ebx,%ebx \n"
kfraser@14391 68 " xor %ecx,%ecx \n"
kfraser@14391 69 " xor %edx,%edx \n"
kfraser@14391 70 " xor %esp,%esp \n"
kfraser@14391 71 " xor %ebp,%ebp \n"
kfraser@14391 72 " xor %esi,%esi \n"
kfraser@14391 73 " xor %edi,%edi \n"
kfraser@14373 74 /* Enter real mode, reload all segment registers and IDT. */
kfraser@14391 75 " ljmp $0x8,$0x0 \n"
kfraser@14373 76 "trampoline_start: .code16 \n"
kfraser@14373 77 " mov %eax,%cr0 \n"
kfraser@14373 78 " ljmp $0,$1f-trampoline_start\n"
kfraser@14391 79 "1: mov %ax,%ds \n"
kfraser@14373 80 " mov %ax,%es \n"
kfraser@14373 81 " mov %ax,%fs \n"
kfraser@14373 82 " mov %ax,%gs \n"
kfraser@14373 83 " mov %ax,%ss \n"
kfraser@14373 84 " lidt 1f-trampoline_start \n"
kfraser@14373 85 " ljmp $0xf000,$0xfff0 \n"
kfraser@14373 86 "1: .word 0x3ff,0,0 \n"
kfraser@14373 87 "trampoline_end: .code32 \n"
kfraser@12548 88 " \n"
kfraser@12548 89 "gdt_desr: \n"
kfraser@12548 90 " .word gdt_end - gdt - 1 \n"
kfraser@12548 91 " .long gdt \n"
kfraser@12548 92 " \n"
kfraser@12548 93 " .align 8 \n"
kfraser@12548 94 "gdt: \n"
kfraser@12548 95 " .quad 0x0000000000000000 \n"
kfraser@14373 96 " .quad 0x00009a000000ffff \n" /* Ring 0 code, base 0 limit 0xffff */
kfraser@14373 97 " .quad 0x000092000000ffff \n" /* Ring 0 data, base 0 limit 0xffff */
kfraser@12548 98 "gdt_end: \n"
kfraser@12548 99 " \n"
kfraser@12548 100 " .bss \n"
kfraser@12548 101 " .align 8 \n"
kfraser@12548 102 "stack: \n"
kfraser@12548 103 " .skip 0x4000 \n"
kfraser@12548 104 "stack_top: \n"
kfraser@12548 105 );
kaf24@8708 106
kaf24@10575 107 extern void create_mp_tables(void);
kaf24@8708 108
kfraser@10976 109 static int
kaf24@8708 110 cirrus_check(void)
kaf24@8708 111 {
kfraser@12548 112 outw(0x3C4, 0x9206);
kfraser@12548 113 return inb(0x3C5) == 0x12;
kaf24@8708 114 }
kaf24@8708 115
kfraser@10976 116 static int
kaf24@8708 117 check_amd(void)
kaf24@8708 118 {
kfraser@12548 119 char id[12];
kaf24@8708 120
kfraser@12548 121 __asm__ __volatile__ (
kfraser@12548 122 "cpuid"
kfraser@12548 123 : "=b" (*(int *)(&id[0])),
kfraser@12548 124 "=c" (*(int *)(&id[8])),
kfraser@12548 125 "=d" (*(int *)(&id[4]))
kfraser@12548 126 : "a" (0) );
kfraser@12548 127 return __builtin_memcmp(id, "AuthenticAMD", 12) == 0;
kaf24@8708 128 }
kaf24@8708 129
kfraser@10976 130 static void
kfraser@10976 131 wrmsr(uint32_t idx, uint64_t v)
kfraser@10976 132 {
kfraser@12548 133 __asm__ __volatile__ (
kfraser@12548 134 "wrmsr"
kfraser@12548 135 : : "c" (idx), "a" ((uint32_t)v), "d" ((uint32_t)(v>>32)) );
kfraser@10976 136 }
kfraser@10976 137
kfraser@10976 138 static void
kfraser@10976 139 init_hypercalls(void)
kfraser@10976 140 {
kfraser@12548 141 uint32_t eax, ebx, ecx, edx;
kfraser@12548 142 unsigned long i;
kfraser@12554 143 char signature[13];
kfraser@12548 144 xen_extraversion_t extraversion;
kfraser@10976 145
kfraser@12548 146 cpuid(0x40000000, &eax, &ebx, &ecx, &edx);
kfraser@10976 147
kfraser@12548 148 *(uint32_t *)(signature + 0) = ebx;
kfraser@12548 149 *(uint32_t *)(signature + 4) = ecx;
kfraser@12548 150 *(uint32_t *)(signature + 8) = edx;
kfraser@12548 151 signature[12] = '\0';
kfraser@10976 152
kfraser@12548 153 if ( strcmp("XenVMMXenVMM", signature) || (eax < 0x40000002) )
kfraser@12548 154 {
kfraser@12554 155 printf("FATAL: Xen hypervisor not detected\n");
kfraser@12548 156 __asm__ __volatile__( "ud2" );
kfraser@12548 157 }
kfraser@10976 158
kfraser@12554 159 /* Fill in hypercall transfer pages. */
kfraser@12548 160 cpuid(0x40000002, &eax, &ebx, &ecx, &edx);
kfraser@12548 161 for ( i = 0; i < eax; i++ )
kfraser@12548 162 wrmsr(ebx, HYPERCALL_PHYSICAL_ADDRESS + (i << 12) + i);
kfraser@12548 163
kfraser@12554 164 /* Print version information. */
kfraser@12554 165 cpuid(0x40000001, &eax, &ebx, &ecx, &edx);
kfraser@12548 166 hypercall_xen_version(XENVER_extraversion, extraversion);
kfraser@12554 167 printf("Detected Xen v%u.%u%s\n", eax >> 16, eax & 0xffff, extraversion);
kfraser@10976 168 }
kfraser@10976 169
kfraser@12548 170 static void apic_setup(void)
kaf24@8708 171 {
kaf24@12571 172 /* Set the IOAPIC ID to tha static value used in the MP/ACPI tables. */
kaf24@12571 173 ioapic_write(0x00, IOAPIC_ID);
kaf24@8708 174
kaf24@12571 175 /* Set up Virtual Wire mode. */
kaf24@12571 176 lapic_write(APIC_SPIV, APIC_SPIV_APIC_ENABLED | 0xFF);
kaf24@12571 177 lapic_write(APIC_LVT0, APIC_MODE_EXTINT << 8);
kaf24@12571 178 lapic_write(APIC_LVT1, APIC_MODE_NMI << 8);
kaf24@8708 179 }
kaf24@8708 180
kfraser@12554 181 static void pci_setup(void)
kfraser@12554 182 {
kfraser@12554 183 uint32_t devfn, bar_reg, bar_data, bar_sz, cmd;
kfraser@12554 184 uint32_t *base, io_base = 0xc000, mem_base = HVM_BELOW_4G_MMIO_START;
kfraser@12554 185 uint16_t class, vendor_id, device_id;
kfraser@12554 186 unsigned int bar, pin, link, isa_irq;
kfraser@12554 187
kfraser@12554 188 /* Program PCI-ISA bridge with appropriate link routes. */
kfraser@12554 189 link = 0;
kfraser@12554 190 for ( isa_irq = 0; isa_irq < 15; isa_irq++ )
kfraser@12554 191 {
kfraser@12554 192 if ( !(PCI_ISA_IRQ_MASK & (1U << isa_irq)) )
kfraser@12554 193 continue;
kfraser@12554 194 pci_writeb(PCI_ISA_DEVFN, 0x60 + link, isa_irq);
kfraser@12554 195 printf("PCI-ISA link %u routed to IRQ%u\n", link, isa_irq);
kfraser@12554 196 if ( link++ == 4 )
kfraser@12554 197 break;
kfraser@12554 198 }
kfraser@12554 199
kfraser@12554 200 /* Program ELCR to match PCI-wired IRQs. */
kfraser@12554 201 outb(0x4d0, (uint8_t)(PCI_ISA_IRQ_MASK >> 0));
kfraser@12554 202 outb(0x4d1, (uint8_t)(PCI_ISA_IRQ_MASK >> 8));
kfraser@12554 203
kfraser@12554 204 /* Scan the PCI bus and map resources. */
kfraser@12554 205 for ( devfn = 0; devfn < 128; devfn++ )
kfraser@12554 206 {
kfraser@12554 207 class = pci_readw(devfn, PCI_CLASS_DEVICE);
kfraser@12554 208 vendor_id = pci_readw(devfn, PCI_VENDOR_ID);
kfraser@12554 209 device_id = pci_readw(devfn, PCI_DEVICE_ID);
kfraser@12554 210 if ( (vendor_id == 0xffff) && (device_id == 0xffff) )
kfraser@12554 211 continue;
kfraser@12554 212
kfraser@12554 213 ASSERT((devfn != PCI_ISA_DEVFN) ||
kfraser@12554 214 ((vendor_id == 0x8086) && (device_id == 0x7000)));
kfraser@12554 215
kfraser@12554 216 switch ( class )
kfraser@12554 217 {
kfraser@12554 218 case 0x0680:
kfraser@12554 219 ASSERT((vendor_id == 0x8086) && (device_id == 0x7113));
kfraser@12554 220 /*
kfraser@12554 221 * PIIX4 ACPI PM. Special device with special PCI config space.
kfraser@12554 222 * No ordinary BARs.
kfraser@12554 223 */
kfraser@12554 224 pci_writew(devfn, 0x20, 0x0000); /* No smb bus IO enable */
kfraser@12554 225 pci_writew(devfn, 0x22, 0x0000);
kfraser@12554 226 pci_writew(devfn, 0x3c, 0x0009); /* Hardcoded IRQ9 */
kfraser@12554 227 pci_writew(devfn, 0x3d, 0x0001);
kfraser@12554 228 break;
kfraser@12554 229 case 0x0101:
kfraser@12554 230 /* PIIX3 IDE */
kfraser@12554 231 ASSERT((vendor_id == 0x8086) && (device_id == 0x7010));
kfraser@12554 232 pci_writew(devfn, 0x40, 0x8000); /* enable IDE0 */
kfraser@12554 233 pci_writew(devfn, 0x42, 0x8000); /* enable IDE1 */
kfraser@12554 234 /* fall through */
kfraser@12554 235 default:
kfraser@12554 236 /* Default memory mappings. */
kfraser@12554 237 for ( bar = 0; bar < 7; bar++ )
kfraser@12554 238 {
kfraser@12554 239 bar_reg = PCI_BASE_ADDRESS_0 + 4*bar;
kfraser@12554 240 if ( bar == 6 )
kfraser@12554 241 bar_reg = PCI_ROM_ADDRESS;
kfraser@12554 242
kfraser@12554 243 bar_data = pci_readl(devfn, bar_reg);
kfraser@12554 244
kfraser@12554 245 pci_writel(devfn, bar_reg, ~0);
kfraser@12554 246 bar_sz = pci_readl(devfn, bar_reg);
kfraser@12554 247 if ( bar_sz == 0 )
kfraser@12554 248 continue;
kfraser@12554 249
kfraser@12554 250 if ( (bar_data & PCI_BASE_ADDRESS_SPACE) ==
kfraser@12554 251 PCI_BASE_ADDRESS_SPACE_MEMORY )
kfraser@12554 252 {
kfraser@12554 253 base = &mem_base;
kfraser@12554 254 bar_sz &= PCI_BASE_ADDRESS_MEM_MASK;
kfraser@12554 255 bar_data &= ~PCI_BASE_ADDRESS_MEM_MASK;
kfraser@12554 256 }
kfraser@12554 257 else
kfraser@12554 258 {
kfraser@12554 259 base = &io_base;
kfraser@12554 260 bar_sz &= PCI_BASE_ADDRESS_IO_MASK & 0xffff;
kfraser@12554 261 bar_data &= ~PCI_BASE_ADDRESS_IO_MASK;
kfraser@12554 262 }
kfraser@12554 263 bar_sz &= ~(bar_sz - 1);
kfraser@12554 264
kfraser@12554 265 *base = (*base + bar_sz - 1) & ~(bar_sz - 1);
kfraser@12554 266 bar_data |= *base;
kfraser@12554 267 *base += bar_sz;
kfraser@12554 268
kfraser@12554 269 pci_writel(devfn, bar_reg, bar_data);
kfraser@12554 270 printf("pci dev %02x:%x bar %02x size %08x: %08x\n",
kfraser@12554 271 devfn>>3, devfn&7, bar_reg, bar_sz, bar_data);
kfraser@12554 272
kfraser@12554 273 /* Now enable the memory or I/O mapping. */
kfraser@12554 274 cmd = pci_readw(devfn, PCI_COMMAND);
kfraser@12554 275 if ( (bar_reg == PCI_ROM_ADDRESS) ||
kfraser@12554 276 ((bar_data & PCI_BASE_ADDRESS_SPACE) ==
kfraser@12554 277 PCI_BASE_ADDRESS_SPACE_MEMORY) )
kfraser@12554 278 cmd |= PCI_COMMAND_MEMORY;
kfraser@12554 279 else
kfraser@12554 280 cmd |= PCI_COMMAND_IO;
kfraser@12554 281 pci_writew(devfn, PCI_COMMAND, cmd);
kfraser@12554 282 }
kfraser@12554 283 break;
kfraser@12554 284 }
kfraser@12554 285
kfraser@12554 286 /* Map the interrupt. */
kfraser@12554 287 pin = pci_readb(devfn, PCI_INTERRUPT_PIN);
kfraser@12554 288 if ( pin != 0 )
kfraser@12554 289 {
kfraser@12554 290 /* This is the barber's pole mapping used by Xen. */
kfraser@12554 291 link = ((pin - 1) + (devfn >> 3)) & 3;
kfraser@12554 292 isa_irq = pci_readb(PCI_ISA_DEVFN, 0x60 + link);
kfraser@12554 293 pci_writeb(devfn, PCI_INTERRUPT_LINE, isa_irq);
kfraser@12554 294 printf("pci dev %02x:%x INT%c->IRQ%u\n",
kfraser@12554 295 devfn>>3, devfn&7, 'A'+pin-1, isa_irq);
kfraser@12554 296 }
kfraser@12554 297 }
kfraser@12554 298 }
kfraser@12554 299
Tim@13140 300 static
Tim@13140 301 int must_load_nic(void)
Tim@13140 302 {
Tim@13140 303 /* If the network card is in the boot order, load the Etherboot
Tim@13140 304 * option ROM. Read the boot order bytes from CMOS and check
Tim@13140 305 * if any of them are 0x4. */
Tim@13140 306 uint8_t boot_order;
Tim@13140 307
Tim@13140 308 /* Read CMOS register 0x3d (boot choices 0 and 1) */
Tim@13140 309 outb(0x70, 0x3d);
Tim@13140 310 boot_order = inb(0x71);
Tim@13140 311 if ( (boot_order & 0xf) == 0x4 || (boot_order & 0xf0) == 0x40 )
Tim@13140 312 return 1;
Tim@13140 313 /* Read CMOS register 0x38 (boot choice 2 and FDD test flag) */
Tim@13140 314 outb(0x70, 0x38);
Tim@13140 315 boot_order = inb(0x71);
Tim@13140 316 if ( (boot_order & 0xf0) == 0x40 )
Tim@13140 317 return 1;
Tim@13140 318 return 0;
Tim@13140 319 }
Tim@13140 320
kfraser@12548 321 int main(void)
kfraser@12548 322 {
kaf24@12574 323 int acpi_sz;
kaf24@12574 324
kfraser@12554 325 printf("HVM Loader\n");
kfraser@12548 326
kfraser@12548 327 init_hypercalls();
kfraser@12548 328
kfraser@12554 329 printf("Writing SMBIOS tables ...\n");
kfraser@12548 330 hvm_write_smbios_tables();
kfraser@12548 331
kfraser@12554 332 printf("Loading ROMBIOS ...\n");
kfraser@12548 333 memcpy((void *)ROMBIOS_PHYSICAL_ADDRESS, rombios, sizeof(rombios));
kaf24@13656 334 highbios_setup();
kfraser@12548 335
kfraser@12548 336 apic_setup();
kfraser@12554 337 pci_setup();
kaf24@12574 338
kfraser@12600 339 if ( (get_vcpu_nr() > 1) || get_apic_mode() )
kaf24@12574 340 create_mp_tables();
kfraser@12548 341
kfraser@12548 342 if ( cirrus_check() )
kfraser@12548 343 {
kfraser@12554 344 printf("Loading Cirrus VGABIOS ...\n");
kfraser@12548 345 memcpy((void *)VGABIOS_PHYSICAL_ADDRESS,
kfraser@12548 346 vgabios_cirrusvga, sizeof(vgabios_cirrusvga));
kfraser@12548 347 }
kfraser@12548 348 else
kfraser@12548 349 {
kfraser@12554 350 printf("Loading Standard VGABIOS ...\n");
kfraser@12548 351 memcpy((void *)VGABIOS_PHYSICAL_ADDRESS,
kfraser@12548 352 vgabios_stdvga, sizeof(vgabios_stdvga));
kfraser@12548 353 }
kfraser@12548 354
Tim@13140 355 if ( must_load_nic() )
Tim@13140 356 {
Tim@13140 357 printf("Loading ETHERBOOT ...\n");
Tim@13140 358 memcpy((void *)ETHERBOOT_PHYSICAL_ADDRESS,
Tim@13140 359 etherboot, sizeof(etherboot));
Tim@13140 360 }
Tim@13140 361
kfraser@12548 362 if ( get_acpi_enabled() != 0 )
kfraser@12548 363 {
kfraser@12554 364 printf("Loading ACPI ...\n");
kaf24@12574 365 acpi_sz = acpi_build_tables((uint8_t *)ACPI_PHYSICAL_ADDRESS);
kfraser@12634 366 ASSERT((ACPI_PHYSICAL_ADDRESS + acpi_sz) <= 0xF0000);
kfraser@12548 367 }
kfraser@12548 368
kfraser@14373 369 if ( !check_amd() )
kfraser@12548 370 {
kfraser@12554 371 printf("Loading VMXAssist ...\n");
kfraser@12548 372 memcpy((void *)VMXASSIST_PHYSICAL_ADDRESS,
kfraser@12548 373 vmxassist, sizeof(vmxassist));
kfraser@12548 374
kfraser@12554 375 printf("VMX go ...\n");
kfraser@12548 376 __asm__ __volatile__(
kfraser@12548 377 "jmp *%%eax"
kfraser@12548 378 : : "a" (VMXASSIST_PHYSICAL_ADDRESS), "d" (0)
kfraser@12548 379 );
kfraser@12548 380 }
kfraser@12548 381
kfraser@14373 382 printf("Invoking ROMBIOS ...\n");
kfraser@12548 383 return 0;
kfraser@12548 384 }
kfraser@12548 385
kfraser@12548 386 /*
kfraser@12548 387 * Local variables:
kfraser@12548 388 * mode: C
kfraser@12548 389 * c-set-style: "BSD"
kfraser@12548 390 * c-basic-offset: 4
kfraser@12548 391 * tab-width: 4
kfraser@12548 392 * indent-tabs-mode: nil
kfraser@12548 393 * End:
kfraser@12548 394 */