version 1.1.1.2, 2018/04/24 16:52:55
|
version 1.1.1.5, 2018/04/24 18:28:47
|
Line 7
|
Line 7
|
* This code is licenced under the GPL. |
* This code is licenced under the GPL. |
*/ |
*/ |
|
|
#include "hw.h" |
#include "sysbus.h" |
#include "arm-misc.h" |
#include "arm-misc.h" |
#include "sysemu.h" |
#include "sysemu.h" |
|
#include "loader.h" |
|
#include "elf.h" |
|
|
/* Bitbanded IO. Each word corresponds to a single bit. */ |
/* Bitbanded IO. Each word corresponds to a single bit. */ |
|
|
Line 105 static void bitband_writel(void *opaque,
|
Line 107 static void bitband_writel(void *opaque,
|
cpu_physical_memory_write(addr, (uint8_t *)&v, 4); |
cpu_physical_memory_write(addr, (uint8_t *)&v, 4); |
} |
} |
|
|
static CPUReadMemoryFunc *bitband_readfn[] = { |
static CPUReadMemoryFunc * const bitband_readfn[] = { |
bitband_readb, |
bitband_readb, |
bitband_readw, |
bitband_readw, |
bitband_readl |
bitband_readl |
}; |
}; |
|
|
static CPUWriteMemoryFunc *bitband_writefn[] = { |
static CPUWriteMemoryFunc * const bitband_writefn[] = { |
bitband_writeb, |
bitband_writeb, |
bitband_writew, |
bitband_writew, |
bitband_writel |
bitband_writel |
}; |
}; |
|
|
static void armv7m_bitband_init(void) |
typedef struct { |
|
SysBusDevice busdev; |
|
uint32_t base; |
|
} BitBandState; |
|
|
|
static int bitband_init(SysBusDevice *dev) |
{ |
{ |
|
BitBandState *s = FROM_SYSBUS(BitBandState, dev); |
int iomemtype; |
int iomemtype; |
static uint32_t bitband1_offset = 0x20000000; |
|
static uint32_t bitband2_offset = 0x40000000; |
|
|
|
iomemtype = cpu_register_io_memory(0, bitband_readfn, bitband_writefn, |
iomemtype = cpu_register_io_memory(bitband_readfn, bitband_writefn, |
&bitband1_offset); |
&s->base); |
cpu_register_physical_memory(0x22000000, 0x02000000, iomemtype); |
sysbus_init_mmio(dev, 0x02000000, iomemtype); |
iomemtype = cpu_register_io_memory(0, bitband_readfn, bitband_writefn, |
return 0; |
&bitband2_offset); |
} |
cpu_register_physical_memory(0x42000000, 0x02000000, iomemtype); |
|
|
static void armv7m_bitband_init(void) |
|
{ |
|
DeviceState *dev; |
|
|
|
dev = qdev_create(NULL, "ARM,bitband-memory"); |
|
qdev_prop_set_uint32(dev, "base", 0x20000000); |
|
qdev_init_nofail(dev); |
|
sysbus_mmio_map(sysbus_from_qdev(dev), 0, 0x22000000); |
|
|
|
dev = qdev_create(NULL, "ARM,bitband-memory"); |
|
qdev_prop_set_uint32(dev, "base", 0x40000000); |
|
qdev_init_nofail(dev); |
|
sysbus_mmio_map(sysbus_from_qdev(dev), 0, 0x42000000); |
} |
} |
|
|
/* Board init. */ |
/* Board init. */ |
|
|
|
static void armv7m_reset(void *opaque) |
|
{ |
|
cpu_reset((CPUState *)opaque); |
|
} |
|
|
/* Init CPU and memory for a v7-M based board. |
/* Init CPU and memory for a v7-M based board. |
flash_size and sram_size are in kb. |
flash_size and sram_size are in kb. |
Returns the NVIC array. */ |
Returns the NVIC array. */ |
Line 140 qemu_irq *armv7m_init(int flash_size, in
|
Line 165 qemu_irq *armv7m_init(int flash_size, in
|
const char *kernel_filename, const char *cpu_model) |
const char *kernel_filename, const char *cpu_model) |
{ |
{ |
CPUState *env; |
CPUState *env; |
qemu_irq *pic; |
DeviceState *nvic; |
uint32_t pc; |
/* FIXME: make this local state. */ |
|
static qemu_irq pic[64]; |
|
qemu_irq *cpu_pic; |
int image_size; |
int image_size; |
uint64_t entry; |
uint64_t entry; |
uint64_t lowaddr; |
uint64_t lowaddr; |
|
int i; |
|
int big_endian; |
|
|
flash_size *= 1024; |
flash_size *= 1024; |
sram_size *= 1024; |
sram_size *= 1024; |
Line 170 qemu_irq *armv7m_init(int flash_size, in
|
Line 199 qemu_irq *armv7m_init(int flash_size, in
|
#endif |
#endif |
|
|
/* Flash programming is done via the SCU, so pretend it is ROM. */ |
/* Flash programming is done via the SCU, so pretend it is ROM. */ |
cpu_register_physical_memory(0, flash_size, IO_MEM_ROM); |
cpu_register_physical_memory(0, flash_size, |
|
qemu_ram_alloc(NULL, "armv7m.flash", |
|
flash_size) | IO_MEM_ROM); |
cpu_register_physical_memory(0x20000000, sram_size, |
cpu_register_physical_memory(0x20000000, sram_size, |
flash_size + IO_MEM_RAM); |
qemu_ram_alloc(NULL, "armv7m.sram", |
|
sram_size) | IO_MEM_RAM); |
armv7m_bitband_init(); |
armv7m_bitband_init(); |
|
|
pic = armv7m_nvic_init(env); |
nvic = qdev_create(NULL, "armv7m_nvic"); |
|
env->nvic = nvic; |
|
qdev_init_nofail(nvic); |
|
cpu_pic = arm_pic_init_cpu(env); |
|
sysbus_connect_irq(sysbus_from_qdev(nvic), 0, cpu_pic[ARM_PIC_CPU_IRQ]); |
|
for (i = 0; i < 64; i++) { |
|
pic[i] = qdev_get_gpio_in(nvic, i); |
|
} |
|
|
image_size = load_elf(kernel_filename, 0, &entry, &lowaddr, NULL); |
#ifdef TARGET_WORDS_BIGENDIAN |
|
big_endian = 1; |
|
#else |
|
big_endian = 0; |
|
#endif |
|
|
|
image_size = load_elf(kernel_filename, NULL, NULL, &entry, &lowaddr, |
|
NULL, big_endian, ELF_MACHINE, 1); |
if (image_size < 0) { |
if (image_size < 0) { |
image_size = load_image(kernel_filename, phys_ram_base); |
image_size = load_image_targphys(kernel_filename, 0, flash_size); |
lowaddr = 0; |
lowaddr = 0; |
} |
} |
if (image_size < 0) { |
if (image_size < 0) { |
Line 188 qemu_irq *armv7m_init(int flash_size, in
|
Line 234 qemu_irq *armv7m_init(int flash_size, in
|
exit(1); |
exit(1); |
} |
} |
|
|
/* If the image was loaded at address zero then assume it is a |
|
regular ROM image and perform the normal CPU reset sequence. |
|
Otherwise jump directly to the entry point. */ |
|
if (lowaddr == 0) { |
|
env->regs[13] = tswap32(*(uint32_t *)phys_ram_base); |
|
pc = tswap32(*(uint32_t *)(phys_ram_base + 4)); |
|
} else { |
|
pc = entry; |
|
} |
|
env->thumb = pc & 1; |
|
env->regs[15] = pc & ~1; |
|
|
|
/* Hack to map an additional page of ram at the top of the address |
/* Hack to map an additional page of ram at the top of the address |
space. This stops qemu complaining about executing code outside RAM |
space. This stops qemu complaining about executing code outside RAM |
when returning from an exception. */ |
when returning from an exception. */ |
cpu_register_physical_memory(0xfffff000, 0x1000, IO_MEM_RAM + ram_size); |
cpu_register_physical_memory(0xfffff000, 0x1000, |
|
qemu_ram_alloc(NULL, "armv7m.hack", |
|
0x1000) | IO_MEM_RAM); |
|
|
|
qemu_register_reset(armv7m_reset, env); |
return pic; |
return pic; |
} |
} |
|
|
|
static SysBusDeviceInfo bitband_info = { |
|
.init = bitband_init, |
|
.qdev.name = "ARM,bitband-memory", |
|
.qdev.size = sizeof(BitBandState), |
|
.qdev.props = (Property[]) { |
|
DEFINE_PROP_UINT32("base", BitBandState, base, 0), |
|
DEFINE_PROP_END_OF_LIST(), |
|
} |
|
}; |
|
|
|
static void armv7m_register_devices(void) |
|
{ |
|
sysbus_register_withprop(&bitband_info); |
|
} |
|
|
|
device_init(armv7m_register_devices) |