220 lines
6.8 KiB
C
220 lines
6.8 KiB
C
/*
|
|
* QEMU model for the Milkymist board.
|
|
*
|
|
* Copyright (c) 2010 Michael Walle <michael@walle.cc>
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2 of the License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
* License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "hw/sysbus.h"
|
|
#include "hw/hw.h"
|
|
#include "hw/block/flash.h"
|
|
#include "sysemu/sysemu.h"
|
|
#include "sysemu/qtest.h"
|
|
#include "hw/devices.h"
|
|
#include "hw/boards.h"
|
|
#include "hw/loader.h"
|
|
#include "elf.h"
|
|
#include "sysemu/blockdev.h"
|
|
#include "milkymist-hw.h"
|
|
#include "lm32.h"
|
|
#include "exec/address-spaces.h"
|
|
|
|
#define BIOS_FILENAME "mmone-bios.bin"
|
|
#define BIOS_OFFSET 0x00860000
|
|
#define BIOS_SIZE (512*1024)
|
|
#define KERNEL_LOAD_ADDR 0x40000000
|
|
|
|
typedef struct {
|
|
LM32CPU *cpu;
|
|
hwaddr bootstrap_pc;
|
|
hwaddr flash_base;
|
|
hwaddr initrd_base;
|
|
size_t initrd_size;
|
|
hwaddr cmdline_base;
|
|
} ResetInfo;
|
|
|
|
static void cpu_irq_handler(void *opaque, int irq, int level)
|
|
{
|
|
LM32CPU *cpu = opaque;
|
|
CPUState *cs = CPU(cpu);
|
|
|
|
if (level) {
|
|
cpu_interrupt(cs, CPU_INTERRUPT_HARD);
|
|
} else {
|
|
cpu_reset_interrupt(cs, CPU_INTERRUPT_HARD);
|
|
}
|
|
}
|
|
|
|
static void main_cpu_reset(void *opaque)
|
|
{
|
|
ResetInfo *reset_info = opaque;
|
|
CPULM32State *env = &reset_info->cpu->env;
|
|
|
|
cpu_reset(CPU(reset_info->cpu));
|
|
|
|
/* init defaults */
|
|
env->pc = reset_info->bootstrap_pc;
|
|
env->regs[R_R1] = reset_info->cmdline_base;
|
|
env->regs[R_R2] = reset_info->initrd_base;
|
|
env->regs[R_R3] = reset_info->initrd_base + reset_info->initrd_size;
|
|
env->eba = reset_info->flash_base;
|
|
env->deba = reset_info->flash_base;
|
|
}
|
|
|
|
static void
|
|
milkymist_init(QEMUMachineInitArgs *args)
|
|
{
|
|
const char *cpu_model = args->cpu_model;
|
|
const char *kernel_filename = args->kernel_filename;
|
|
const char *kernel_cmdline = args->kernel_cmdline;
|
|
const char *initrd_filename = args->initrd_filename;
|
|
LM32CPU *cpu;
|
|
CPULM32State *env;
|
|
int kernel_size;
|
|
DriveInfo *dinfo;
|
|
MemoryRegion *address_space_mem = get_system_memory();
|
|
MemoryRegion *phys_sdram = g_new(MemoryRegion, 1);
|
|
qemu_irq irq[32], *cpu_irq;
|
|
int i;
|
|
char *bios_filename;
|
|
ResetInfo *reset_info;
|
|
|
|
/* memory map */
|
|
hwaddr flash_base = 0x00000000;
|
|
size_t flash_sector_size = 128 * 1024;
|
|
size_t flash_size = 32 * 1024 * 1024;
|
|
hwaddr sdram_base = 0x40000000;
|
|
size_t sdram_size = 128 * 1024 * 1024;
|
|
|
|
hwaddr initrd_base = sdram_base + 0x1002000;
|
|
hwaddr cmdline_base = sdram_base + 0x1000000;
|
|
size_t initrd_max = sdram_size - 0x1002000;
|
|
|
|
reset_info = g_malloc0(sizeof(ResetInfo));
|
|
|
|
if (cpu_model == NULL) {
|
|
cpu_model = "lm32-full";
|
|
}
|
|
cpu = cpu_lm32_init(cpu_model);
|
|
env = &cpu->env;
|
|
reset_info->cpu = cpu;
|
|
|
|
cpu_lm32_set_phys_msb_ignore(env, 1);
|
|
|
|
memory_region_init_ram(phys_sdram, NULL, "milkymist.sdram", sdram_size);
|
|
vmstate_register_ram_global(phys_sdram);
|
|
memory_region_add_subregion(address_space_mem, sdram_base, phys_sdram);
|
|
|
|
dinfo = drive_get(IF_PFLASH, 0, 0);
|
|
/* Numonyx JS28F256J3F105 */
|
|
pflash_cfi01_register(flash_base, NULL, "milkymist.flash", flash_size,
|
|
dinfo ? dinfo->bdrv : NULL, flash_sector_size,
|
|
flash_size / flash_sector_size, 2,
|
|
0x00, 0x89, 0x00, 0x1d, 1);
|
|
|
|
/* create irq lines */
|
|
cpu_irq = qemu_allocate_irqs(cpu_irq_handler, cpu, 1);
|
|
env->pic_state = lm32_pic_init(*cpu_irq);
|
|
for (i = 0; i < 32; i++) {
|
|
irq[i] = qdev_get_gpio_in(env->pic_state, i);
|
|
}
|
|
|
|
/* load bios rom */
|
|
if (bios_name == NULL) {
|
|
bios_name = BIOS_FILENAME;
|
|
}
|
|
bios_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, bios_name);
|
|
|
|
if (bios_filename) {
|
|
load_image_targphys(bios_filename, BIOS_OFFSET, BIOS_SIZE);
|
|
}
|
|
|
|
reset_info->bootstrap_pc = BIOS_OFFSET;
|
|
|
|
/* if no kernel is given no valid bios rom is a fatal error */
|
|
if (!kernel_filename && !dinfo && !bios_filename && !qtest_enabled()) {
|
|
fprintf(stderr, "qemu: could not load Milkymist One bios '%s'\n",
|
|
bios_name);
|
|
exit(1);
|
|
}
|
|
|
|
milkymist_uart_create(0x60000000, irq[0]);
|
|
milkymist_sysctl_create(0x60001000, irq[1], irq[2], irq[3],
|
|
80000000, 0x10014d31, 0x0000041f, 0x00000001);
|
|
milkymist_hpdmc_create(0x60002000);
|
|
milkymist_vgafb_create(0x60003000, 0x40000000, 0x0fffffff);
|
|
milkymist_memcard_create(0x60004000);
|
|
milkymist_ac97_create(0x60005000, irq[4], irq[5], irq[6], irq[7]);
|
|
milkymist_pfpu_create(0x60006000, irq[8]);
|
|
milkymist_tmu2_create(0x60007000, irq[9]);
|
|
milkymist_minimac2_create(0x60008000, 0x30000000, irq[10], irq[11]);
|
|
milkymist_softusb_create(0x6000f000, irq[15],
|
|
0x20000000, 0x1000, 0x20020000, 0x2000);
|
|
|
|
/* make sure juart isn't the first chardev */
|
|
env->juart_state = lm32_juart_init();
|
|
|
|
if (kernel_filename) {
|
|
uint64_t entry;
|
|
|
|
/* Boots a kernel elf binary. */
|
|
kernel_size = load_elf(kernel_filename, NULL, NULL, &entry, NULL, NULL,
|
|
1, ELF_MACHINE, 0);
|
|
reset_info->bootstrap_pc = entry;
|
|
|
|
if (kernel_size < 0) {
|
|
kernel_size = load_image_targphys(kernel_filename, sdram_base,
|
|
sdram_size);
|
|
reset_info->bootstrap_pc = sdram_base;
|
|
}
|
|
|
|
if (kernel_size < 0) {
|
|
fprintf(stderr, "qemu: could not load kernel '%s'\n",
|
|
kernel_filename);
|
|
exit(1);
|
|
}
|
|
}
|
|
|
|
if (kernel_cmdline && strlen(kernel_cmdline)) {
|
|
pstrcpy_targphys("cmdline", cmdline_base, TARGET_PAGE_SIZE,
|
|
kernel_cmdline);
|
|
reset_info->cmdline_base = (uint32_t)cmdline_base;
|
|
}
|
|
|
|
if (initrd_filename) {
|
|
size_t initrd_size;
|
|
initrd_size = load_image_targphys(initrd_filename, initrd_base,
|
|
initrd_max);
|
|
reset_info->initrd_base = (uint32_t)initrd_base;
|
|
reset_info->initrd_size = (uint32_t)initrd_size;
|
|
}
|
|
|
|
qemu_register_reset(main_cpu_reset, reset_info);
|
|
}
|
|
|
|
static QEMUMachine milkymist_machine = {
|
|
.name = "milkymist",
|
|
.desc = "Milkymist One",
|
|
.init = milkymist_init,
|
|
.is_default = 0,
|
|
};
|
|
|
|
static void milkymist_machine_init(void)
|
|
{
|
|
qemu_register_machine(&milkymist_machine);
|
|
}
|
|
|
|
machine_init(milkymist_machine_init);
|