pc.c 34.2 KB
Newer Older
B
bellard 已提交
1 2
/*
 * QEMU PC System Emulator
3
 *
B
bellard 已提交
4
 * Copyright (c) 2003-2004 Fabrice Bellard
5
 *
B
bellard 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
P
pbrook 已提交
24 25 26 27 28 29 30 31 32 33
#include "hw.h"
#include "pc.h"
#include "fdc.h"
#include "pci.h"
#include "block.h"
#include "sysemu.h"
#include "audio/audio.h"
#include "net.h"
#include "smbus.h"
#include "boards.h"
A
aliguori 已提交
34
#include "monitor.h"
35
#include "fw_cfg.h"
A
aliguori 已提交
36
#include "hpet_emul.h"
R
Richard W.M. Jones 已提交
37
#include "watchdog.h"
38
#include "smbios.h"
B
bellard 已提交
39

B
bellard 已提交
40 41 42
/* output Bochs bios info messages */
//#define DEBUG_BIOS

B
bellard 已提交
43 44
#define BIOS_FILENAME "bios.bin"
#define VGABIOS_FILENAME "vgabios.bin"
B
bellard 已提交
45
#define VGABIOS_CIRRUS_FILENAME "vgabios-cirrus.bin"
B
bellard 已提交
46

47 48
#define PC_MAX_BIOS_SIZE (4 * 1024 * 1024)

49 50
/* Leave a chunk of memory at the top of RAM for the BIOS ACPI tables.  */
#define ACPI_DATA_SIZE       0x10000
51
#define BIOS_CFG_IOPORT 0x510
52
#define FW_CFG_ACPI_TABLES (FW_CFG_ARCH_LOCAL + 0)
53
#define FW_CFG_SMBIOS_ENTRIES (FW_CFG_ARCH_LOCAL + 1)
B
bellard 已提交
54

T
ths 已提交
55 56
#define MAX_IDE_BUS 2

57
static fdctrl_t *floppy_controller;
B
bellard 已提交
58
static RTCState *rtc_state;
B
bellard 已提交
59
static PITState *pit;
60
static IOAPICState *ioapic;
B
bellard 已提交
61
static PCIDevice *i440fx_state;
B
bellard 已提交
62

63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83
typedef struct rom_reset_data {
    uint8_t *data;
    target_phys_addr_t addr;
    unsigned size;
} RomResetData;

static void option_rom_reset(void *_rrd)
{
    RomResetData *rrd = _rrd;

    cpu_physical_memory_write_rom(rrd->addr, rrd->data, rrd->size);
}

static void option_rom_setup_reset(target_phys_addr_t addr, unsigned size)
{
    RomResetData *rrd = qemu_malloc(sizeof *rrd);

    rrd->data = qemu_malloc(size);
    cpu_physical_memory_read(addr, rrd->data, size);
    rrd->addr = addr;
    rrd->size = size;
J
Jan Kiszka 已提交
84
    qemu_register_reset(option_rom_reset, 0, rrd);
85 86
}

B
bellard 已提交
87
static void ioport80_write(void *opaque, uint32_t addr, uint32_t data)
B
bellard 已提交
88 89 90
{
}

91
/* MSDOS compatibility mode FPU exception support */
P
pbrook 已提交
92
static qemu_irq ferr_irq;
93 94 95
/* XXX: add IGNNE support */
void cpu_set_ferr(CPUX86State *s)
{
P
pbrook 已提交
96
    qemu_irq_raise(ferr_irq);
97 98 99 100
}

static void ioportF0_write(void *opaque, uint32_t addr, uint32_t data)
{
P
pbrook 已提交
101
    qemu_irq_lower(ferr_irq);
102 103
}

B
bellard 已提交
104 105 106
/* TSC handling */
uint64_t cpu_get_tsc(CPUX86State *env)
{
107 108 109
    /* Note: when using kqemu, it is more logical to return the host TSC
       because kqemu does not trap the RDTSC instruction for
       performance reasons */
110
#ifdef CONFIG_KQEMU
111 112
    if (env->kqemu_enabled) {
        return cpu_get_real_ticks();
113
    } else
114 115 116 117
#endif
    {
        return cpu_get_ticks();
    }
B
bellard 已提交
118 119
}

B
bellard 已提交
120 121 122 123 124 125 126 127
/* SMM support */
void cpu_smm_update(CPUState *env)
{
    if (i440fx_state && env == first_cpu)
        i440fx_set_smm(i440fx_state, (env->hflags >> HF_SMM_SHIFT) & 1);
}


B
bellard 已提交
128 129 130 131 132 133 134 135 136
/* IRQ handling */
int cpu_get_pic_interrupt(CPUState *env)
{
    int intno;

    intno = apic_get_interrupt(env);
    if (intno >= 0) {
        /* set irq request if a PIC irq is still pending */
        /* XXX: improve that */
137
        pic_update_irq(isa_pic);
B
bellard 已提交
138 139 140
        return intno;
    }
    /* read the irq from the PIC */
141 142 143
    if (!apic_accept_pic_intr(env))
        return -1;

B
bellard 已提交
144 145 146 147
    intno = pic_read_irq(isa_pic);
    return intno;
}

P
pbrook 已提交
148
static void pic_irq_request(void *opaque, int irq, int level)
B
bellard 已提交
149
{
150 151
    CPUState *env = first_cpu;

A
aurel32 已提交
152 153 154
    if (env->apic_state) {
        while (env) {
            if (apic_accept_pic_intr(env))
155
                apic_deliver_pic_intr(env, level);
A
aurel32 已提交
156 157 158
            env = env->next_cpu;
        }
    } else {
A
aurel32 已提交
159 160 161 162
        if (level)
            cpu_interrupt(env, CPU_INTERRUPT_HARD);
        else
            cpu_reset_interrupt(env, CPU_INTERRUPT_HARD);
163
    }
B
bellard 已提交
164 165
}

B
bellard 已提交
166 167
/* PC cmos mappings */

B
bellard 已提交
168 169
#define REG_EQUIPMENT_BYTE          0x14

170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193
static int cmos_get_fd_drive_type(int fd0)
{
    int val;

    switch (fd0) {
    case 0:
        /* 1.44 Mb 3"5 drive */
        val = 4;
        break;
    case 1:
        /* 2.88 Mb 3"5 drive */
        val = 5;
        break;
    case 2:
        /* 1.2 Mb 5"5 drive */
        val = 2;
        break;
    default:
        val = 0;
        break;
    }
    return val;
}

194
static void cmos_init_hd(int type_ofs, int info_ofs, BlockDriverState *hd)
B
bellard 已提交
195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210
{
    RTCState *s = rtc_state;
    int cylinders, heads, sectors;
    bdrv_get_geometry_hint(hd, &cylinders, &heads, &sectors);
    rtc_set_memory(s, type_ofs, 47);
    rtc_set_memory(s, info_ofs, cylinders);
    rtc_set_memory(s, info_ofs + 1, cylinders >> 8);
    rtc_set_memory(s, info_ofs + 2, heads);
    rtc_set_memory(s, info_ofs + 3, 0xff);
    rtc_set_memory(s, info_ofs + 4, 0xff);
    rtc_set_memory(s, info_ofs + 5, 0xc0 | ((heads > 8) << 3));
    rtc_set_memory(s, info_ofs + 6, cylinders);
    rtc_set_memory(s, info_ofs + 7, cylinders >> 8);
    rtc_set_memory(s, info_ofs + 8, sectors);
}

211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227
/* convert boot_device letter to something recognizable by the bios */
static int boot_device2nibble(char boot_device)
{
    switch(boot_device) {
    case 'a':
    case 'b':
        return 0x01; /* floppy boot */
    case 'c':
        return 0x02; /* hard drive boot */
    case 'd':
        return 0x03; /* CD-ROM boot */
    case 'n':
        return 0x04; /* Network boot */
    }
    return 0;
}

228 229
/* copy/pasted from cmos_init, should be made a general function
 and used there as well */
230
static int pc_boot_set(void *opaque, const char *boot_device)
231
{
A
aliguori 已提交
232
    Monitor *mon = cur_mon;
233
#define PC_MAX_BOOT_DEVICES 3
234
    RTCState *s = (RTCState *)opaque;
235 236 237 238 239
    int nbds, bds[3] = { 0, };
    int i;

    nbds = strlen(boot_device);
    if (nbds > PC_MAX_BOOT_DEVICES) {
A
aliguori 已提交
240
        monitor_printf(mon, "Too many boot devices for PC\n");
241 242 243 244 245
        return(1);
    }
    for (i = 0; i < nbds; i++) {
        bds[i] = boot_device2nibble(boot_device[i]);
        if (bds[i] == 0) {
A
aliguori 已提交
246 247
            monitor_printf(mon, "Invalid boot device for PC: '%c'\n",
                           boot_device[i]);
248 249 250 251 252 253 254 255
            return(1);
        }
    }
    rtc_set_memory(s, 0x3d, (bds[1] << 4) | bds[0]);
    rtc_set_memory(s, 0x38, (bds[2] << 4));
    return(0);
}

B
bellard 已提交
256
/* hd_table must contain 4 block drivers */
257 258
static void cmos_init(ram_addr_t ram_size, ram_addr_t above_4g_mem_size,
                      const char *boot_device, BlockDriverState **hd_table)
B
bellard 已提交
259
{
B
bellard 已提交
260
    RTCState *s = rtc_state;
261
    int nbds, bds[3] = { 0, };
B
bellard 已提交
262
    int val;
B
bellard 已提交
263
    int fd0, fd1, nb;
B
bellard 已提交
264
    int i;
B
bellard 已提交
265 266

    /* various important CMOS locations needed by PC/Bochs bios */
B
bellard 已提交
267 268

    /* memory size */
B
bellard 已提交
269 270 271 272
    val = 640; /* base memory in K */
    rtc_set_memory(s, 0x15, val);
    rtc_set_memory(s, 0x16, val >> 8);

B
bellard 已提交
273 274 275
    val = (ram_size / 1024) - 1024;
    if (val > 65535)
        val = 65535;
B
bellard 已提交
276 277 278 279
    rtc_set_memory(s, 0x17, val);
    rtc_set_memory(s, 0x18, val >> 8);
    rtc_set_memory(s, 0x30, val);
    rtc_set_memory(s, 0x31, val >> 8);
B
bellard 已提交
280

281 282 283 284 285 286
    if (above_4g_mem_size) {
        rtc_set_memory(s, 0x5b, (unsigned int)above_4g_mem_size >> 16);
        rtc_set_memory(s, 0x5c, (unsigned int)above_4g_mem_size >> 24);
        rtc_set_memory(s, 0x5d, (uint64_t)above_4g_mem_size >> 32);
    }

B
bellard 已提交
287 288 289 290
    if (ram_size > (16 * 1024 * 1024))
        val = (ram_size / 65536) - ((16 * 1024 * 1024) / 65536);
    else
        val = 0;
B
bellard 已提交
291 292
    if (val > 65535)
        val = 65535;
B
bellard 已提交
293 294
    rtc_set_memory(s, 0x34, val);
    rtc_set_memory(s, 0x35, val >> 8);
295

A
aurel32 已提交
296 297 298
    /* set the number of CPU */
    rtc_set_memory(s, 0x5f, smp_cpus - 1);

299
    /* set boot devices, and disable floppy signature check if requested */
300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315
#define PC_MAX_BOOT_DEVICES 3
    nbds = strlen(boot_device);
    if (nbds > PC_MAX_BOOT_DEVICES) {
        fprintf(stderr, "Too many boot devices for PC\n");
        exit(1);
    }
    for (i = 0; i < nbds; i++) {
        bds[i] = boot_device2nibble(boot_device[i]);
        if (bds[i] == 0) {
            fprintf(stderr, "Invalid boot device for PC: '%c'\n",
                    boot_device[i]);
            exit(1);
        }
    }
    rtc_set_memory(s, 0x3d, (bds[1] << 4) | bds[0]);
    rtc_set_memory(s, 0x38, (bds[2] << 4) | (fd_bootchk ?  0x0 : 0x1));
B
bellard 已提交
316

B
bellard 已提交
317 318
    /* floppy type */

319 320
    fd0 = fdctrl_get_drive_type(floppy_controller, 0);
    fd1 = fdctrl_get_drive_type(floppy_controller, 1);
B
bellard 已提交
321

322
    val = (cmos_get_fd_drive_type(fd0) << 4) | cmos_get_fd_drive_type(fd1);
B
bellard 已提交
323
    rtc_set_memory(s, 0x10, val);
324

B
bellard 已提交
325
    val = 0;
B
bellard 已提交
326
    nb = 0;
B
bellard 已提交
327 328 329 330 331 332 333 334
    if (fd0 < 3)
        nb++;
    if (fd1 < 3)
        nb++;
    switch (nb) {
    case 0:
        break;
    case 1:
B
bellard 已提交
335
        val |= 0x01; /* 1 drive, ready for boot */
B
bellard 已提交
336 337
        break;
    case 2:
B
bellard 已提交
338
        val |= 0x41; /* 2 drives, ready for boot */
B
bellard 已提交
339 340
        break;
    }
B
bellard 已提交
341 342 343 344
    val |= 0x02; /* FPU is there */
    val |= 0x04; /* PS/2 mouse installed */
    rtc_set_memory(s, REG_EQUIPMENT_BYTE, val);

B
bellard 已提交
345 346 347 348 349
    /* hard drives */

    rtc_set_memory(s, 0x12, (hd_table[0] ? 0xf0 : 0) | (hd_table[1] ? 0x0f : 0));
    if (hd_table[0])
        cmos_init_hd(0x19, 0x1b, hd_table[0]);
350
    if (hd_table[1])
B
bellard 已提交
351 352 353
        cmos_init_hd(0x1a, 0x24, hd_table[1]);

    val = 0;
B
bellard 已提交
354
    for (i = 0; i < 4; i++) {
B
bellard 已提交
355
        if (hd_table[i]) {
B
bellard 已提交
356 357 358 359 360 361 362 363 364 365 366 367 368 369 370
            int cylinders, heads, sectors, translation;
            /* NOTE: bdrv_get_geometry_hint() returns the physical
                geometry.  It is always such that: 1 <= sects <= 63, 1
                <= heads <= 16, 1 <= cylinders <= 16383. The BIOS
                geometry can be different if a translation is done. */
            translation = bdrv_get_translation_hint(hd_table[i]);
            if (translation == BIOS_ATA_TRANSLATION_AUTO) {
                bdrv_get_geometry_hint(hd_table[i], &cylinders, &heads, &sectors);
                if (cylinders <= 1024 && heads <= 16 && sectors <= 63) {
                    /* No translation. */
                    translation = 0;
                } else {
                    /* LBA translation. */
                    translation = 1;
                }
B
bellard 已提交
371
            } else {
B
bellard 已提交
372
                translation--;
B
bellard 已提交
373 374 375
            }
            val |= translation << (i * 2);
        }
B
bellard 已提交
376
    }
B
bellard 已提交
377
    rtc_set_memory(s, 0x39, val);
B
bellard 已提交
378 379
}

380 381 382 383 384 385 386 387 388 389 390
void ioport_set_a20(int enable)
{
    /* XXX: send to all CPUs ? */
    cpu_x86_set_a20(first_cpu, enable);
}

int ioport_get_a20(void)
{
    return ((first_cpu->a20_mask >> 20) & 1);
}

B
bellard 已提交
391 392
static void ioport92_write(void *opaque, uint32_t addr, uint32_t val)
{
393
    ioport_set_a20((val >> 1) & 1);
B
bellard 已提交
394 395 396 397 398
    /* XXX: bit 0 is fast reset */
}

static uint32_t ioport92_read(void *opaque, uint32_t addr)
{
399
    return ioport_get_a20() << 1;
B
bellard 已提交
400 401
}

B
bellard 已提交
402 403 404
/***********************************************************/
/* Bochs BIOS debug ports */

405
static void bochs_bios_write(void *opaque, uint32_t addr, uint32_t val)
B
bellard 已提交
406
{
B
bellard 已提交
407 408
    static const char shutdown_str[8] = "Shutdown";
    static int shutdown_index = 0;
409

B
bellard 已提交
410 411 412 413 414 415 416 417 418 419 420 421
    switch(addr) {
        /* Bochs BIOS messages */
    case 0x400:
    case 0x401:
        fprintf(stderr, "BIOS panic at rombios.c, line %d\n", val);
        exit(1);
    case 0x402:
    case 0x403:
#ifdef DEBUG_BIOS
        fprintf(stderr, "%c", val);
#endif
        break;
B
bellard 已提交
422 423 424 425 426 427 428 429 430 431 432 433
    case 0x8900:
        /* same as Bochs power off */
        if (val == shutdown_str[shutdown_index]) {
            shutdown_index++;
            if (shutdown_index == 8) {
                shutdown_index = 0;
                qemu_system_shutdown_request();
            }
        } else {
            shutdown_index = 0;
        }
        break;
B
bellard 已提交
434 435 436 437 438 439 440 441 442 443 444 445 446 447 448

        /* LGPL'ed VGA BIOS messages */
    case 0x501:
    case 0x502:
        fprintf(stderr, "VGA BIOS panic, line %d\n", val);
        exit(1);
    case 0x500:
    case 0x503:
#ifdef DEBUG_BIOS
        fprintf(stderr, "%c", val);
#endif
        break;
    }
}

449 450
extern uint64_t node_cpumask[MAX_NODES];

451
static void bochs_bios_init(void)
B
bellard 已提交
452
{
453
    void *fw_cfg;
454 455
    uint8_t *smbios_table;
    size_t smbios_len;
456 457
    uint64_t *numa_fw_cfg;
    int i, j;
458

B
bellard 已提交
459 460 461 462
    register_ioport_write(0x400, 1, 2, bochs_bios_write, NULL);
    register_ioport_write(0x401, 1, 2, bochs_bios_write, NULL);
    register_ioport_write(0x402, 1, 1, bochs_bios_write, NULL);
    register_ioport_write(0x403, 1, 1, bochs_bios_write, NULL);
B
bellard 已提交
463
    register_ioport_write(0x8900, 1, 1, bochs_bios_write, NULL);
B
bellard 已提交
464 465 466 467 468

    register_ioport_write(0x501, 1, 2, bochs_bios_write, NULL);
    register_ioport_write(0x502, 1, 2, bochs_bios_write, NULL);
    register_ioport_write(0x500, 1, 1, bochs_bios_write, NULL);
    register_ioport_write(0x503, 1, 1, bochs_bios_write, NULL);
469 470 471

    fw_cfg = fw_cfg_init(BIOS_CFG_IOPORT, BIOS_CFG_IOPORT + 1, 0, 0);
    fw_cfg_add_i32(fw_cfg, FW_CFG_ID, 1);
472
    fw_cfg_add_i64(fw_cfg, FW_CFG_RAM_SIZE, (uint64_t)ram_size);
473 474
    fw_cfg_add_bytes(fw_cfg, FW_CFG_ACPI_TABLES, (uint8_t *)acpi_tables,
                     acpi_tables_len);
475 476 477 478 479

    smbios_table = smbios_get_table(&smbios_len);
    if (smbios_table)
        fw_cfg_add_bytes(fw_cfg, FW_CFG_SMBIOS_ENTRIES,
                         smbios_table, smbios_len);
480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499

    /* allocate memory for the NUMA channel: one (64bit) word for the number
     * of nodes, one word for each VCPU->node and one word for each node to
     * hold the amount of memory.
     */
    numa_fw_cfg = qemu_mallocz((1 + smp_cpus + nb_numa_nodes) * 8);
    numa_fw_cfg[0] = cpu_to_le64(nb_numa_nodes);
    for (i = 0; i < smp_cpus; i++) {
        for (j = 0; j < nb_numa_nodes; j++) {
            if (node_cpumask[j] & (1 << i)) {
                numa_fw_cfg[i + 1] = cpu_to_le64(j);
                break;
            }
        }
    }
    for (i = 0; i < nb_numa_nodes; i++) {
        numa_fw_cfg[smp_cpus + 1 + i] = cpu_to_le64(node_mem[i]);
    }
    fw_cfg_add_bytes(fw_cfg, FW_CFG_NUMA, (uint8_t *)numa_fw_cfg,
                     (1 + smp_cpus + nb_numa_nodes) * 8);
B
bellard 已提交
500 501
}

T
ths 已提交
502 503
/* Generate an initial boot sector which sets state and jump to
   a specified vector */
504
static void generate_bootsect(target_phys_addr_t option_rom,
505
                              uint32_t gpr[8], uint16_t segs[6], uint16_t ip)
T
ths 已提交
506
{
507 508
    uint8_t rom[512], *p, *reloc;
    uint8_t sum;
T
ths 已提交
509 510
    int i;

511 512 513 514 515 516
    memset(rom, 0, sizeof(rom));

    p = rom;
    /* Make sure we have an option rom signature */
    *p++ = 0x55;
    *p++ = 0xaa;
T
ths 已提交
517

518 519
    /* ROM size in sectors*/
    *p++ = 1;
T
ths 已提交
520

521
    /* Hook int19 */
T
ths 已提交
522

523 524 525 526
    *p++ = 0x50;		/* push ax */
    *p++ = 0x1e;		/* push ds */
    *p++ = 0x31; *p++ = 0xc0;	/* xor ax, ax */
    *p++ = 0x8e; *p++ = 0xd8;	/* mov ax, ds */
T
ths 已提交
527

528 529 530 531 532 533 534 535 536 537 538 539
    *p++ = 0xc7; *p++ = 0x06;   /* movvw _start,0x64 */
    *p++ = 0x64; *p++ = 0x00;
    reloc = p;
    *p++ = 0x00; *p++ = 0x00;

    *p++ = 0x8c; *p++ = 0x0e;   /* mov cs,0x66 */
    *p++ = 0x66; *p++ = 0x00;

    *p++ = 0x1f;		/* pop ds */
    *p++ = 0x58;		/* pop ax */
    *p++ = 0xcb;		/* lret */
    
T
ths 已提交
540
    /* Actual code */
541 542
    *reloc = (p - rom);

T
ths 已提交
543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571
    *p++ = 0xfa;		/* CLI */
    *p++ = 0xfc;		/* CLD */

    for (i = 0; i < 6; i++) {
	if (i == 1)		/* Skip CS */
	    continue;

	*p++ = 0xb8;		/* MOV AX,imm16 */
	*p++ = segs[i];
	*p++ = segs[i] >> 8;
	*p++ = 0x8e;		/* MOV <seg>,AX */
	*p++ = 0xc0 + (i << 3);
    }

    for (i = 0; i < 8; i++) {
	*p++ = 0x66;		/* 32-bit operand size */
	*p++ = 0xb8 + i;	/* MOV <reg>,imm32 */
	*p++ = gpr[i];
	*p++ = gpr[i] >> 8;
	*p++ = gpr[i] >> 16;
	*p++ = gpr[i] >> 24;
    }

    *p++ = 0xea;		/* JMP FAR */
    *p++ = ip;			/* IP */
    *p++ = ip >> 8;
    *p++ = segs[1];		/* CS */
    *p++ = segs[1] >> 8;

572 573 574 575 576 577
    /* sign rom */
    sum = 0;
    for (i = 0; i < (sizeof(rom) - 1); i++)
        sum += rom[i];
    rom[sizeof(rom) - 1] = -sum;

578
    cpu_physical_memory_write_rom(option_rom, rom, sizeof(rom));
G
Glauber Costa 已提交
579
    option_rom_setup_reset(option_rom, sizeof (rom));
T
ths 已提交
580
}
B
bellard 已提交
581

T
ths 已提交
582 583 584 585 586 587 588 589 590 591 592 593 594 595
static long get_file_size(FILE *f)
{
    long where, size;

    /* XXX: on Unix systems, using fstat() probably makes more sense */

    where = ftell(f);
    fseek(f, 0, SEEK_END);
    size = ftell(f);
    fseek(f, where, SEEK_SET);

    return size;
}

596
static void load_linux(target_phys_addr_t option_rom,
597
                       const char *kernel_filename,
T
ths 已提交
598
		       const char *initrd_filename,
G
Glauber Costa 已提交
599 600
		       const char *kernel_cmdline,
               target_phys_addr_t max_ram_size)
T
ths 已提交
601 602 603 604 605
{
    uint16_t protocol;
    uint32_t gpr[8];
    uint16_t seg[6];
    uint16_t real_seg;
P
Paul Brook 已提交
606
    int setup_size, kernel_size, initrd_size = 0, cmdline_size;
T
ths 已提交
607 608
    uint32_t initrd_max;
    uint8_t header[1024];
P
Paul Brook 已提交
609
    target_phys_addr_t real_addr, prot_addr, cmdline_addr, initrd_addr = 0;
T
ths 已提交
610 611 612 613 614 615 616 617 618 619 620 621 622 623 624
    FILE *f, *fi;

    /* Align to 16 bytes as a paranoia measure */
    cmdline_size = (strlen(kernel_cmdline)+16) & ~15;

    /* load the kernel header */
    f = fopen(kernel_filename, "rb");
    if (!f || !(kernel_size = get_file_size(f)) ||
	fread(header, 1, 1024, f) != 1024) {
	fprintf(stderr, "qemu: could not load kernel '%s'\n",
		kernel_filename);
	exit(1);
    }

    /* kernel protocol version */
B
bellard 已提交
625
#if 0
T
ths 已提交
626
    fprintf(stderr, "header magic: %#x\n", ldl_p(header+0x202));
B
bellard 已提交
627
#endif
T
ths 已提交
628 629 630 631 632 633 634
    if (ldl_p(header+0x202) == 0x53726448)
	protocol = lduw_p(header+0x206);
    else
	protocol = 0;

    if (protocol < 0x200 || !(header[0x211] & 0x01)) {
	/* Low kernel */
635 636 637
	real_addr    = 0x90000;
	cmdline_addr = 0x9a000 - cmdline_size;
	prot_addr    = 0x10000;
T
ths 已提交
638 639
    } else if (protocol < 0x202) {
	/* High but ancient kernel */
640 641 642
	real_addr    = 0x90000;
	cmdline_addr = 0x9a000 - cmdline_size;
	prot_addr    = 0x100000;
T
ths 已提交
643 644
    } else {
	/* High and recent kernel */
645 646 647
	real_addr    = 0x10000;
	cmdline_addr = 0x20000;
	prot_addr    = 0x100000;
T
ths 已提交
648 649
    }

B
bellard 已提交
650
#if 0
T
ths 已提交
651
    fprintf(stderr,
652 653 654
	    "qemu: real_addr     = 0x" TARGET_FMT_plx "\n"
	    "qemu: cmdline_addr  = 0x" TARGET_FMT_plx "\n"
	    "qemu: prot_addr     = 0x" TARGET_FMT_plx "\n",
655 656 657
	    real_addr,
	    cmdline_addr,
	    prot_addr);
B
bellard 已提交
658
#endif
T
ths 已提交
659 660 661 662 663 664 665

    /* highest address for loading the initrd */
    if (protocol >= 0x203)
	initrd_max = ldl_p(header+0x22c);
    else
	initrd_max = 0x37ffffff;

G
Glauber Costa 已提交
666 667
    if (initrd_max >= max_ram_size-ACPI_DATA_SIZE)
    	initrd_max = max_ram_size-ACPI_DATA_SIZE-1;
T
ths 已提交
668 669

    /* kernel command line */
670
    pstrcpy_targphys(cmdline_addr, 4096, kernel_cmdline);
T
ths 已提交
671 672

    if (protocol >= 0x202) {
673
	stl_p(header+0x228, cmdline_addr);
T
ths 已提交
674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706
    } else {
	stw_p(header+0x20, 0xA33F);
	stw_p(header+0x22, cmdline_addr-real_addr);
    }

    /* loader type */
    /* High nybble = B reserved for Qemu; low nybble is revision number.
       If this code is substantially changed, you may want to consider
       incrementing the revision. */
    if (protocol >= 0x200)
	header[0x210] = 0xB0;

    /* heap */
    if (protocol >= 0x201) {
	header[0x211] |= 0x80;	/* CAN_USE_HEAP */
	stw_p(header+0x224, cmdline_addr-real_addr-0x200);
    }

    /* load initrd */
    if (initrd_filename) {
	if (protocol < 0x200) {
	    fprintf(stderr, "qemu: linux kernel too old to load a ram disk\n");
	    exit(1);
	}

	fi = fopen(initrd_filename, "rb");
	if (!fi) {
	    fprintf(stderr, "qemu: could not load initial ram disk '%s'\n",
		    initrd_filename);
	    exit(1);
	}

	initrd_size = get_file_size(fi);
707
	initrd_addr = (initrd_max-initrd_size) & ~4095;
T
ths 已提交
708

709
	if (!fread_targphys_ok(initrd_addr, initrd_size, fi)) {
T
ths 已提交
710 711 712 713 714 715
	    fprintf(stderr, "qemu: read error on initial ram disk '%s'\n",
		    initrd_filename);
	    exit(1);
	}
	fclose(fi);

716
	stl_p(header+0x218, initrd_addr);
T
ths 已提交
717 718 719 720
	stl_p(header+0x21c, initrd_size);
    }

    /* store the finalized header and load the rest of the kernel */
721
    cpu_physical_memory_write(real_addr, header, 1024);
T
ths 已提交
722 723 724 725 726 727 728 729

    setup_size = header[0x1f1];
    if (setup_size == 0)
	setup_size = 4;

    setup_size = (setup_size+1)*512;
    kernel_size -= setup_size;	/* Size of protected-mode code */

730 731
    if (!fread_targphys_ok(real_addr+1024, setup_size-1024, f) ||
	!fread_targphys_ok(prot_addr, kernel_size, f)) {
T
ths 已提交
732 733 734 735 736 737 738
	fprintf(stderr, "qemu: read error on kernel '%s'\n",
		kernel_filename);
	exit(1);
    }
    fclose(f);

    /* generate bootsector to set up the initial register state */
739
    real_seg = real_addr >> 4;
T
ths 已提交
740 741 742 743 744
    seg[0] = seg[2] = seg[3] = seg[4] = seg[4] = real_seg;
    seg[1] = real_seg+0x20;	/* CS */
    memset(gpr, 0, sizeof gpr);
    gpr[4] = cmdline_addr-real_addr-16;	/* SP (-16 is paranoia) */

G
Glauber Costa 已提交
745 746 747 748 749 750
    option_rom_setup_reset(real_addr, setup_size);
    option_rom_setup_reset(prot_addr, kernel_size);
    option_rom_setup_reset(cmdline_addr, cmdline_size);
    if (initrd_filename)
        option_rom_setup_reset(initrd_addr, initrd_size);

751
    generate_bootsect(option_rom, gpr, seg, 0);
T
ths 已提交
752 753
}

754 755 756 757 758 759
static void main_cpu_reset(void *opaque)
{
    CPUState *env = opaque;
    cpu_reset(env);
}

B
bellard 已提交
760 761 762 763 764 765
static const int ide_iobase[2] = { 0x1f0, 0x170 };
static const int ide_iobase2[2] = { 0x3f6, 0x376 };
static const int ide_irq[2] = { 14, 15 };

#define NE2000_NB_MAX 6

766
static int ne2000_io[NE2000_NB_MAX] = { 0x300, 0x320, 0x340, 0x360, 0x280, 0x380 };
B
bellard 已提交
767 768
static int ne2000_irq[NE2000_NB_MAX] = { 9, 10, 11, 3, 4, 5 };

769 770 771
static int serial_io[MAX_SERIAL_PORTS] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8 };
static int serial_irq[MAX_SERIAL_PORTS] = { 4, 3, 4, 3 };

772 773 774
static int parallel_io[MAX_PARALLEL_PORTS] = { 0x378, 0x278, 0x3bc };
static int parallel_irq[MAX_PARALLEL_PORTS] = { 7, 7, 7 };

775
#ifdef HAS_AUDIO
P
pbrook 已提交
776
static void audio_init (PCIBus *pci_bus, qemu_irq *pic)
777 778 779
{
    struct soundhw *c;

M
malc 已提交
780 781 782 783 784 785 786
    for (c = soundhw; c->name; ++c) {
        if (c->enabled) {
            if (c->isa) {
                c->init.init_isa(pic);
            } else {
                if (pci_bus) {
                    c->init.init_pci(pci_bus);
787 788 789 790 791 792 793
                }
            }
        }
    }
}
#endif

P
pbrook 已提交
794
static void pc_init_ne2k_isa(NICInfo *nd, qemu_irq *pic)
795 796 797 798 799
{
    static int nb_ne2k = 0;

    if (nb_ne2k == NE2000_NB_MAX)
        return;
P
pbrook 已提交
800
    isa_ne2000_init(ne2000_io[nb_ne2k], pic[ne2000_irq[nb_ne2k]], nd);
801 802 803
    nb_ne2k++;
}

804 805 806 807
static int load_option_rom(const char *oprom, target_phys_addr_t start,
                           target_phys_addr_t end)
{
        int size;
P
Paul Brook 已提交
808 809 810 811 812 813 814 815 816 817 818 819 820 821
        char *filename;

        filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, oprom);
        if (filename) {
            size = get_image_size(filename);
            if (size > 0 && start + size > end) {
                fprintf(stderr, "Not enough space to load option rom '%s'\n",
                        oprom);
                exit(1);
            }
            size = load_image_targphys(filename, start, end - start);
            qemu_free(filename);
        } else {
            size = -1;
822 823 824 825 826 827 828
        }
        if (size < 0) {
            fprintf(stderr, "Could not load option rom '%s'\n", oprom);
            exit(1);
        }
        /* Round up optiom rom size to the next 2k boundary */
        size = (size + 2047) & ~2047;
829
        option_rom_setup_reset(start, size);
830 831 832
        return size;
}

G
Gleb Natapov 已提交
833 834 835 836 837
int cpu_is_bsp(CPUState *env)
{
	return env->cpuid_apic_id == 0;
}

B
bellard 已提交
838
/* PC hardware initialisation */
P
Paul Brook 已提交
839
static void pc_init1(ram_addr_t ram_size,
840
                     const char *boot_device,
B
bellard 已提交
841
                     const char *kernel_filename, const char *kernel_cmdline,
842
                     const char *initrd_filename,
843
                     int pci_enabled, const char *cpu_model)
B
bellard 已提交
844
{
P
Paul Brook 已提交
845
    char *filename;
T
ths 已提交
846
    int ret, linux_boot, i;
P
pbrook 已提交
847
    ram_addr_t ram_addr, bios_offset, option_rom_offset;
848
    ram_addr_t below_4g_mem_size, above_4g_mem_size = 0;
849
    int bios_size, isa_bios_size, oprom_area_size;
B
bellard 已提交
850
    PCIBus *pci_bus;
P
pbrook 已提交
851
    int piix3_devfn = -1;
852
    CPUState *env;
P
pbrook 已提交
853 854
    qemu_irq *cpu_irq;
    qemu_irq *i8259;
T
ths 已提交
855 856 857
    int index;
    BlockDriverState *hd[MAX_IDE_BUS * MAX_IDE_DEVS];
    BlockDriverState *fd[MAX_FD];
A
aliguori 已提交
858
    int using_vga = cirrus_vga_enabled || std_vga_enabled || vmsvga_enabled;
859

860 861 862 863 864 865 866
    if (ram_size >= 0xe0000000 ) {
        above_4g_mem_size = ram_size - 0xe0000000;
        below_4g_mem_size = 0xe0000000;
    } else {
        below_4g_mem_size = ram_size;
    }

B
bellard 已提交
867 868
    linux_boot = (kernel_filename != NULL);

869
    /* init CPUs */
870 871 872 873 874 875 876 877
    if (cpu_model == NULL) {
#ifdef TARGET_X86_64
        cpu_model = "qemu64";
#else
        cpu_model = "qemu32";
#endif
    }
    
878
    for(i = 0; i < smp_cpus; i++) {
B
bellard 已提交
879 880 881 882 883
        env = cpu_init(cpu_model);
        if (!env) {
            fprintf(stderr, "Unable to find x86 CPU definition\n");
            exit(1);
        }
884
        if ((env->cpuid_features & CPUID_APIC) || smp_cpus > 1) {
G
Gleb Natapov 已提交
885
            env->cpuid_apic_id = env->cpu_index;
886 887
            apic_init(env);
        }
888
        qemu_register_reset(main_cpu_reset, 0, env);
889 890
    }

A
aurel32 已提交
891 892
    vmport_init();

B
bellard 已提交
893
    /* allocate RAM */
894 895 896 897 898 899 900 901 902 903 904 905
    ram_addr = qemu_ram_alloc(0xa0000);
    cpu_register_physical_memory(0, 0xa0000, ram_addr);

    /* Allocate, even though we won't register, so we don't break the
     * phys_ram_base + PA assumption. This range includes vga (0xa0000 - 0xc0000),
     * and some bios areas, which will be registered later
     */
    ram_addr = qemu_ram_alloc(0x100000 - 0xa0000);
    ram_addr = qemu_ram_alloc(below_4g_mem_size - 0x100000);
    cpu_register_physical_memory(0x100000,
                 below_4g_mem_size - 0x100000,
                 ram_addr);
906 907 908

    /* above 4giga memory allocation */
    if (above_4g_mem_size > 0) {
909 910 911
#if TARGET_PHYS_ADDR_BITS == 32
        hw_error("To much RAM for 32-bit physical address");
#else
912 913
        ram_addr = qemu_ram_alloc(above_4g_mem_size);
        cpu_register_physical_memory(0x100000000ULL,
914
                                     above_4g_mem_size,
915
                                     ram_addr);
916
#endif
917
    }
B
bellard 已提交
918

919

B
bellard 已提交
920
    /* BIOS load */
921 922
    if (bios_name == NULL)
        bios_name = BIOS_FILENAME;
P
Paul Brook 已提交
923 924 925 926 927 928
    filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, bios_name);
    if (filename) {
        bios_size = get_image_size(filename);
    } else {
        bios_size = -1;
    }
929
    if (bios_size <= 0 ||
B
bellard 已提交
930
        (bios_size % 65536) != 0) {
B
bellard 已提交
931 932
        goto bios_error;
    }
B
bellard 已提交
933
    bios_offset = qemu_ram_alloc(bios_size);
P
Paul Brook 已提交
934
    ret = load_image(filename, qemu_get_ram_ptr(bios_offset));
B
bellard 已提交
935 936
    if (ret != bios_size) {
    bios_error:
P
Paul Brook 已提交
937
        fprintf(stderr, "qemu: could not load PC BIOS '%s'\n", bios_name);
B
bellard 已提交
938 939
        exit(1);
    }
P
Paul Brook 已提交
940 941 942
    if (filename) {
        qemu_free(filename);
    }
B
bellard 已提交
943 944 945 946
    /* map the last 128KB of the BIOS in ISA space */
    isa_bios_size = bios_size;
    if (isa_bios_size > (128 * 1024))
        isa_bios_size = 128 * 1024;
947 948
    cpu_register_physical_memory(0x100000 - isa_bios_size,
                                 isa_bios_size,
B
bellard 已提交
949
                                 (bios_offset + bios_size - isa_bios_size) | IO_MEM_ROM);
950

951

952 953 954

    option_rom_offset = qemu_ram_alloc(0x20000);
    oprom_area_size = 0;
955
    cpu_register_physical_memory(0xc0000, 0x20000, option_rom_offset);
956 957

    if (using_vga) {
P
Paul Brook 已提交
958
        const char *vgabios_filename;
959 960
        /* VGA BIOS load */
        if (cirrus_vga_enabled) {
P
Paul Brook 已提交
961
            vgabios_filename = VGABIOS_CIRRUS_FILENAME;
962
        } else {
P
Paul Brook 已提交
963
            vgabios_filename = VGABIOS_FILENAME;
B
bellard 已提交
964
        }
P
Paul Brook 已提交
965
        oprom_area_size = load_option_rom(vgabios_filename, 0xc0000, 0xe0000);
966 967 968 969 970 971 972 973
    }
    /* Although video roms can grow larger than 0x8000, the area between
     * 0xc0000 - 0xc8000 is reserved for them. It means we won't be looking
     * for any other kind of option rom inside this area */
    if (oprom_area_size < 0x8000)
        oprom_area_size = 0x8000;

    if (linux_boot) {
974
        load_linux(0xc0000 + oprom_area_size,
G
Glauber Costa 已提交
975
                   kernel_filename, initrd_filename, kernel_cmdline, below_4g_mem_size);
976 977 978 979
        oprom_area_size += 2048;
    }

    for (i = 0; i < nb_option_roms; i++) {
980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996
        oprom_area_size += load_option_rom(option_rom[i], 0xc0000 + oprom_area_size,
                                           0xe0000);
    }

    for (i = 0; i < nb_nics; i++) {
        char nic_oprom[1024];
        const char *model = nd_table[i].model;

        if (!nd_table[i].bootable)
            continue;

        if (model == NULL)
            model = "ne2k_pci";
        snprintf(nic_oprom, sizeof(nic_oprom), "pxe-%s.bin", model);

        oprom_area_size += load_option_rom(nic_oprom, 0xc0000 + oprom_area_size,
                                           0xe0000);
997 998
    }

B
bellard 已提交
999
    /* map all the bios at the top of memory */
1000
    cpu_register_physical_memory((uint32_t)(-bios_size),
B
bellard 已提交
1001
                                 bios_size, bios_offset | IO_MEM_ROM);
1002

B
bellard 已提交
1003 1004
    bochs_bios_init();

1005
    cpu_irq = qemu_allocate_irqs(pic_irq_request, NULL, 1);
P
pbrook 已提交
1006 1007 1008
    i8259 = i8259_init(cpu_irq[0]);
    ferr_irq = i8259[13];

B
bellard 已提交
1009
    if (pci_enabled) {
P
pbrook 已提交
1010
        pci_bus = i440fx_init(&i440fx_state, i8259);
1011
        piix3_devfn = piix3_init(pci_bus, -1);
B
bellard 已提交
1012 1013
    } else {
        pci_bus = NULL;
B
bellard 已提交
1014 1015
    }

B
bellard 已提交
1016
    /* init basic PC hardware */
B
bellard 已提交
1017
    register_ioport_write(0x80, 1, 1, ioport80_write, NULL);
B
bellard 已提交
1018

1019 1020
    register_ioport_write(0xf0, 1, 1, ioportF0_write, NULL);

B
bellard 已提交
1021 1022
    if (cirrus_vga_enabled) {
        if (pci_enabled) {
P
Paul Brook 已提交
1023
            pci_cirrus_vga_init(pci_bus);
B
bellard 已提交
1024
        } else {
P
Paul Brook 已提交
1025
            isa_cirrus_vga_init();
B
bellard 已提交
1026
        }
1027 1028
    } else if (vmsvga_enabled) {
        if (pci_enabled)
P
Paul Brook 已提交
1029
            pci_vmsvga_init(pci_bus);
1030 1031
        else
            fprintf(stderr, "%s: vmware_vga: no PCI bus\n", __FUNCTION__);
1032
    } else if (std_vga_enabled) {
B
bellard 已提交
1033
        if (pci_enabled) {
P
Paul Brook 已提交
1034
            pci_vga_init(pci_bus, 0, 0);
B
bellard 已提交
1035
        } else {
P
Paul Brook 已提交
1036
            isa_vga_init();
B
bellard 已提交
1037
        }
B
bellard 已提交
1038
    }
B
bellard 已提交
1039

1040
    rtc_state = rtc_init(0x70, i8259[8], 2000);
B
bellard 已提交
1041

1042 1043
    qemu_register_boot_set(pc_boot_set, rtc_state);

B
bellard 已提交
1044 1045 1046
    register_ioport_read(0x92, 1, 1, ioport92_read, NULL);
    register_ioport_write(0x92, 1, 1, ioport92_write, NULL);

1047 1048 1049
    if (pci_enabled) {
        ioapic = ioapic_init();
    }
P
pbrook 已提交
1050
    pit = pit_init(0x40, i8259[0]);
B
bellard 已提交
1051
    pcspk_init(pit);
A
aliguori 已提交
1052 1053 1054
    if (!no_hpet) {
        hpet_init(i8259);
    }
1055 1056 1057
    if (pci_enabled) {
        pic_set_alt_irq_func(isa_pic, ioapic_set_irq, ioapic);
    }
B
bellard 已提交
1058

1059 1060
    for(i = 0; i < MAX_SERIAL_PORTS; i++) {
        if (serial_hds[i]) {
A
aurel32 已提交
1061 1062
            serial_init(serial_io[i], i8259[serial_irq[i]], 115200,
                        serial_hds[i]);
1063 1064
        }
    }
B
bellard 已提交
1065

1066 1067
    for(i = 0; i < MAX_PARALLEL_PORTS; i++) {
        if (parallel_hds[i]) {
P
pbrook 已提交
1068 1069
            parallel_init(parallel_io[i], i8259[parallel_irq[i]],
                          parallel_hds[i]);
1070 1071 1072
        }
    }

R
Richard W.M. Jones 已提交
1073 1074
    watchdog_pc_init(pci_bus);

1075
    for(i = 0; i < nb_nics; i++) {
1076 1077 1078
        NICInfo *nd = &nd_table[i];

        if (!pci_enabled || (nd->model && strcmp(nd->model, "ne2k_isa") == 0))
P
pbrook 已提交
1079
            pc_init_ne2k_isa(nd, i8259);
1080 1081
        else
            pci_nic_init(pci_bus, nd, -1, "ne2k_pci");
1082
    }
B
bellard 已提交
1083

1084
    piix4_acpi_system_hot_add_init();
1085

T
ths 已提交
1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098
    if (drive_get_max_bus(IF_IDE) >= MAX_IDE_BUS) {
        fprintf(stderr, "qemu: too many IDE bus\n");
        exit(1);
    }

    for(i = 0; i < MAX_IDE_BUS * MAX_IDE_DEVS; i++) {
        index = drive_get_index(IF_IDE, i / MAX_IDE_DEVS, i % MAX_IDE_DEVS);
	if (index != -1)
	    hd[i] = drives_table[index].bdrv;
	else
	    hd[i] = NULL;
    }

1099
    if (pci_enabled) {
T
ths 已提交
1100
        pci_piix3_ide_init(pci_bus, hd, piix3_devfn + 1, i8259);
1101
    } else {
T
ths 已提交
1102
        for(i = 0; i < MAX_IDE_BUS; i++) {
P
pbrook 已提交
1103
            isa_ide_init(ide_iobase[i], ide_iobase2[i], i8259[ide_irq[i]],
T
ths 已提交
1104
	                 hd[MAX_IDE_DEVS * i], hd[MAX_IDE_DEVS * i + 1]);
B
bellard 已提交
1105
        }
B
bellard 已提交
1106
    }
B
bellard 已提交
1107

P
pbrook 已提交
1108
    i8042_init(i8259[1], i8259[12], 0x60);
B
bellard 已提交
1109
    DMA_init(0);
1110
#ifdef HAS_AUDIO
P
pbrook 已提交
1111
    audio_init(pci_enabled ? pci_bus : NULL, i8259);
B
bellard 已提交
1112
#endif
B
bellard 已提交
1113

T
ths 已提交
1114 1115 1116 1117 1118 1119 1120 1121
    for(i = 0; i < MAX_FD; i++) {
        index = drive_get_index(IF_FLOPPY, 0, i);
	if (index != -1)
	    fd[i] = drives_table[index].bdrv;
	else
	    fd[i] = NULL;
    }
    floppy_controller = fdctrl_init(i8259[6], 2, 0, 0x3f0, fd);
B
bellard 已提交
1122

1123
    cmos_init(below_4g_mem_size, above_4g_mem_size, boot_device, hd);
B
bellard 已提交
1124

B
bellard 已提交
1125
    if (pci_enabled && usb_enabled) {
T
ths 已提交
1126
        usb_uhci_piix3_init(pci_bus, piix3_devfn + 2);
B
bellard 已提交
1127 1128
    }

B
bellard 已提交
1129
    if (pci_enabled && acpi_enabled) {
1130
        uint8_t *eeprom_buf = qemu_mallocz(8 * 256); /* XXX: make this persistent */
P
pbrook 已提交
1131 1132 1133
        i2c_bus *smbus;

        /* TODO: Populate SPD eeprom data.  */
A
aurel32 已提交
1134
        smbus = piix4_pm_init(pci_bus, piix3_devfn + 3, 0xb100, i8259[9]);
1135
        for (i = 0; i < 8; i++) {
P
Paul Brook 已提交
1136
            DeviceState *eeprom;
P
Paul Brook 已提交
1137
            eeprom = qdev_create((BusState *)smbus, "smbus-eeprom");
P
Paul Brook 已提交
1138 1139 1140
            qdev_set_prop_int(eeprom, "address", 0x50 + i);
            qdev_set_prop_ptr(eeprom, "data", eeprom_buf + (i * 256));
            qdev_init(eeprom);
1141
        }
B
bellard 已提交
1142
    }
1143

B
bellard 已提交
1144 1145 1146
    if (i440fx_state) {
        i440fx_init_memory_mappings(i440fx_state);
    }
T
ths 已提交
1147

P
pbrook 已提交
1148
    if (pci_enabled) {
T
ths 已提交
1149
	int max_bus;
P
Paul Brook 已提交
1150
        int bus;
1151

T
ths 已提交
1152 1153
        max_bus = drive_get_max_bus(IF_SCSI);
	for (bus = 0; bus <= max_bus; bus++) {
P
Paul Brook 已提交
1154
            pci_create_simple(pci_bus, -1, "lsi53c895a");
T
ths 已提交
1155
        }
P
pbrook 已提交
1156
    }
A
aliguori 已提交
1157 1158 1159 1160 1161 1162 1163

    /* Add virtio block devices */
    if (pci_enabled) {
        int index;
        int unit_id = 0;

        while ((index = drive_get_index(IF_VIRTIO, 0, unit_id)) != -1) {
P
Paul Brook 已提交
1164
            pci_create_simple(pci_bus, -1, "virtio-blk-pci");
A
aliguori 已提交
1165 1166 1167
            unit_id++;
        }
    }
A
aliguori 已提交
1168 1169

    /* Add virtio balloon device */
1170
    if (pci_enabled && !no_virtio_balloon) {
P
Paul Brook 已提交
1171
        pci_create_simple(pci_bus, -1, "virtio-balloon-pci");
P
Paul Brook 已提交
1172
    }
1173 1174 1175 1176

    /* Add virtio console devices */
    if (pci_enabled) {
        for(i = 0; i < MAX_VIRTIO_CONSOLES; i++) {
P
Paul Brook 已提交
1177
            if (virtcon_hds[i]) {
P
Paul Brook 已提交
1178
                pci_create_simple(pci_bus, -1, "virtio-console-pci");
P
Paul Brook 已提交
1179
            }
1180 1181
        }
    }
B
bellard 已提交
1182
}
B
bellard 已提交
1183

P
Paul Brook 已提交
1184
static void pc_init_pci(ram_addr_t ram_size,
1185
                        const char *boot_device,
1186
                        const char *kernel_filename,
1187
                        const char *kernel_cmdline,
1188 1189
                        const char *initrd_filename,
                        const char *cpu_model)
1190
{
P
Paul Brook 已提交
1191
    pc_init1(ram_size, boot_device,
1192
             kernel_filename, kernel_cmdline,
1193
             initrd_filename, 1, cpu_model);
1194 1195
}

P
Paul Brook 已提交
1196
static void pc_init_isa(ram_addr_t ram_size,
1197
                        const char *boot_device,
1198
                        const char *kernel_filename,
1199
                        const char *kernel_cmdline,
1200 1201
                        const char *initrd_filename,
                        const char *cpu_model)
1202
{
P
Paul Brook 已提交
1203
    pc_init1(ram_size, boot_device,
1204
             kernel_filename, kernel_cmdline,
1205
             initrd_filename, 0, cpu_model);
1206 1207
}

A
aliguori 已提交
1208 1209 1210 1211 1212 1213 1214 1215
/* set CMOS shutdown status register (index 0xF) as S3_resume(0xFE)
   BIOS will read it and start S3 resume at POST Entry */
void cmos_set_s3_resume(void)
{
    if (rtc_state)
        rtc_set_memory(rtc_state, 0xF, 0xFE);
}

1216
static QEMUMachine pc_machine = {
A
aurel32 已提交
1217 1218 1219
    .name = "pc",
    .desc = "Standard PC",
    .init = pc_init_pci,
1220
    .max_cpus = 255,
1221
    .is_default = 1,
1222 1223
};

1224
static QEMUMachine isapc_machine = {
A
aurel32 已提交
1225 1226 1227
    .name = "isapc",
    .desc = "ISA-only PC",
    .init = pc_init_isa,
1228
    .max_cpus = 1,
B
bellard 已提交
1229
};
1230 1231 1232 1233 1234 1235 1236 1237

static void pc_machine_init(void)
{
    qemu_register_machine(&pc_machine);
    qemu_register_machine(&isapc_machine);
}

machine_init(pc_machine_init);