[qemu.git] / hw / xtensa / xtfpga.c

/*
 * Copyright (c) 2011, Max Filippov, Open Source and Linux Lab.
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above copyright
 *       notice, this list of conditions and the following disclaimer in the
 *       documentation and/or other materials provided with the distribution.
 *     * Neither the name of the Open Source and Linux Lab nor the
 *       names of its contributors may be used to endorse or promote products
 *       derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include "sysemu/sysemu.h"
#include "hw/boards.h"
#include "hw/loader.h"
#include "elf.h"
#include "exec/memory.h"
#include "exec/address-spaces.h"
#include "hw/char/serial.h"
#include "net/net.h"
#include "hw/sysbus.h"
#include "hw/block/flash.h"
#include "sysemu/block-backend.h"
#include "sysemu/char.h"
#include "sysemu/device_tree.h"
#include "qemu/error-report.h"
#include "bootparam.h"

typedef struct LxBoardDesc {
    hwaddr flash_base;
    size_t flash_size;
    size_t flash_boot_base;
    size_t flash_sector_size;
    size_t sram_size;
} LxBoardDesc;

typedef struct Lx60FpgaState {
    MemoryRegion iomem;
    uint32_t leds;
    uint32_t switches;
} Lx60FpgaState;

static void lx60_fpga_reset(void *opaque)
{
    Lx60FpgaState *s = opaque;

    s->leds = 0;
    s->switches = 0;
}

static uint64_t lx60_fpga_read(void *opaque, hwaddr addr,
        unsigned size)
{
    Lx60FpgaState *s = opaque;

    switch (addr) {
    case 0x0: /*build date code*/
        return 0x09272011;

    case 0x4: /*processor clock frequency, Hz*/
        return 10000000;

    case 0x8: /*LEDs (off = 0, on = 1)*/
        return s->leds;

    case 0xc: /*DIP switches (off = 0, on = 1)*/
        return s->switches;
    }
    return 0;
}

static void lx60_fpga_write(void *opaque, hwaddr addr,
        uint64_t val, unsigned size)
{
    Lx60FpgaState *s = opaque;

    switch (addr) {
    case 0x8: /*LEDs (off = 0, on = 1)*/
        s->leds = val;
        break;

    case 0x10: /*board reset*/
        if (val == 0xdead) {
            qemu_system_reset_request();
        }
        break;
    }
}

static const MemoryRegionOps lx60_fpga_ops = {
    .read = lx60_fpga_read,
    .write = lx60_fpga_write,
    .endianness = DEVICE_NATIVE_ENDIAN,
};

static Lx60FpgaState *lx60_fpga_init(MemoryRegion *address_space,
        hwaddr base)
{
    Lx60FpgaState *s = g_malloc(sizeof(Lx60FpgaState));

    memory_region_init_io(&s->iomem, NULL, &lx60_fpga_ops, s,
            "lx60.fpga", 0x10000);
    memory_region_add_subregion(address_space, base, &s->iomem);
    lx60_fpga_reset(s);
    qemu_register_reset(lx60_fpga_reset, s);
    return s;
}

static void lx60_net_init(MemoryRegion *address_space,
        hwaddr base,
        hwaddr descriptors,
        hwaddr buffers,
        qemu_irq irq, NICInfo *nd)
{
    DeviceState *dev;
    SysBusDevice *s;
    MemoryRegion *ram;

    dev = qdev_create(NULL, "open_eth");
    qdev_set_nic_properties(dev, nd);
    qdev_init_nofail(dev);

    s = SYS_BUS_DEVICE(dev);
    sysbus_connect_irq(s, 0, irq);
    memory_region_add_subregion(address_space, base,
            sysbus_mmio_get_region(s, 0));
    memory_region_add_subregion(address_space, descriptors,
            sysbus_mmio_get_region(s, 1));

    ram = g_malloc(sizeof(*ram));
    memory_region_init_ram(ram, OBJECT(s), "open_eth.ram", 16384, &error_abort);
    vmstate_register_ram_global(ram);
    memory_region_add_subregion(address_space, buffers, ram);
}

static uint64_t translate_phys_addr(void *opaque, uint64_t addr)
{
    XtensaCPU *cpu = opaque;

    return cpu_get_phys_page_debug(CPU(cpu), addr);
}

static void lx60_reset(void *opaque)
{
    XtensaCPU *cpu = opaque;

    cpu_reset(CPU(cpu));
}

static uint64_t lx60_io_read(void *opaque, hwaddr addr,
        unsigned size)
{
    return 0;
}

static void lx60_io_write(void *opaque, hwaddr addr,
        uint64_t val, unsigned size)
{
}

static const MemoryRegionOps lx60_io_ops = {
    .read = lx60_io_read,
    .write = lx60_io_write,
    .endianness = DEVICE_NATIVE_ENDIAN,
};

static void lx_init(const LxBoardDesc *board, MachineState *machine)
{
#ifdef TARGET_WORDS_BIGENDIAN
    int be = 1;
#else
    int be = 0;
#endif
    MemoryRegion *system_memory = get_system_memory();
    XtensaCPU *cpu = NULL;
    CPUXtensaState *env = NULL;
    MemoryRegion *ram, *rom, *system_io;
    DriveInfo *dinfo;
    pflash_t *flash = NULL;
    QemuOpts *machine_opts = qemu_get_machine_opts();
    const char *cpu_model = machine->cpu_model;
    const char *kernel_filename = qemu_opt_get(machine_opts, "kernel");
    const char *kernel_cmdline = qemu_opt_get(machine_opts, "append");
    const char *dtb_filename = qemu_opt_get(machine_opts, "dtb");
    const char *initrd_filename = qemu_opt_get(machine_opts, "initrd");
    int n;

    if (!cpu_model) {
        cpu_model = XTENSA_DEFAULT_CPU_MODEL;
    }

    for (n = 0; n < smp_cpus; n++) {
        cpu = cpu_xtensa_init(cpu_model);
        if (cpu == NULL) {
            error_report("unable to find CPU definition '%s'\n",
                         cpu_model);
            exit(EXIT_FAILURE);
        }
        env = &cpu->env;

        env->sregs[PRID] = n;
        qemu_register_reset(lx60_reset, cpu);
        /* Need MMU initialized prior to ELF loading,
         * so that ELF gets loaded into virtual addresses
         */
        cpu_reset(CPU(cpu));
    }

    ram = g_malloc(sizeof(*ram));
    memory_region_init_ram(ram, NULL, "lx60.dram", machine->ram_size,
                           &error_abort);
    vmstate_register_ram_global(ram);
    memory_region_add_subregion(system_memory, 0, ram);

    system_io = g_malloc(sizeof(*system_io));
    memory_region_init_io(system_io, NULL, &lx60_io_ops, NULL, "lx60.io",
                          224 * 1024 * 1024);
    memory_region_add_subregion(system_memory, 0xf0000000, system_io);
    lx60_fpga_init(system_io, 0x0d020000);
    if (nd_table[0].used) {
        lx60_net_init(system_io, 0x0d030000, 0x0d030400, 0x0d800000,
                xtensa_get_extint(env, 1), nd_table);
    }

    if (!serial_hds[0]) {
        serial_hds[0] = qemu_chr_new("serial0", "null", NULL);
    }

    serial_mm_init(system_io, 0x0d050020, 2, xtensa_get_extint(env, 0),
            115200, serial_hds[0], DEVICE_NATIVE_ENDIAN);

    dinfo = drive_get(IF_PFLASH, 0, 0);
    if (dinfo) {
        flash = pflash_cfi01_register(board->flash_base,
                NULL, "lx60.io.flash", board->flash_size,
                blk_by_legacy_dinfo(dinfo),
                board->flash_sector_size,
                board->flash_size / board->flash_sector_size,
                4, 0x0000, 0x0000, 0x0000, 0x0000, be);
        if (flash == NULL) {
            error_report("unable to mount pflash\n");
            exit(EXIT_FAILURE);
        }
    }

    /* Use presence of kernel file name as 'boot from SRAM' switch. */
    if (kernel_filename) {
        uint32_t entry_point = env->pc;
        size_t bp_size = 3 * get_tag_size(0); /* first/last and memory tags */
        uint32_t tagptr = 0xfe000000 + board->sram_size;
        uint32_t cur_tagptr;
        BpMemInfo memory_location = {
            .type = tswap32(MEMORY_TYPE_CONVENTIONAL),
            .start = tswap32(0),
            .end = tswap32(machine->ram_size),
        };
        uint32_t lowmem_end = machine->ram_size < 0x08000000 ?
            machine->ram_size : 0x08000000;
        uint32_t cur_lowmem = QEMU_ALIGN_UP(lowmem_end / 2, 4096);

        rom = g_malloc(sizeof(*rom));
        memory_region_init_ram(rom, NULL, "lx60.sram", board->sram_size,
                               &error_abort);
        vmstate_register_ram_global(rom);
        memory_region_add_subregion(system_memory, 0xfe000000, rom);

        if (kernel_cmdline) {
            bp_size += get_tag_size(strlen(kernel_cmdline) + 1);
        }
        if (dtb_filename) {
            bp_size += get_tag_size(sizeof(uint32_t));
        }
        if (initrd_filename) {
            bp_size += get_tag_size(sizeof(BpMemInfo));
        }

        /* Put kernel bootparameters to the end of that SRAM */
        tagptr = (tagptr - bp_size) & ~0xff;
        cur_tagptr = put_tag(tagptr, BP_TAG_FIRST, 0, NULL);
        cur_tagptr = put_tag(cur_tagptr, BP_TAG_MEMORY,
                             sizeof(memory_location), &memory_location);

        if (kernel_cmdline) {
            cur_tagptr = put_tag(cur_tagptr, BP_TAG_COMMAND_LINE,
                                 strlen(kernel_cmdline) + 1, kernel_cmdline);
        }
        if (dtb_filename) {
            int fdt_size;
            void *fdt = load_device_tree(dtb_filename, &fdt_size);
            uint32_t dtb_addr = tswap32(cur_lowmem);

            if (!fdt) {
                error_report("could not load DTB '%s'\n", dtb_filename);
                exit(EXIT_FAILURE);
            }

            cpu_physical_memory_write(cur_lowmem, fdt, fdt_size);
            cur_tagptr = put_tag(cur_tagptr, BP_TAG_FDT,
                                 sizeof(dtb_addr), &dtb_addr);
            cur_lowmem = QEMU_ALIGN_UP(cur_lowmem + fdt_size, 4096);
        }
        if (initrd_filename) {
            BpMemInfo initrd_location = { 0 };
            int initrd_size = load_ramdisk(initrd_filename, cur_lowmem,
                                           lowmem_end - cur_lowmem);

            if (initrd_size < 0) {
                initrd_size = load_image_targphys(initrd_filename,
                                                  cur_lowmem,
                                                  lowmem_end - cur_lowmem);
            }
            if (initrd_size < 0) {
                error_report("could not load initrd '%s'\n", initrd_filename);
                exit(EXIT_FAILURE);
            }
            initrd_location.start = tswap32(cur_lowmem);
            initrd_location.end = tswap32(cur_lowmem + initrd_size);
            cur_tagptr = put_tag(cur_tagptr, BP_TAG_INITRD,
                                 sizeof(initrd_location), &initrd_location);
            cur_lowmem = QEMU_ALIGN_UP(cur_lowmem + initrd_size, 4096);
        }
        cur_tagptr = put_tag(cur_tagptr, BP_TAG_LAST, 0, NULL);
        env->regs[2] = tagptr;

        uint64_t elf_entry;
        uint64_t elf_lowaddr;
        int success = load_elf(kernel_filename, translate_phys_addr, cpu,
                &elf_entry, &elf_lowaddr, NULL, be, ELF_MACHINE, 0);
        if (success > 0) {
            entry_point = elf_entry;
        } else {
            hwaddr ep;
            int is_linux;
            success = load_uimage(kernel_filename, &ep, NULL, &is_linux,
                                  translate_phys_addr, cpu);
            if (success > 0 && is_linux) {
                entry_point = ep;
            } else {
                error_report("could not load kernel '%s'\n",
                             kernel_filename);
                exit(EXIT_FAILURE);
            }
        }
        if (entry_point != env->pc) {
            static const uint8_t jx_a0[] = {
#ifdef TARGET_WORDS_BIGENDIAN
                0x0a, 0, 0,
#else
                0xa0, 0, 0,
#endif
            };
            env->regs[0] = entry_point;
            cpu_physical_memory_write(env->pc, jx_a0, sizeof(jx_a0));
        }
    } else {
        if (flash) {
            MemoryRegion *flash_mr = pflash_cfi01_get_memory(flash);
            MemoryRegion *flash_io = g_malloc(sizeof(*flash_io));

            memory_region_init_alias(flash_io, NULL, "lx60.flash",
                    flash_mr, board->flash_boot_base,
                    board->flash_size - board->flash_boot_base < 0x02000000 ?
                    board->flash_size - board->flash_boot_base : 0x02000000);
            memory_region_add_subregion(system_memory, 0xfe000000,
                    flash_io);
        }
    }
}

static void xtensa_lx60_init(MachineState *machine)
{
    static const LxBoardDesc lx60_board = {
        .flash_base = 0xf8000000,
        .flash_size = 0x00400000,
        .flash_sector_size = 0x10000,
        .sram_size = 0x20000,
    };
    lx_init(&lx60_board, machine);
}

static void xtensa_lx200_init(MachineState *machine)
{
    static const LxBoardDesc lx200_board = {
        .flash_base = 0xf8000000,
        .flash_size = 0x01000000,
        .flash_sector_size = 0x20000,
        .sram_size = 0x2000000,
    };
    lx_init(&lx200_board, machine);
}

static void xtensa_ml605_init(MachineState *machine)
{
    static const LxBoardDesc ml605_board = {
        .flash_base = 0xf8000000,
        .flash_size = 0x01000000,
        .flash_sector_size = 0x20000,
        .sram_size = 0x2000000,
    };
    lx_init(&ml605_board, machine);
}

static void xtensa_kc705_init(MachineState *machine)
{
    static const LxBoardDesc kc705_board = {
        .flash_base = 0xf0000000,
        .flash_size = 0x08000000,
        .flash_boot_base = 0x06000000,
        .flash_sector_size = 0x20000,
        .sram_size = 0x2000000,
    };
    lx_init(&kc705_board, machine);
}

static QEMUMachine xtensa_lx60_machine = {
    .name = "lx60",
    .desc = "lx60 EVB (" XTENSA_DEFAULT_CPU_MODEL ")",
    .init = xtensa_lx60_init,
    .max_cpus = 4,
};

static QEMUMachine xtensa_lx200_machine = {
    .name = "lx200",
    .desc = "lx200 EVB (" XTENSA_DEFAULT_CPU_MODEL ")",
    .init = xtensa_lx200_init,
    .max_cpus = 4,
};

static QEMUMachine xtensa_ml605_machine = {
    .name = "ml605",
    .desc = "ml605 EVB (" XTENSA_DEFAULT_CPU_MODEL ")",
    .init = xtensa_ml605_init,
    .max_cpus = 4,
};

static QEMUMachine xtensa_kc705_machine = {
    .name = "kc705",
    .desc = "kc705 EVB (" XTENSA_DEFAULT_CPU_MODEL ")",
    .init = xtensa_kc705_init,
    .max_cpus = 4,
};

static void xtensa_lx_machines_init(void)
{
    qemu_register_machine(&xtensa_lx60_machine);
    qemu_register_machine(&xtensa_lx200_machine);
    qemu_register_machine(&xtensa_ml605_machine);
    qemu_register_machine(&xtensa_kc705_machine);
}

machine_init(xtensa_lx_machines_init);
Commit	Line	Data
0200db65 MF	1	/*
	2	* Copyright (c) 2011, Max Filippov, Open Source and Linux Lab.
	3	* All rights reserved.
	4	*
	5	* Redistribution and use in source and binary forms, with or without
	6	* modification, are permitted provided that the following conditions are met:
	7	* * Redistributions of source code must retain the above copyright
	8	* notice, this list of conditions and the following disclaimer.
	9	* * Redistributions in binary form must reproduce the above copyright
	10	* notice, this list of conditions and the following disclaimer in the
	11	* documentation and/or other materials provided with the distribution.
	12	* * Neither the name of the Open Source and Linux Lab nor the
	13	* names of its contributors may be used to endorse or promote products
	14	* derived from this software without specific prior written permission.
	15	*
	16	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
	17	* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
	18	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	19	* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
	20	* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
	21	* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
	22	* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
	23	* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	24	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
	25	* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	26	*/
	27
9c17d615	28	#include "sysemu/sysemu.h"
83c9f4ca PB	29	#include "hw/boards.h"
83c9f4ca PB	30	#include "hw/loader.h"
0200db65	31	#include "elf.h"
022c62cb PB	32	#include "exec/memory.h"
022c62cb PB	33	#include "exec/address-spaces.h"
0d09e41a	34	#include "hw/char/serial.h"
1422e32d	35	#include "net/net.h"
83c9f4ca	36	#include "hw/sysbus.h"
0d09e41a	37	#include "hw/block/flash.h"
fa1d36df	38	#include "sysemu/block-backend.h"
dccfcd0e	39	#include "sysemu/char.h"
996dfe98	40	#include "sysemu/device_tree.h"
8488ab02	41	#include "qemu/error-report.h"
b707ab75	42	#include "bootparam.h"
82b25dc8 MF	43
82b25dc8 MF	44	typedef struct LxBoardDesc {
e0db904d	45	hwaddr flash_base;
82b25dc8	46	size_t flash_size;
37ed7c4b	47	size_t flash_boot_base;
82b25dc8 MF	48	size_t flash_sector_size;
	49	size_t sram_size;
	50	} LxBoardDesc;
0200db65 MF	51
	52	typedef struct Lx60FpgaState {
	53	MemoryRegion iomem;
	54	uint32_t leds;
	55	uint32_t switches;
	56	} Lx60FpgaState;
	57
	58	static void lx60_fpga_reset(void *opaque)
	59	{
	60	Lx60FpgaState *s = opaque;
	61
	62	s->leds = 0;
	63	s->switches = 0;
	64	}
	65
a8170e5e	66	static uint64_t lx60_fpga_read(void *opaque, hwaddr addr,
0200db65 MF	67	unsigned size)
	68	{
	69	Lx60FpgaState *s = opaque;
	70
	71	switch (addr) {
	72	case 0x0: /build date code/
556ba668	73	return 0x09272011;
0200db65 MF	74
	75	case 0x4: /processor clock frequency, Hz/
	76	return 10000000;
	77
	78	case 0x8: /LEDs (off = 0, on = 1)/
	79	return s->leds;
	80
	81	case 0xc: /DIP switches (off = 0, on = 1)/
	82	return s->switches;
	83	}
	84	return 0;
	85	}
	86
a8170e5e	87	static void lx60_fpga_write(void *opaque, hwaddr addr,
0200db65 MF	88	uint64_t val, unsigned size)
	89	{
	90	Lx60FpgaState *s = opaque;
	91
	92	switch (addr) {
	93	case 0x8: /LEDs (off = 0, on = 1)/
	94	s->leds = val;
	95	break;
	96
	97	case 0x10: /board reset/
	98	if (val == 0xdead) {
	99	qemu_system_reset_request();
	100	}
	101	break;
	102	}
	103	}
	104
	105	static const MemoryRegionOps lx60_fpga_ops = {
	106	.read = lx60_fpga_read,
	107	.write = lx60_fpga_write,
	108	.endianness = DEVICE_NATIVE_ENDIAN,
	109	};
	110
	111	static Lx60FpgaState lx60_fpga_init(MemoryRegion address_space,
a8170e5e	112	hwaddr base)
0200db65 MF	113	{
	114	Lx60FpgaState *s = g_malloc(sizeof(Lx60FpgaState));
	115
2c9b15ca	116	memory_region_init_io(&s->iomem, NULL, &lx60_fpga_ops, s,
556ba668	117	"lx60.fpga", 0x10000);
0200db65 MF	118	memory_region_add_subregion(address_space, base, &s->iomem);
	119	lx60_fpga_reset(s);
	120	qemu_register_reset(lx60_fpga_reset, s);
	121	return s;
	122	}
	123
	124	static void lx60_net_init(MemoryRegion *address_space,
a8170e5e AK	125	hwaddr base,
	126	hwaddr descriptors,
	127	hwaddr buffers,
0200db65 MF	128	qemu_irq irq, NICInfo *nd)
	129	{
	130	DeviceState *dev;
	131	SysBusDevice *s;
	132	MemoryRegion *ram;
	133
	134	dev = qdev_create(NULL, "open_eth");
	135	qdev_set_nic_properties(dev, nd);
	136	qdev_init_nofail(dev);
	137
1356b98d	138	s = SYS_BUS_DEVICE(dev);
0200db65 MF	139	sysbus_connect_irq(s, 0, irq);
	140	memory_region_add_subregion(address_space, base,
	141	sysbus_mmio_get_region(s, 0));
	142	memory_region_add_subregion(address_space, descriptors,
	143	sysbus_mmio_get_region(s, 1));
	144
	145	ram = g_malloc(sizeof(*ram));
49946538	146	memory_region_init_ram(ram, OBJECT(s), "open_eth.ram", 16384, &error_abort);
c5705a77	147	vmstate_register_ram_global(ram);
0200db65 MF	148	memory_region_add_subregion(address_space, buffers, ram);
	149	}
	150
00b941e5	151	static uint64_t translate_phys_addr(void *opaque, uint64_t addr)
0200db65	152	{
00b941e5 AF	153	XtensaCPU *cpu = opaque;
	154
	155	return cpu_get_phys_page_debug(CPU(cpu), addr);
0200db65 MF	156	}
0200db65 MF	157
1bba0dc9	158	static void lx60_reset(void *opaque)
0200db65	159	{
eded1267	160	XtensaCPU *cpu = opaque;
1bba0dc9	161
eded1267	162	cpu_reset(CPU(cpu));
0200db65 MF	163	}
0200db65 MF	164
8bb3b575 MF	165	static uint64_t lx60_io_read(void *opaque, hwaddr addr,
	166	unsigned size)
	167	{
	168	return 0;
	169	}
	170
	171	static void lx60_io_write(void *opaque, hwaddr addr,
	172	uint64_t val, unsigned size)
	173	{
	174	}
	175
	176	static const MemoryRegionOps lx60_io_ops = {
	177	.read = lx60_io_read,
	178	.write = lx60_io_write,
	179	.endianness = DEVICE_NATIVE_ENDIAN,
	180	};
	181
3ef96221	182	static void lx_init(const LxBoardDesc board, MachineState machine)
0200db65 MF	183	{
	184	#ifdef TARGET_WORDS_BIGENDIAN
	185	int be = 1;
	186	#else
	187	int be = 0;
	188	#endif
	189	MemoryRegion *system_memory = get_system_memory();
adbb0f75	190	XtensaCPU *cpu = NULL;
5bfcb36e	191	CPUXtensaState *env = NULL;
0200db65	192	MemoryRegion ram, rom, *system_io;
82b25dc8 MF	193	DriveInfo *dinfo;
82b25dc8 MF	194	pflash_t *flash = NULL;
37b259d0	195	QemuOpts *machine_opts = qemu_get_machine_opts();
3ef96221	196	const char *cpu_model = machine->cpu_model;
37b259d0 MF	197	const char *kernel_filename = qemu_opt_get(machine_opts, "kernel");
37b259d0 MF	198	const char *kernel_cmdline = qemu_opt_get(machine_opts, "append");
996dfe98	199	const char *dtb_filename = qemu_opt_get(machine_opts, "dtb");
f55b32e7	200	const char *initrd_filename = qemu_opt_get(machine_opts, "initrd");
0200db65 MF	201	int n;
0200db65 MF	202
82b25dc8	203	if (!cpu_model) {
e38077ff	204	cpu_model = XTENSA_DEFAULT_CPU_MODEL;
82b25dc8 MF	205	}
82b25dc8 MF	206
0200db65	207	for (n = 0; n < smp_cpus; n++) {
adbb0f75 AF	208	cpu = cpu_xtensa_init(cpu_model);
adbb0f75 AF	209	if (cpu == NULL) {
8488ab02 MF	210	error_report("unable to find CPU definition '%s'\n",
	211	cpu_model);
	212	exit(EXIT_FAILURE);
0200db65	213	}
adbb0f75 AF	214	env = &cpu->env;
adbb0f75 AF	215
0200db65	216	env->sregs[PRID] = n;
eded1267	217	qemu_register_reset(lx60_reset, cpu);
0200db65 MF	218	/* Need MMU initialized prior to ELF loading,
	219	* so that ELF gets loaded into virtual addresses
	220	*/
adbb0f75	221	cpu_reset(CPU(cpu));
0200db65 MF	222	}
	223
	224	ram = g_malloc(sizeof(*ram));
49946538 HT	225	memory_region_init_ram(ram, NULL, "lx60.dram", machine->ram_size,
49946538 HT	226	&error_abort);
c5705a77	227	vmstate_register_ram_global(ram);
0200db65 MF	228	memory_region_add_subregion(system_memory, 0, ram);
0200db65 MF	229
0200db65	230	system_io = g_malloc(sizeof(*system_io));
8bb3b575 MF	231	memory_region_init_io(system_io, NULL, &lx60_io_ops, NULL, "lx60.io",
8bb3b575 MF	232	224 * 1024 * 1024);
0200db65 MF	233	memory_region_add_subregion(system_memory, 0xf0000000, system_io);
0200db65 MF	234	lx60_fpga_init(system_io, 0x0d020000);
a005d073	235	if (nd_table[0].used) {
0200db65 MF	236	lx60_net_init(system_io, 0x0d030000, 0x0d030400, 0x0d800000,
	237	xtensa_get_extint(env, 1), nd_table);
	238	}
	239
	240	if (!serial_hds[0]) {
	241	serial_hds[0] = qemu_chr_new("serial0", "null", NULL);
	242	}
	243
	244	serial_mm_init(system_io, 0x0d050020, 2, xtensa_get_extint(env, 0),
	245	115200, serial_hds[0], DEVICE_NATIVE_ENDIAN);
	246
82b25dc8 MF	247	dinfo = drive_get(IF_PFLASH, 0, 0);
82b25dc8 MF	248	if (dinfo) {
e0db904d	249	flash = pflash_cfi01_register(board->flash_base,
82b25dc8	250	NULL, "lx60.io.flash", board->flash_size,
4be74634	251	blk_by_legacy_dinfo(dinfo),
fa1d36df	252	board->flash_sector_size,
82b25dc8 MF	253	board->flash_size / board->flash_sector_size,
	254	4, 0x0000, 0x0000, 0x0000, 0x0000, be);
	255	if (flash == NULL) {
8488ab02 MF	256	error_report("unable to mount pflash\n");
8488ab02 MF	257	exit(EXIT_FAILURE);
82b25dc8 MF	258	}
	259	}
	260
	261	/* Use presence of kernel file name as 'boot from SRAM' switch. */
0200db65	262	if (kernel_filename) {
364d4802	263	uint32_t entry_point = env->pc;
b6edea8b	264	size_t bp_size = 3 * get_tag_size(0); /* first/last and memory tags */
a9a28591 MF	265	uint32_t tagptr = 0xfe000000 + board->sram_size;
a9a28591 MF	266	uint32_t cur_tagptr;
b6edea8b MF	267	BpMemInfo memory_location = {
	268	.type = tswap32(MEMORY_TYPE_CONVENTIONAL),
	269	.start = tswap32(0),
	270	.end = tswap32(machine->ram_size),
	271	};
996dfe98 MF	272	uint32_t lowmem_end = machine->ram_size < 0x08000000 ?
	273	machine->ram_size : 0x08000000;
	274	uint32_t cur_lowmem = QEMU_ALIGN_UP(lowmem_end / 2, 4096);
a9a28591	275
292627bb	276	rom = g_malloc(sizeof(*rom));
49946538 HT	277	memory_region_init_ram(rom, NULL, "lx60.sram", board->sram_size,
49946538 HT	278	&error_abort);
c5705a77	279	vmstate_register_ram_global(rom);
292627bb MF	280	memory_region_add_subregion(system_memory, 0xfe000000, rom);
292627bb MF	281
a9a28591 MF	282	if (kernel_cmdline) {
	283	bp_size += get_tag_size(strlen(kernel_cmdline) + 1);
	284	}
996dfe98 MF	285	if (dtb_filename) {
	286	bp_size += get_tag_size(sizeof(uint32_t));
	287	}
f55b32e7 MF	288	if (initrd_filename) {
	289	bp_size += get_tag_size(sizeof(BpMemInfo));
	290	}
a9a28591	291
292627bb	292	/* Put kernel bootparameters to the end of that SRAM */
a9a28591 MF	293	tagptr = (tagptr - bp_size) & ~0xff;
a9a28591 MF	294	cur_tagptr = put_tag(tagptr, BP_TAG_FIRST, 0, NULL);
b6edea8b MF	295	cur_tagptr = put_tag(cur_tagptr, BP_TAG_MEMORY,
b6edea8b MF	296	sizeof(memory_location), &memory_location);
a9a28591	297
292627bb	298	if (kernel_cmdline) {
a9a28591 MF	299	cur_tagptr = put_tag(cur_tagptr, BP_TAG_COMMAND_LINE,
a9a28591 MF	300	strlen(kernel_cmdline) + 1, kernel_cmdline);
292627bb	301	}
996dfe98 MF	302	if (dtb_filename) {
	303	int fdt_size;
	304	void *fdt = load_device_tree(dtb_filename, &fdt_size);
	305	uint32_t dtb_addr = tswap32(cur_lowmem);
	306
	307	if (!fdt) {
	308	error_report("could not load DTB '%s'\n", dtb_filename);
	309	exit(EXIT_FAILURE);
	310	}
	311
	312	cpu_physical_memory_write(cur_lowmem, fdt, fdt_size);
	313	cur_tagptr = put_tag(cur_tagptr, BP_TAG_FDT,
	314	sizeof(dtb_addr), &dtb_addr);
	315	cur_lowmem = QEMU_ALIGN_UP(cur_lowmem + fdt_size, 4096);
	316	}
f55b32e7 MF	317	if (initrd_filename) {
	318	BpMemInfo initrd_location = { 0 };
	319	int initrd_size = load_ramdisk(initrd_filename, cur_lowmem,
	320	lowmem_end - cur_lowmem);
	321
	322	if (initrd_size < 0) {
	323	initrd_size = load_image_targphys(initrd_filename,
	324	cur_lowmem,
	325	lowmem_end - cur_lowmem);
	326	}
	327	if (initrd_size < 0) {
	328	error_report("could not load initrd '%s'\n", initrd_filename);
	329	exit(EXIT_FAILURE);
	330	}
	331	initrd_location.start = tswap32(cur_lowmem);
	332	initrd_location.end = tswap32(cur_lowmem + initrd_size);
	333	cur_tagptr = put_tag(cur_tagptr, BP_TAG_INITRD,
	334	sizeof(initrd_location), &initrd_location);
	335	cur_lowmem = QEMU_ALIGN_UP(cur_lowmem + initrd_size, 4096);
	336	}
a9a28591 MF	337	cur_tagptr = put_tag(cur_tagptr, BP_TAG_LAST, 0, NULL);
	338	env->regs[2] = tagptr;
	339
0200db65 MF	340	uint64_t elf_entry;
0200db65 MF	341	uint64_t elf_lowaddr;
00b941e5	342	int success = load_elf(kernel_filename, translate_phys_addr, cpu,
0200db65 MF	343	&elf_entry, &elf_lowaddr, NULL, be, ELF_MACHINE, 0);
0200db65 MF	344	if (success > 0) {
364d4802 MF	345	entry_point = elf_entry;
	346	} else {
	347	hwaddr ep;
	348	int is_linux;
25bda50a	349	success = load_uimage(kernel_filename, &ep, NULL, &is_linux,
6d2e4530	350	translate_phys_addr, cpu);
364d4802 MF	351	if (success > 0 && is_linux) {
	352	entry_point = ep;
	353	} else {
	354	error_report("could not load kernel '%s'\n",
	355	kernel_filename);
	356	exit(EXIT_FAILURE);
	357	}
	358	}
	359	if (entry_point != env->pc) {
	360	static const uint8_t jx_a0[] = {
	361	#ifdef TARGET_WORDS_BIGENDIAN
	362	0x0a, 0, 0,
	363	#else
	364	0xa0, 0, 0,
	365	#endif
	366	};
	367	env->regs[0] = entry_point;
	368	cpu_physical_memory_write(env->pc, jx_a0, sizeof(jx_a0));
0200db65	369	}
82b25dc8 MF	370	} else {
	371	if (flash) {
	372	MemoryRegion *flash_mr = pflash_cfi01_get_memory(flash);
	373	MemoryRegion flash_io = g_malloc(sizeof(flash_io));
	374
2c9b15ca	375	memory_region_init_alias(flash_io, NULL, "lx60.flash",
37ed7c4b MF	376	flash_mr, board->flash_boot_base,
	377	board->flash_size - board->flash_boot_base < 0x02000000 ?
	378	board->flash_size - board->flash_boot_base : 0x02000000);
82b25dc8 MF	379	memory_region_add_subregion(system_memory, 0xfe000000,
	380	flash_io);
	381	}
0200db65 MF	382	}
	383	}
	384
3ef96221	385	static void xtensa_lx60_init(MachineState *machine)
0200db65	386	{
82b25dc8	387	static const LxBoardDesc lx60_board = {
e0db904d MF	388	.flash_base = 0xf8000000,
e0db904d MF	389	.flash_size = 0x00400000,
82b25dc8 MF	390	.flash_sector_size = 0x10000,
	391	.sram_size = 0x20000,
	392	};
3ef96221	393	lx_init(&lx60_board, machine);
82b25dc8 MF	394	}
82b25dc8 MF	395
3ef96221	396	static void xtensa_lx200_init(MachineState *machine)
82b25dc8 MF	397	{
82b25dc8 MF	398	static const LxBoardDesc lx200_board = {
e0db904d MF	399	.flash_base = 0xf8000000,
e0db904d MF	400	.flash_size = 0x01000000,
82b25dc8 MF	401	.flash_sector_size = 0x20000,
	402	.sram_size = 0x2000000,
	403	};
3ef96221	404	lx_init(&lx200_board, machine);
0200db65 MF	405	}
0200db65 MF	406
3ef96221	407	static void xtensa_ml605_init(MachineState *machine)
e0db904d MF	408	{
	409	static const LxBoardDesc ml605_board = {
	410	.flash_base = 0xf8000000,
12004c9e	411	.flash_size = 0x01000000,
e0db904d MF	412	.flash_sector_size = 0x20000,
	413	.sram_size = 0x2000000,
	414	};
3ef96221	415	lx_init(&ml605_board, machine);
e0db904d MF	416	}
e0db904d MF	417
3ef96221	418	static void xtensa_kc705_init(MachineState *machine)
e0db904d MF	419	{
	420	static const LxBoardDesc kc705_board = {
	421	.flash_base = 0xf0000000,
	422	.flash_size = 0x08000000,
37ed7c4b	423	.flash_boot_base = 0x06000000,
e0db904d MF	424	.flash_sector_size = 0x20000,
	425	.sram_size = 0x2000000,
	426	};
3ef96221	427	lx_init(&kc705_board, machine);
e0db904d MF	428	}
e0db904d MF	429
0200db65 MF	430	static QEMUMachine xtensa_lx60_machine = {
0200db65 MF	431	.name = "lx60",
e38077ff	432	.desc = "lx60 EVB (" XTENSA_DEFAULT_CPU_MODEL ")",
0200db65 MF	433	.init = xtensa_lx60_init,
	434	.max_cpus = 4,
	435	};
	436
82b25dc8 MF	437	static QEMUMachine xtensa_lx200_machine = {
82b25dc8 MF	438	.name = "lx200",
e38077ff	439	.desc = "lx200 EVB (" XTENSA_DEFAULT_CPU_MODEL ")",
82b25dc8 MF	440	.init = xtensa_lx200_init,
	441	.max_cpus = 4,
	442	};
	443
e0db904d MF	444	static QEMUMachine xtensa_ml605_machine = {
	445	.name = "ml605",
	446	.desc = "ml605 EVB (" XTENSA_DEFAULT_CPU_MODEL ")",
	447	.init = xtensa_ml605_init,
	448	.max_cpus = 4,
	449	};
	450
	451	static QEMUMachine xtensa_kc705_machine = {
	452	.name = "kc705",
	453	.desc = "kc705 EVB (" XTENSA_DEFAULT_CPU_MODEL ")",
	454	.init = xtensa_kc705_init,
	455	.max_cpus = 4,
	456	};
	457
82b25dc8	458	static void xtensa_lx_machines_init(void)
0200db65 MF	459	{
0200db65 MF	460	qemu_register_machine(&xtensa_lx60_machine);
82b25dc8	461	qemu_register_machine(&xtensa_lx200_machine);
e0db904d MF	462	qemu_register_machine(&xtensa_ml605_machine);
e0db904d MF	463	qemu_register_machine(&xtensa_kc705_machine);
0200db65 MF	464	}
0200db65 MF	465
82b25dc8	466	machine_init(xtensa_lx_machines_init);