Archipelago » qemu

/*

 * Renesas SH7751R R2D-PLUS emulation

 *

 * Copyright (c) 2007 Magnus Damm

 * Copyright (c) 2008 Paul Mundt

 *

 * 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.

 */

#include "sysbus.h"

#include "hw.h"

#include "sh.h"

#include "devices.h"

#include "sysemu.h"

#include "boards.h"

#include "pci.h"

#include "net.h"

#include "sh7750_regs.h"

#include "ide.h"

#include "loader.h"

#include "usb.h"

#include "flash.h"

#include "blockdev.h"

#define FLASH_BASE 0x00000000

#define FLASH_SIZE 0x02000000

#define SDRAM_BASE 0x0c000000 /* Physical location of SDRAM: Area 3 */

#define SDRAM_SIZE 0x04000000

#define SM501_VRAM_SIZE 0x800000

#define BOOT_PARAMS_OFFSET 0x0010000

/* CONFIG_BOOT_LINK_OFFSET of Linux kernel */

#define LINUX_LOAD_OFFSET  0x0800000

#define INITRD_LOAD_OFFSET 0x1800000

#define PA_IRLMSK        0x00

#define PA_POWOFF        0x30

#define PA_VERREG        0x32

#define PA_OUTPORT        0x36

typedef struct {

    uint16_t bcr;

    uint16_t irlmsk;

    uint16_t irlmon;

    uint16_t cfctl;

    uint16_t cfpow;

    uint16_t dispctl;

    uint16_t sdmpow;

    uint16_t rtcce;

    uint16_t pcicd;

    uint16_t voyagerrts;

    uint16_t cfrst;

    uint16_t admrts;

    uint16_t extrst;

    uint16_t cfcdintclr;

    uint16_t keyctlclr;

    uint16_t pad0;

    uint16_t pad1;

    uint16_t verreg;

    uint16_t inport;

    uint16_t outport;

    uint16_t bverreg;

/* output pin */

    qemu_irq irl;

} r2d_fpga_t;

enum r2d_fpga_irq {

    PCI_INTD, CF_IDE, CF_CD, PCI_INTC, SM501, KEY, RTC_A, RTC_T,

    SDCARD, PCI_INTA, PCI_INTB, EXT, TP,

    NR_IRQS

};

static const struct { short irl; uint16_t msk; } irqtab[NR_IRQS] = {

    [CF_IDE]        = {  1, 1<<9 },

    [CF_CD]        = {  2, 1<<8 },

    [PCI_INTA]        = {  9, 1<<14 },

    [PCI_INTB]        = { 10, 1<<13 },

    [PCI_INTC]        = {  3, 1<<12 },

    [PCI_INTD]        = {  0, 1<<11 },

    [SM501]        = {  4, 1<<10 },

    [KEY]        = {  5, 1<<6 },

    [RTC_A]        = {  6, 1<<5 },

    [RTC_T]        = {  7, 1<<4 },

    [SDCARD]        = {  8, 1<<7 },

    [EXT]        = { 11, 1<<0 },

    [TP]        = { 12, 1<<15 },

};

static void update_irl(r2d_fpga_t *fpga)

{

    int i, irl = 15;

    for (i = 0; i < NR_IRQS; i++)

        if (fpga->irlmon & fpga->irlmsk & irqtab[i].msk)

            if (irqtab[i].irl < irl)

                irl = irqtab[i].irl;

    qemu_set_irq(fpga->irl, irl ^ 15);

}

static void r2d_fpga_irq_set(void *opaque, int n, int level)

{

    r2d_fpga_t *fpga = opaque;

    if (level)

        fpga->irlmon |= irqtab[n].msk;

    else

        fpga->irlmon &= ~irqtab[n].msk;

    update_irl(fpga);

}

static uint32_t r2d_fpga_read(void *opaque, target_phys_addr_t addr)

{

    r2d_fpga_t *s = opaque;

    switch (addr) {

    case PA_IRLMSK:

        return s->irlmsk;

    case PA_OUTPORT:

        return s->outport;

    case PA_POWOFF:

        return 0x00;

    case PA_VERREG:

        return 0x10;

    }

    return 0;

}

static void

r2d_fpga_write(void *opaque, target_phys_addr_t addr, uint32_t value)

{

    r2d_fpga_t *s = opaque;

    switch (addr) {

    case PA_IRLMSK:

        s->irlmsk = value;

        update_irl(s);

        break;

    case PA_OUTPORT:

        s->outport = value;

        break;

    case PA_POWOFF:

        if (value & 1) {

            qemu_system_shutdown_request();

        }

        break;

    case PA_VERREG:

        /* Discard writes */

        break;

    }

}

static CPUReadMemoryFunc * const r2d_fpga_readfn[] = {

    r2d_fpga_read,

    r2d_fpga_read,

    NULL,

};

static CPUWriteMemoryFunc * const r2d_fpga_writefn[] = {

    r2d_fpga_write,

    r2d_fpga_write,

    NULL,

};

static qemu_irq *r2d_fpga_init(target_phys_addr_t base, qemu_irq irl)

{

    int iomemtype;

    r2d_fpga_t *s;

    s = g_malloc0(sizeof(r2d_fpga_t));

    s->irl = irl;

    iomemtype = cpu_register_io_memory(r2d_fpga_readfn,

                                       r2d_fpga_writefn, s,

                                       DEVICE_NATIVE_ENDIAN);

    cpu_register_physical_memory(base, 0x40, iomemtype);

    return qemu_allocate_irqs(r2d_fpga_irq_set, s, NR_IRQS);

}

typedef struct ResetData {

    CPUState *env;

    uint32_t vector;

} ResetData;

static void main_cpu_reset(void *opaque)

{

    ResetData *s = (ResetData *)opaque;

    CPUState *env = s->env;

    cpu_reset(env);

    env->pc = s->vector;

}

static struct __attribute__((__packed__))

{

    int mount_root_rdonly;

    int ramdisk_flags;

    int orig_root_dev;

    int loader_type;

    int initrd_start;

    int initrd_size;

    char pad[232];

    char kernel_cmdline[256];

} boot_params;

static void r2d_init(ram_addr_t ram_size,

              const char *boot_device,

              const char *kernel_filename, const char *kernel_cmdline,

              const char *initrd_filename, const char *cpu_model)

{

    CPUState *env;

    ResetData *reset_info;

    struct SH7750State *s;

    ram_addr_t sdram_addr;

    qemu_irq *irq;

    DriveInfo *dinfo;

    int i;

    if (!cpu_model)

        cpu_model = "SH7751R";

    env = cpu_init(cpu_model);

    if (!env) {

        fprintf(stderr, "Unable to find CPU definition\n");

        exit(1);

    }

    reset_info = g_malloc0(sizeof(ResetData));

    reset_info->env = env;

    reset_info->vector = env->pc;

    qemu_register_reset(main_cpu_reset, reset_info);

    /* Allocate memory space */

    sdram_addr = qemu_ram_alloc(NULL, "r2d.sdram", SDRAM_SIZE);

    cpu_register_physical_memory(SDRAM_BASE, SDRAM_SIZE, sdram_addr);

    /* Register peripherals */

    s = sh7750_init(env);

    irq = r2d_fpga_init(0x04000000, sh7750_irl(s));

    sysbus_create_varargs("sh_pci", 0x1e200000, irq[PCI_INTA], irq[PCI_INTB],

                          irq[PCI_INTC], irq[PCI_INTD], NULL);

    sm501_init(0x10000000, SM501_VRAM_SIZE, irq[SM501], serial_hds[2]);

    /* onboard CF (True IDE mode, Master only). */

    dinfo = drive_get(IF_IDE, 0, 0);

    mmio_ide_init(0x14001000, 0x1400080c, irq[CF_IDE], 1,

                  dinfo, NULL);

    /* onboard flash memory */

    dinfo = drive_get(IF_PFLASH, 0, 0);

    pflash_cfi02_register(0x0, qemu_ram_alloc(NULL, "r2d.flash", FLASH_SIZE),

                          dinfo ? dinfo->bdrv : NULL, (16 * 1024),

                          FLASH_SIZE >> 16,

                          1, 4, 0x0000, 0x0000, 0x0000, 0x0000,

                          0x555, 0x2aa, 0);

    /* NIC: rtl8139 on-board, and 2 slots. */

    for (i = 0; i < nb_nics; i++)

        pci_nic_init_nofail(&nd_table[i], "rtl8139", i==0 ? "2" : NULL);

    /* USB keyboard */

    usbdevice_create("keyboard");

    /* Todo: register on board registers */

    memset(&boot_params, 0, sizeof(boot_params));

    if (kernel_filename) {

        int kernel_size;

        kernel_size = load_image_targphys(kernel_filename,

                                          SDRAM_BASE + LINUX_LOAD_OFFSET,

                                          INITRD_LOAD_OFFSET - LINUX_LOAD_OFFSET);

        if (kernel_size < 0) {

          fprintf(stderr, "qemu: could not load kernel '%s'\n", kernel_filename);

          exit(1);

        }

        /* initialization which should be done by firmware */

        stl_phys(SH7750_BCR1, 1<<3); /* cs3 SDRAM */

        stw_phys(SH7750_BCR2, 3<<(3*2)); /* cs3 32bit */

        reset_info->vector = (SDRAM_BASE + LINUX_LOAD_OFFSET) | 0xa0000000; /* Start from P2 area */

    }

    if (initrd_filename) {

        int initrd_size;

        initrd_size = load_image_targphys(initrd_filename,

                                          SDRAM_BASE + INITRD_LOAD_OFFSET,

                                          SDRAM_SIZE - INITRD_LOAD_OFFSET);

        if (initrd_size < 0) {

          fprintf(stderr, "qemu: could not load initrd '%s'\n", initrd_filename);

          exit(1);

        }

        /* initialization which should be done by firmware */

        boot_params.loader_type = 1;

        boot_params.initrd_start = INITRD_LOAD_OFFSET;

        boot_params.initrd_size = initrd_size;

    }

    if (kernel_cmdline) {

        strncpy(boot_params.kernel_cmdline, kernel_cmdline,

                sizeof(boot_params.kernel_cmdline));

    }

    rom_add_blob_fixed("boot_params", &boot_params, sizeof(boot_params),

                       SDRAM_BASE + BOOT_PARAMS_OFFSET);

}

static QEMUMachine r2d_machine = {

    .name = "r2d",

    .desc = "r2d-plus board",

    .init = r2d_init,

};

static void r2d_machine_init(void)

{

    qemu_register_machine(&r2d_machine);

}

machine_init(r2d_machine_init);