Revision 57a46d05 hw/pc.c
| b/hw/pc.c | ||
|---|---|---|
| 487 | 487 |
return fw_cfg; |
| 488 | 488 |
} |
| 489 | 489 |
|
| 490 |
/* Generate an initial boot sector which sets state and jump to |
|
| 491 |
a specified vector */ |
|
| 492 |
static void generate_bootsect(uint32_t gpr[8], uint16_t segs[6], uint16_t ip) |
|
| 493 |
{
|
|
| 494 |
uint8_t rom[512], *p, *reloc; |
|
| 495 |
uint8_t sum; |
|
| 496 |
int i; |
|
| 497 |
|
|
| 498 |
memset(rom, 0, sizeof(rom)); |
|
| 499 |
|
|
| 500 |
p = rom; |
|
| 501 |
/* Make sure we have an option rom signature */ |
|
| 502 |
*p++ = 0x55; |
|
| 503 |
*p++ = 0xaa; |
|
| 504 |
|
|
| 505 |
/* ROM size in sectors*/ |
|
| 506 |
*p++ = 1; |
|
| 507 |
|
|
| 508 |
/* Hook int19 */ |
|
| 509 |
|
|
| 510 |
*p++ = 0x50; /* push ax */ |
|
| 511 |
*p++ = 0x1e; /* push ds */ |
|
| 512 |
*p++ = 0x31; *p++ = 0xc0; /* xor ax, ax */ |
|
| 513 |
*p++ = 0x8e; *p++ = 0xd8; /* mov ax, ds */ |
|
| 514 |
|
|
| 515 |
*p++ = 0xc7; *p++ = 0x06; /* movvw _start,0x64 */ |
|
| 516 |
*p++ = 0x64; *p++ = 0x00; |
|
| 517 |
reloc = p; |
|
| 518 |
*p++ = 0x00; *p++ = 0x00; |
|
| 519 |
|
|
| 520 |
*p++ = 0x8c; *p++ = 0x0e; /* mov cs,0x66 */ |
|
| 521 |
*p++ = 0x66; *p++ = 0x00; |
|
| 522 |
|
|
| 523 |
*p++ = 0x1f; /* pop ds */ |
|
| 524 |
*p++ = 0x58; /* pop ax */ |
|
| 525 |
*p++ = 0xcb; /* lret */ |
|
| 526 |
|
|
| 527 |
/* Actual code */ |
|
| 528 |
*reloc = (p - rom); |
|
| 529 |
|
|
| 530 |
*p++ = 0xfa; /* CLI */ |
|
| 531 |
*p++ = 0xfc; /* CLD */ |
|
| 532 |
|
|
| 533 |
for (i = 0; i < 6; i++) {
|
|
| 534 |
if (i == 1) /* Skip CS */ |
|
| 535 |
continue; |
|
| 536 |
|
|
| 537 |
*p++ = 0xb8; /* MOV AX,imm16 */ |
|
| 538 |
*p++ = segs[i]; |
|
| 539 |
*p++ = segs[i] >> 8; |
|
| 540 |
*p++ = 0x8e; /* MOV <seg>,AX */ |
|
| 541 |
*p++ = 0xc0 + (i << 3); |
|
| 542 |
} |
|
| 543 |
|
|
| 544 |
for (i = 0; i < 8; i++) {
|
|
| 545 |
*p++ = 0x66; /* 32-bit operand size */ |
|
| 546 |
*p++ = 0xb8 + i; /* MOV <reg>,imm32 */ |
|
| 547 |
*p++ = gpr[i]; |
|
| 548 |
*p++ = gpr[i] >> 8; |
|
| 549 |
*p++ = gpr[i] >> 16; |
|
| 550 |
*p++ = gpr[i] >> 24; |
|
| 551 |
} |
|
| 552 |
|
|
| 553 |
*p++ = 0xea; /* JMP FAR */ |
|
| 554 |
*p++ = ip; /* IP */ |
|
| 555 |
*p++ = ip >> 8; |
|
| 556 |
*p++ = segs[1]; /* CS */ |
|
| 557 |
*p++ = segs[1] >> 8; |
|
| 558 |
|
|
| 559 |
/* sign rom */ |
|
| 560 |
sum = 0; |
|
| 561 |
for (i = 0; i < (sizeof(rom) - 1); i++) |
|
| 562 |
sum += rom[i]; |
|
| 563 |
rom[sizeof(rom) - 1] = -sum; |
|
| 564 |
|
|
| 565 |
rom_add_blob("linux-bootsect", rom, sizeof(rom),
|
|
| 566 |
PC_ROM_MIN_OPTION, PC_ROM_MAX, PC_ROM_ALIGN); |
|
| 567 |
} |
|
| 568 |
|
|
| 569 | 490 |
static long get_file_size(FILE *f) |
| 570 | 491 |
{
|
| 571 | 492 |
long where, size; |
| ... | ... | |
| 812 | 733 |
target_phys_addr_t max_ram_size) |
| 813 | 734 |
{
|
| 814 | 735 |
uint16_t protocol; |
| 815 |
uint32_t gpr[8]; |
|
| 816 |
uint16_t seg[6]; |
|
| 817 |
uint16_t real_seg; |
|
| 818 | 736 |
int setup_size, kernel_size, initrd_size = 0, cmdline_size; |
| 819 | 737 |
uint32_t initrd_max; |
| 820 |
uint8_t header[8192], *setup, *kernel; |
|
| 738 |
uint8_t header[8192], *setup, *kernel, *initrd_data;
|
|
| 821 | 739 |
target_phys_addr_t real_addr, prot_addr, cmdline_addr, initrd_addr = 0; |
| 822 | 740 |
FILE *f; |
| 823 | 741 |
char *vmode; |
| ... | ... | |
| 886 | 804 |
if (initrd_max >= max_ram_size-ACPI_DATA_SIZE) |
| 887 | 805 |
initrd_max = max_ram_size-ACPI_DATA_SIZE-1; |
| 888 | 806 |
|
| 889 |
/* kernel command line */ |
|
| 890 |
rom_add_blob_fixed("cmdline", kernel_cmdline,
|
|
| 891 |
strlen(kernel_cmdline)+1, cmdline_addr); |
|
| 807 |
fw_cfg_add_i32(fw_cfg, FW_CFG_CMDLINE_ADDR, cmdline_addr); |
|
| 808 |
fw_cfg_add_i32(fw_cfg, FW_CFG_CMDLINE_SIZE, strlen(kernel_cmdline)+1); |
|
| 809 |
fw_cfg_add_bytes(fw_cfg, FW_CFG_CMDLINE_DATA, |
|
| 810 |
(uint8_t*)strdup(kernel_cmdline), |
|
| 811 |
strlen(kernel_cmdline)+1); |
|
| 892 | 812 |
|
| 893 | 813 |
if (protocol >= 0x202) {
|
| 894 | 814 |
stl_p(header+0x228, cmdline_addr); |
| ... | ... | |
| 937 | 857 |
|
| 938 | 858 |
initrd_size = get_image_size(initrd_filename); |
| 939 | 859 |
initrd_addr = (initrd_max-initrd_size) & ~4095; |
| 940 |
rom_add_file_fixed(initrd_filename, initrd_addr); |
|
| 860 |
|
|
| 861 |
initrd_data = qemu_malloc(initrd_size); |
|
| 862 |
load_image(initrd_filename, initrd_data); |
|
| 863 |
|
|
| 864 |
fw_cfg_add_i32(fw_cfg, FW_CFG_INITRD_ADDR, initrd_addr); |
|
| 865 |
fw_cfg_add_i32(fw_cfg, FW_CFG_INITRD_SIZE, initrd_size); |
|
| 866 |
fw_cfg_add_bytes(fw_cfg, FW_CFG_INITRD_DATA, initrd_data, initrd_size); |
|
| 941 | 867 |
|
| 942 | 868 |
stl_p(header+0x218, initrd_addr); |
| 943 | 869 |
stl_p(header+0x21c, initrd_size); |
| ... | ... | |
| 957 | 883 |
fread(kernel, 1, kernel_size, f); |
| 958 | 884 |
fclose(f); |
| 959 | 885 |
memcpy(setup, header, MIN(sizeof(header), setup_size)); |
| 960 |
rom_add_blob_fixed("linux-setup", setup,
|
|
| 961 |
setup_size, real_addr); |
|
| 962 |
rom_add_blob_fixed(kernel_filename, kernel, |
|
| 963 |
kernel_size, prot_addr); |
|
| 964 |
qemu_free(setup); |
|
| 965 |
qemu_free(kernel); |
|
| 966 |
|
|
| 967 |
/* generate bootsector to set up the initial register state */ |
|
| 968 |
real_seg = real_addr >> 4; |
|
| 969 |
seg[0] = seg[2] = seg[3] = seg[4] = seg[4] = real_seg; |
|
| 970 |
seg[1] = real_seg+0x20; /* CS */ |
|
| 971 |
memset(gpr, 0, sizeof gpr); |
|
| 972 |
gpr[4] = cmdline_addr-real_addr-16; /* SP (-16 is paranoia) */ |
|
| 973 |
|
|
| 974 |
generate_bootsect(gpr, seg, 0); |
|
| 886 |
|
|
| 887 |
fw_cfg_add_i32(fw_cfg, FW_CFG_KERNEL_ADDR, prot_addr); |
|
| 888 |
fw_cfg_add_i32(fw_cfg, FW_CFG_KERNEL_SIZE, kernel_size); |
|
| 889 |
fw_cfg_add_bytes(fw_cfg, FW_CFG_KERNEL_DATA, kernel, kernel_size); |
|
| 890 |
|
|
| 891 |
fw_cfg_add_i32(fw_cfg, FW_CFG_SETUP_ADDR, real_addr); |
|
| 892 |
fw_cfg_add_i32(fw_cfg, FW_CFG_SETUP_SIZE, setup_size); |
|
| 893 |
fw_cfg_add_bytes(fw_cfg, FW_CFG_SETUP_DATA, setup, setup_size); |
|
| 894 |
|
|
| 895 |
option_rom[nb_option_roms] = "linuxboot.bin"; |
|
| 896 |
nb_option_roms++; |
|
| 975 | 897 |
} |
| 976 | 898 |
|
| 977 | 899 |
static const int ide_iobase[2] = { 0x1f0, 0x170 };
|
Also available in: Unified diff