mirror of
https://github.com/izzy2lost/xemu.git
synced 2026-07-06 00:20:22 -07:00
Merge remote-tracking branch 'remotes/pmaydell/tags/pull-target-arm-20170228-1' into staging
target-arm queue: * raspi2: add gpio controller and sdhost controller, with the wiring so the guest can switch which controller the SD card is attached to (this is sufficient to get raspbian kernels to boot) * GICv3: support state save/restore from KVM * update Linux headers to 4.11 * refactor and QOMify the ARMv7M container object # gpg: Signature made Tue 28 Feb 2017 17:11:49 GMT # gpg: using RSA key 0x3C2525ED14360CDE # gpg: Good signature from "Peter Maydell <peter.maydell@linaro.org>" # gpg: aka "Peter Maydell <pmaydell@gmail.com>" # gpg: aka "Peter Maydell <pmaydell@chiark.greenend.org.uk>" # Primary key fingerprint: E1A5 C593 CD41 9DE2 8E83 15CF 3C25 25ED 1436 0CDE * remotes/pmaydell/tags/pull-target-arm-20170228-1: (21 commits) bcm2835: add sdhost and gpio controllers bcm2835_gpio: add bcm2835 gpio controller hw/sd: add card-reparenting function qdev: Have qdev_set_parent_bus() handle devices already on a bus hw/intc/arm_gicv3_kvm: Reset GICv3 cpu interface registers target-arm: Add GICv3CPUState in CPUARMState struct hw/intc/arm_gicv3_kvm: Implement get/put functions hw/intc/arm_gicv3_kvm: Add ICC_SRE_EL1 register to vmstate update Linux headers to 4.11 update-linux-headers: update for 4.11 stm32f205: Rename 'nvic' local to 'armv7m' stm32f205: Create armv7m object without using armv7m_init() armv7m: Split systick out from NVIC armv7m: Don't put core v7M devices under CONFIG_STELLARIS armv7m: Make bitband device take the address space to access armv7m: Make NVIC expose a memory region rather than mapping itself armv7m: Make ARMv7M object take memory region link armv7m: Use QOMified armv7m object in armv7m_init() armv7m: QOMify the armv7m container armv7m: Move NVICState struct definition into header ... Signed-off-by: Peter Maydell <peter.maydell@linaro.org>
This commit is contained in:
@@ -42,6 +42,8 @@ CONFIG_ARM11MPCORE=y
|
||||
CONFIG_A9MPCORE=y
|
||||
CONFIG_A15MPCORE=y
|
||||
|
||||
CONFIG_ARM_V7M=y
|
||||
|
||||
CONFIG_ARM_GIC=y
|
||||
CONFIG_ARM_GIC_KVM=$(CONFIG_KVM)
|
||||
CONFIG_ARM_TIMER=y
|
||||
|
||||
+252
-131
@@ -8,6 +8,7 @@
|
||||
*/
|
||||
|
||||
#include "qemu/osdep.h"
|
||||
#include "hw/arm/armv7m.h"
|
||||
#include "qapi/error.h"
|
||||
#include "qemu-common.h"
|
||||
#include "cpu.h"
|
||||
@@ -17,148 +18,261 @@
|
||||
#include "elf.h"
|
||||
#include "sysemu/qtest.h"
|
||||
#include "qemu/error-report.h"
|
||||
#include "exec/address-spaces.h"
|
||||
|
||||
/* Bitbanded IO. Each word corresponds to a single bit. */
|
||||
|
||||
/* Get the byte address of the real memory for a bitband access. */
|
||||
static inline uint32_t bitband_addr(void * opaque, uint32_t addr)
|
||||
static inline hwaddr bitband_addr(BitBandState *s, hwaddr offset)
|
||||
{
|
||||
uint32_t res;
|
||||
|
||||
res = *(uint32_t *)opaque;
|
||||
res |= (addr & 0x1ffffff) >> 5;
|
||||
return res;
|
||||
|
||||
return s->base | (offset & 0x1ffffff) >> 5;
|
||||
}
|
||||
|
||||
static uint32_t bitband_readb(void *opaque, hwaddr offset)
|
||||
static MemTxResult bitband_read(void *opaque, hwaddr offset,
|
||||
uint64_t *data, unsigned size, MemTxAttrs attrs)
|
||||
{
|
||||
uint8_t v;
|
||||
cpu_physical_memory_read(bitband_addr(opaque, offset), &v, 1);
|
||||
return (v & (1 << ((offset >> 2) & 7))) != 0;
|
||||
BitBandState *s = opaque;
|
||||
uint8_t buf[4];
|
||||
MemTxResult res;
|
||||
int bitpos, bit;
|
||||
hwaddr addr;
|
||||
|
||||
assert(size <= 4);
|
||||
|
||||
/* Find address in underlying memory and round down to multiple of size */
|
||||
addr = bitband_addr(s, offset) & (-size);
|
||||
res = address_space_read(s->source_as, addr, attrs, buf, size);
|
||||
if (res) {
|
||||
return res;
|
||||
}
|
||||
/* Bit position in the N bytes read... */
|
||||
bitpos = (offset >> 2) & ((size * 8) - 1);
|
||||
/* ...converted to byte in buffer and bit in byte */
|
||||
bit = (buf[bitpos >> 3] >> (bitpos & 7)) & 1;
|
||||
*data = bit;
|
||||
return MEMTX_OK;
|
||||
}
|
||||
|
||||
static void bitband_writeb(void *opaque, hwaddr offset,
|
||||
uint32_t value)
|
||||
static MemTxResult bitband_write(void *opaque, hwaddr offset, uint64_t value,
|
||||
unsigned size, MemTxAttrs attrs)
|
||||
{
|
||||
uint32_t addr;
|
||||
uint8_t mask;
|
||||
uint8_t v;
|
||||
addr = bitband_addr(opaque, offset);
|
||||
mask = (1 << ((offset >> 2) & 7));
|
||||
cpu_physical_memory_read(addr, &v, 1);
|
||||
if (value & 1)
|
||||
v |= mask;
|
||||
else
|
||||
v &= ~mask;
|
||||
cpu_physical_memory_write(addr, &v, 1);
|
||||
}
|
||||
BitBandState *s = opaque;
|
||||
uint8_t buf[4];
|
||||
MemTxResult res;
|
||||
int bitpos, bit;
|
||||
hwaddr addr;
|
||||
|
||||
static uint32_t bitband_readw(void *opaque, hwaddr offset)
|
||||
{
|
||||
uint32_t addr;
|
||||
uint16_t mask;
|
||||
uint16_t v;
|
||||
addr = bitband_addr(opaque, offset) & ~1;
|
||||
mask = (1 << ((offset >> 2) & 15));
|
||||
mask = tswap16(mask);
|
||||
cpu_physical_memory_read(addr, &v, 2);
|
||||
return (v & mask) != 0;
|
||||
}
|
||||
assert(size <= 4);
|
||||
|
||||
static void bitband_writew(void *opaque, hwaddr offset,
|
||||
uint32_t value)
|
||||
{
|
||||
uint32_t addr;
|
||||
uint16_t mask;
|
||||
uint16_t v;
|
||||
addr = bitband_addr(opaque, offset) & ~1;
|
||||
mask = (1 << ((offset >> 2) & 15));
|
||||
mask = tswap16(mask);
|
||||
cpu_physical_memory_read(addr, &v, 2);
|
||||
if (value & 1)
|
||||
v |= mask;
|
||||
else
|
||||
v &= ~mask;
|
||||
cpu_physical_memory_write(addr, &v, 2);
|
||||
}
|
||||
|
||||
static uint32_t bitband_readl(void *opaque, hwaddr offset)
|
||||
{
|
||||
uint32_t addr;
|
||||
uint32_t mask;
|
||||
uint32_t v;
|
||||
addr = bitband_addr(opaque, offset) & ~3;
|
||||
mask = (1 << ((offset >> 2) & 31));
|
||||
mask = tswap32(mask);
|
||||
cpu_physical_memory_read(addr, &v, 4);
|
||||
return (v & mask) != 0;
|
||||
}
|
||||
|
||||
static void bitband_writel(void *opaque, hwaddr offset,
|
||||
uint32_t value)
|
||||
{
|
||||
uint32_t addr;
|
||||
uint32_t mask;
|
||||
uint32_t v;
|
||||
addr = bitband_addr(opaque, offset) & ~3;
|
||||
mask = (1 << ((offset >> 2) & 31));
|
||||
mask = tswap32(mask);
|
||||
cpu_physical_memory_read(addr, &v, 4);
|
||||
if (value & 1)
|
||||
v |= mask;
|
||||
else
|
||||
v &= ~mask;
|
||||
cpu_physical_memory_write(addr, &v, 4);
|
||||
/* Find address in underlying memory and round down to multiple of size */
|
||||
addr = bitband_addr(s, offset) & (-size);
|
||||
res = address_space_read(s->source_as, addr, attrs, buf, size);
|
||||
if (res) {
|
||||
return res;
|
||||
}
|
||||
/* Bit position in the N bytes read... */
|
||||
bitpos = (offset >> 2) & ((size * 8) - 1);
|
||||
/* ...converted to byte in buffer and bit in byte */
|
||||
bit = 1 << (bitpos & 7);
|
||||
if (value & 1) {
|
||||
buf[bitpos >> 3] |= bit;
|
||||
} else {
|
||||
buf[bitpos >> 3] &= ~bit;
|
||||
}
|
||||
return address_space_write(s->source_as, addr, attrs, buf, size);
|
||||
}
|
||||
|
||||
static const MemoryRegionOps bitband_ops = {
|
||||
.old_mmio = {
|
||||
.read = { bitband_readb, bitband_readw, bitband_readl, },
|
||||
.write = { bitband_writeb, bitband_writew, bitband_writel, },
|
||||
},
|
||||
.read_with_attrs = bitband_read,
|
||||
.write_with_attrs = bitband_write,
|
||||
.endianness = DEVICE_NATIVE_ENDIAN,
|
||||
.impl.min_access_size = 1,
|
||||
.impl.max_access_size = 4,
|
||||
.valid.min_access_size = 1,
|
||||
.valid.max_access_size = 4,
|
||||
};
|
||||
|
||||
#define TYPE_BITBAND "ARM,bitband-memory"
|
||||
#define BITBAND(obj) OBJECT_CHECK(BitBandState, (obj), TYPE_BITBAND)
|
||||
|
||||
typedef struct {
|
||||
/*< private >*/
|
||||
SysBusDevice parent_obj;
|
||||
/*< public >*/
|
||||
|
||||
MemoryRegion iomem;
|
||||
uint32_t base;
|
||||
} BitBandState;
|
||||
|
||||
static void bitband_init(Object *obj)
|
||||
{
|
||||
BitBandState *s = BITBAND(obj);
|
||||
SysBusDevice *dev = SYS_BUS_DEVICE(obj);
|
||||
|
||||
memory_region_init_io(&s->iomem, obj, &bitband_ops, &s->base,
|
||||
object_property_add_link(obj, "source-memory",
|
||||
TYPE_MEMORY_REGION,
|
||||
(Object **)&s->source_memory,
|
||||
qdev_prop_allow_set_link_before_realize,
|
||||
OBJ_PROP_LINK_UNREF_ON_RELEASE,
|
||||
&error_abort);
|
||||
memory_region_init_io(&s->iomem, obj, &bitband_ops, s,
|
||||
"bitband", 0x02000000);
|
||||
sysbus_init_mmio(dev, &s->iomem);
|
||||
}
|
||||
|
||||
static void armv7m_bitband_init(void)
|
||||
static void bitband_realize(DeviceState *dev, Error **errp)
|
||||
{
|
||||
DeviceState *dev;
|
||||
BitBandState *s = BITBAND(dev);
|
||||
|
||||
dev = qdev_create(NULL, TYPE_BITBAND);
|
||||
qdev_prop_set_uint32(dev, "base", 0x20000000);
|
||||
qdev_init_nofail(dev);
|
||||
sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, 0x22000000);
|
||||
if (!s->source_memory) {
|
||||
error_setg(errp, "source-memory property not set");
|
||||
return;
|
||||
}
|
||||
|
||||
dev = qdev_create(NULL, TYPE_BITBAND);
|
||||
qdev_prop_set_uint32(dev, "base", 0x40000000);
|
||||
qdev_init_nofail(dev);
|
||||
sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, 0x42000000);
|
||||
s->source_as = address_space_init_shareable(s->source_memory,
|
||||
"bitband-source");
|
||||
}
|
||||
|
||||
/* Board init. */
|
||||
|
||||
static const hwaddr bitband_input_addr[ARMV7M_NUM_BITBANDS] = {
|
||||
0x20000000, 0x40000000
|
||||
};
|
||||
|
||||
static const hwaddr bitband_output_addr[ARMV7M_NUM_BITBANDS] = {
|
||||
0x22000000, 0x42000000
|
||||
};
|
||||
|
||||
static void armv7m_instance_init(Object *obj)
|
||||
{
|
||||
ARMv7MState *s = ARMV7M(obj);
|
||||
int i;
|
||||
|
||||
/* Can't init the cpu here, we don't yet know which model to use */
|
||||
|
||||
object_property_add_link(obj, "memory",
|
||||
TYPE_MEMORY_REGION,
|
||||
(Object **)&s->board_memory,
|
||||
qdev_prop_allow_set_link_before_realize,
|
||||
OBJ_PROP_LINK_UNREF_ON_RELEASE,
|
||||
&error_abort);
|
||||
memory_region_init(&s->container, obj, "armv7m-container", UINT64_MAX);
|
||||
|
||||
object_initialize(&s->nvic, sizeof(s->nvic), "armv7m_nvic");
|
||||
qdev_set_parent_bus(DEVICE(&s->nvic), sysbus_get_default());
|
||||
object_property_add_alias(obj, "num-irq",
|
||||
OBJECT(&s->nvic), "num-irq", &error_abort);
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(s->bitband); i++) {
|
||||
object_initialize(&s->bitband[i], sizeof(s->bitband[i]), TYPE_BITBAND);
|
||||
qdev_set_parent_bus(DEVICE(&s->bitband[i]), sysbus_get_default());
|
||||
}
|
||||
}
|
||||
|
||||
static void armv7m_realize(DeviceState *dev, Error **errp)
|
||||
{
|
||||
ARMv7MState *s = ARMV7M(dev);
|
||||
SysBusDevice *sbd;
|
||||
Error *err = NULL;
|
||||
int i;
|
||||
char **cpustr;
|
||||
ObjectClass *oc;
|
||||
const char *typename;
|
||||
CPUClass *cc;
|
||||
|
||||
if (!s->board_memory) {
|
||||
error_setg(errp, "memory property was not set");
|
||||
return;
|
||||
}
|
||||
|
||||
memory_region_add_subregion_overlap(&s->container, 0, s->board_memory, -1);
|
||||
|
||||
cpustr = g_strsplit(s->cpu_model, ",", 2);
|
||||
|
||||
oc = cpu_class_by_name(TYPE_ARM_CPU, cpustr[0]);
|
||||
if (!oc) {
|
||||
error_setg(errp, "Unknown CPU model %s", cpustr[0]);
|
||||
g_strfreev(cpustr);
|
||||
return;
|
||||
}
|
||||
|
||||
cc = CPU_CLASS(oc);
|
||||
typename = object_class_get_name(oc);
|
||||
cc->parse_features(typename, cpustr[1], &err);
|
||||
g_strfreev(cpustr);
|
||||
if (err) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
|
||||
s->cpu = ARM_CPU(object_new(typename));
|
||||
if (!s->cpu) {
|
||||
error_setg(errp, "Unknown CPU model %s", s->cpu_model);
|
||||
return;
|
||||
}
|
||||
|
||||
object_property_set_link(OBJECT(s->cpu), OBJECT(&s->container), "memory",
|
||||
&error_abort);
|
||||
object_property_set_bool(OBJECT(s->cpu), true, "realized", &err);
|
||||
if (err != NULL) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Note that we must realize the NVIC after the CPU */
|
||||
object_property_set_bool(OBJECT(&s->nvic), true, "realized", &err);
|
||||
if (err != NULL) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Alias the NVIC's input and output GPIOs as our own so the board
|
||||
* code can wire them up. (We do this in realize because the
|
||||
* NVIC doesn't create the input GPIO array until realize.)
|
||||
*/
|
||||
qdev_pass_gpios(DEVICE(&s->nvic), dev, NULL);
|
||||
qdev_pass_gpios(DEVICE(&s->nvic), dev, "SYSRESETREQ");
|
||||
|
||||
/* Wire the NVIC up to the CPU */
|
||||
sbd = SYS_BUS_DEVICE(&s->nvic);
|
||||
sysbus_connect_irq(sbd, 0,
|
||||
qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ));
|
||||
s->cpu->env.nvic = &s->nvic;
|
||||
|
||||
memory_region_add_subregion(&s->container, 0xe000e000,
|
||||
sysbus_mmio_get_region(sbd, 0));
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(s->bitband); i++) {
|
||||
Object *obj = OBJECT(&s->bitband[i]);
|
||||
SysBusDevice *sbd = SYS_BUS_DEVICE(&s->bitband[i]);
|
||||
|
||||
object_property_set_int(obj, bitband_input_addr[i], "base", &err);
|
||||
if (err != NULL) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
object_property_set_link(obj, OBJECT(s->board_memory),
|
||||
"source-memory", &error_abort);
|
||||
object_property_set_bool(obj, true, "realized", &err);
|
||||
if (err != NULL) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
|
||||
memory_region_add_subregion(&s->container, bitband_output_addr[i],
|
||||
sysbus_mmio_get_region(sbd, 0));
|
||||
}
|
||||
}
|
||||
|
||||
static Property armv7m_properties[] = {
|
||||
DEFINE_PROP_STRING("cpu-model", ARMv7MState, cpu_model),
|
||||
DEFINE_PROP_END_OF_LIST(),
|
||||
};
|
||||
|
||||
static void armv7m_class_init(ObjectClass *klass, void *data)
|
||||
{
|
||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||
|
||||
dc->realize = armv7m_realize;
|
||||
dc->props = armv7m_properties;
|
||||
}
|
||||
|
||||
static const TypeInfo armv7m_info = {
|
||||
.name = TYPE_ARMV7M,
|
||||
.parent = TYPE_SYS_BUS_DEVICE,
|
||||
.instance_size = sizeof(ARMv7MState),
|
||||
.instance_init = armv7m_instance_init,
|
||||
.class_init = armv7m_class_init,
|
||||
};
|
||||
|
||||
static void armv7m_reset(void *opaque)
|
||||
{
|
||||
ARMCPU *cpu = opaque;
|
||||
@@ -168,38 +282,36 @@ static void armv7m_reset(void *opaque)
|
||||
|
||||
/* Init CPU and memory for a v7-M based board.
|
||||
mem_size is in bytes.
|
||||
Returns the NVIC array. */
|
||||
Returns the ARMv7M device. */
|
||||
|
||||
DeviceState *armv7m_init(MemoryRegion *system_memory, int mem_size, int num_irq,
|
||||
const char *kernel_filename, const char *cpu_model)
|
||||
{
|
||||
ARMCPU *cpu;
|
||||
CPUARMState *env;
|
||||
DeviceState *nvic;
|
||||
DeviceState *armv7m;
|
||||
|
||||
if (cpu_model == NULL) {
|
||||
cpu_model = "cortex-m3";
|
||||
}
|
||||
|
||||
armv7m = qdev_create(NULL, "armv7m");
|
||||
qdev_prop_set_uint32(armv7m, "num-irq", num_irq);
|
||||
qdev_prop_set_string(armv7m, "cpu-model", cpu_model);
|
||||
object_property_set_link(OBJECT(armv7m), OBJECT(get_system_memory()),
|
||||
"memory", &error_abort);
|
||||
/* This will exit with an error if the user passed us a bad cpu_model */
|
||||
qdev_init_nofail(armv7m);
|
||||
|
||||
armv7m_load_kernel(ARM_CPU(first_cpu), kernel_filename, mem_size);
|
||||
return armv7m;
|
||||
}
|
||||
|
||||
void armv7m_load_kernel(ARMCPU *cpu, const char *kernel_filename, int mem_size)
|
||||
{
|
||||
int image_size;
|
||||
uint64_t entry;
|
||||
uint64_t lowaddr;
|
||||
int big_endian;
|
||||
|
||||
if (cpu_model == NULL) {
|
||||
cpu_model = "cortex-m3";
|
||||
}
|
||||
cpu = cpu_arm_init(cpu_model);
|
||||
if (cpu == NULL) {
|
||||
fprintf(stderr, "Unable to find CPU definition\n");
|
||||
exit(1);
|
||||
}
|
||||
env = &cpu->env;
|
||||
|
||||
armv7m_bitband_init();
|
||||
|
||||
nvic = qdev_create(NULL, "armv7m_nvic");
|
||||
qdev_prop_set_uint32(nvic, "num-irq", num_irq);
|
||||
env->nvic = nvic;
|
||||
qdev_init_nofail(nvic);
|
||||
sysbus_connect_irq(SYS_BUS_DEVICE(nvic), 0,
|
||||
qdev_get_gpio_in(DEVICE(cpu), ARM_CPU_IRQ));
|
||||
|
||||
#ifdef TARGET_WORDS_BIGENDIAN
|
||||
big_endian = 1;
|
||||
#else
|
||||
@@ -224,8 +336,15 @@ DeviceState *armv7m_init(MemoryRegion *system_memory, int mem_size, int num_irq,
|
||||
}
|
||||
}
|
||||
|
||||
/* CPU objects (unlike devices) are not automatically reset on system
|
||||
* reset, so we must always register a handler to do so. Unlike
|
||||
* A-profile CPUs, we don't need to do anything special in the
|
||||
* handler to arrange that it starts correctly.
|
||||
* This is arguably the wrong place to do this, but it matches the
|
||||
* way A-profile does it. Note that this means that every M profile
|
||||
* board must call this function!
|
||||
*/
|
||||
qemu_register_reset(armv7m_reset, cpu);
|
||||
return nvic;
|
||||
}
|
||||
|
||||
static Property bitband_properties[] = {
|
||||
@@ -237,6 +356,7 @@ static void bitband_class_init(ObjectClass *klass, void *data)
|
||||
{
|
||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||
|
||||
dc->realize = bitband_realize;
|
||||
dc->props = bitband_properties;
|
||||
}
|
||||
|
||||
@@ -251,6 +371,7 @@ static const TypeInfo bitband_info = {
|
||||
static void armv7m_register_types(void)
|
||||
{
|
||||
type_register_static(&bitband_info);
|
||||
type_register_static(&armv7m_info);
|
||||
}
|
||||
|
||||
type_init(armv7m_register_types)
|
||||
|
||||
@@ -96,6 +96,11 @@ static void bcm2835_peripherals_init(Object *obj)
|
||||
object_property_add_child(obj, "sdhci", OBJECT(&s->sdhci), NULL);
|
||||
qdev_set_parent_bus(DEVICE(&s->sdhci), sysbus_get_default());
|
||||
|
||||
/* SDHOST */
|
||||
object_initialize(&s->sdhost, sizeof(s->sdhost), TYPE_BCM2835_SDHOST);
|
||||
object_property_add_child(obj, "sdhost", OBJECT(&s->sdhost), NULL);
|
||||
qdev_set_parent_bus(DEVICE(&s->sdhost), sysbus_get_default());
|
||||
|
||||
/* DMA Channels */
|
||||
object_initialize(&s->dma, sizeof(s->dma), TYPE_BCM2835_DMA);
|
||||
object_property_add_child(obj, "dma", OBJECT(&s->dma), NULL);
|
||||
@@ -103,6 +108,16 @@ static void bcm2835_peripherals_init(Object *obj)
|
||||
|
||||
object_property_add_const_link(OBJECT(&s->dma), "dma-mr",
|
||||
OBJECT(&s->gpu_bus_mr), &error_abort);
|
||||
|
||||
/* GPIO */
|
||||
object_initialize(&s->gpio, sizeof(s->gpio), TYPE_BCM2835_GPIO);
|
||||
object_property_add_child(obj, "gpio", OBJECT(&s->gpio), NULL);
|
||||
qdev_set_parent_bus(DEVICE(&s->gpio), sysbus_get_default());
|
||||
|
||||
object_property_add_const_link(OBJECT(&s->gpio), "sdbus-sdhci",
|
||||
OBJECT(&s->sdhci.sdbus), &error_abort);
|
||||
object_property_add_const_link(OBJECT(&s->gpio), "sdbus-sdhost",
|
||||
OBJECT(&s->sdhost.sdbus), &error_abort);
|
||||
}
|
||||
|
||||
static void bcm2835_peripherals_realize(DeviceState *dev, Error **errp)
|
||||
@@ -267,13 +282,20 @@ static void bcm2835_peripherals_realize(DeviceState *dev, Error **errp)
|
||||
sysbus_connect_irq(SYS_BUS_DEVICE(&s->sdhci), 0,
|
||||
qdev_get_gpio_in_named(DEVICE(&s->ic), BCM2835_IC_GPU_IRQ,
|
||||
INTERRUPT_ARASANSDIO));
|
||||
object_property_add_alias(OBJECT(s), "sd-bus", OBJECT(&s->sdhci), "sd-bus",
|
||||
&err);
|
||||
|
||||
/* SDHOST */
|
||||
object_property_set_bool(OBJECT(&s->sdhost), true, "realized", &err);
|
||||
if (err) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
|
||||
memory_region_add_subregion(&s->peri_mr, MMCI0_OFFSET,
|
||||
sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->sdhost), 0));
|
||||
sysbus_connect_irq(SYS_BUS_DEVICE(&s->sdhost), 0,
|
||||
qdev_get_gpio_in_named(DEVICE(&s->ic), BCM2835_IC_GPU_IRQ,
|
||||
INTERRUPT_SDIO));
|
||||
|
||||
/* DMA Channels */
|
||||
object_property_set_bool(OBJECT(&s->dma), true, "realized", &err);
|
||||
if (err) {
|
||||
@@ -292,6 +314,23 @@ static void bcm2835_peripherals_realize(DeviceState *dev, Error **errp)
|
||||
BCM2835_IC_GPU_IRQ,
|
||||
INTERRUPT_DMA0 + n));
|
||||
}
|
||||
|
||||
/* GPIO */
|
||||
object_property_set_bool(OBJECT(&s->gpio), true, "realized", &err);
|
||||
if (err) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
|
||||
memory_region_add_subregion(&s->peri_mr, GPIO_OFFSET,
|
||||
sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->gpio), 0));
|
||||
|
||||
object_property_add_alias(OBJECT(s), "sd-bus", OBJECT(&s->gpio), "sd-bus",
|
||||
&err);
|
||||
if (err) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
static void bcm2835_peripherals_class_init(ObjectClass *oc, void *data)
|
||||
|
||||
+4
-3
@@ -27,17 +27,18 @@
|
||||
#include "hw/boards.h"
|
||||
#include "qemu/error-report.h"
|
||||
#include "hw/arm/stm32f205_soc.h"
|
||||
#include "hw/arm/arm.h"
|
||||
|
||||
static void netduino2_init(MachineState *machine)
|
||||
{
|
||||
DeviceState *dev;
|
||||
|
||||
dev = qdev_create(NULL, TYPE_STM32F205_SOC);
|
||||
if (machine->kernel_filename) {
|
||||
qdev_prop_set_string(dev, "kernel-filename", machine->kernel_filename);
|
||||
}
|
||||
qdev_prop_set_string(dev, "cpu-model", "cortex-m3");
|
||||
object_property_set_bool(OBJECT(dev), true, "realized", &error_fatal);
|
||||
|
||||
armv7m_load_kernel(ARM_CPU(first_cpu), machine->kernel_filename,
|
||||
FLASH_SIZE);
|
||||
}
|
||||
|
||||
static void netduino2_machine_init(MachineClass *mc)
|
||||
|
||||
+19
-9
@@ -49,6 +49,9 @@ static void stm32f205_soc_initfn(Object *obj)
|
||||
STM32F205State *s = STM32F205_SOC(obj);
|
||||
int i;
|
||||
|
||||
object_initialize(&s->armv7m, sizeof(s->armv7m), TYPE_ARMV7M);
|
||||
qdev_set_parent_bus(DEVICE(&s->armv7m), sysbus_get_default());
|
||||
|
||||
object_initialize(&s->syscfg, sizeof(s->syscfg), TYPE_STM32F2XX_SYSCFG);
|
||||
qdev_set_parent_bus(DEVICE(&s->syscfg), sysbus_get_default());
|
||||
|
||||
@@ -82,7 +85,7 @@ static void stm32f205_soc_initfn(Object *obj)
|
||||
static void stm32f205_soc_realize(DeviceState *dev_soc, Error **errp)
|
||||
{
|
||||
STM32F205State *s = STM32F205_SOC(dev_soc);
|
||||
DeviceState *dev, *nvic;
|
||||
DeviceState *dev, *armv7m;
|
||||
SysBusDevice *busdev;
|
||||
Error *err = NULL;
|
||||
int i;
|
||||
@@ -110,8 +113,16 @@ static void stm32f205_soc_realize(DeviceState *dev_soc, Error **errp)
|
||||
vmstate_register_ram_global(sram);
|
||||
memory_region_add_subregion(system_memory, SRAM_BASE_ADDRESS, sram);
|
||||
|
||||
nvic = armv7m_init(get_system_memory(), FLASH_SIZE, 96,
|
||||
s->kernel_filename, s->cpu_model);
|
||||
armv7m = DEVICE(&s->armv7m);
|
||||
qdev_prop_set_uint32(armv7m, "num-irq", 96);
|
||||
qdev_prop_set_string(armv7m, "cpu-model", s->cpu_model);
|
||||
object_property_set_link(OBJECT(&s->armv7m), OBJECT(get_system_memory()),
|
||||
"memory", &error_abort);
|
||||
object_property_set_bool(OBJECT(&s->armv7m), true, "realized", &err);
|
||||
if (err != NULL) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
|
||||
/* System configuration controller */
|
||||
dev = DEVICE(&s->syscfg);
|
||||
@@ -122,7 +133,7 @@ static void stm32f205_soc_realize(DeviceState *dev_soc, Error **errp)
|
||||
}
|
||||
busdev = SYS_BUS_DEVICE(dev);
|
||||
sysbus_mmio_map(busdev, 0, 0x40013800);
|
||||
sysbus_connect_irq(busdev, 0, qdev_get_gpio_in(nvic, 71));
|
||||
sysbus_connect_irq(busdev, 0, qdev_get_gpio_in(armv7m, 71));
|
||||
|
||||
/* Attach UART (uses USART registers) and USART controllers */
|
||||
for (i = 0; i < STM_NUM_USARTS; i++) {
|
||||
@@ -136,7 +147,7 @@ static void stm32f205_soc_realize(DeviceState *dev_soc, Error **errp)
|
||||
}
|
||||
busdev = SYS_BUS_DEVICE(dev);
|
||||
sysbus_mmio_map(busdev, 0, usart_addr[i]);
|
||||
sysbus_connect_irq(busdev, 0, qdev_get_gpio_in(nvic, usart_irq[i]));
|
||||
sysbus_connect_irq(busdev, 0, qdev_get_gpio_in(armv7m, usart_irq[i]));
|
||||
}
|
||||
|
||||
/* Timer 2 to 5 */
|
||||
@@ -150,7 +161,7 @@ static void stm32f205_soc_realize(DeviceState *dev_soc, Error **errp)
|
||||
}
|
||||
busdev = SYS_BUS_DEVICE(dev);
|
||||
sysbus_mmio_map(busdev, 0, timer_addr[i]);
|
||||
sysbus_connect_irq(busdev, 0, qdev_get_gpio_in(nvic, timer_irq[i]));
|
||||
sysbus_connect_irq(busdev, 0, qdev_get_gpio_in(armv7m, timer_irq[i]));
|
||||
}
|
||||
|
||||
/* ADC 1 to 3 */
|
||||
@@ -162,7 +173,7 @@ static void stm32f205_soc_realize(DeviceState *dev_soc, Error **errp)
|
||||
return;
|
||||
}
|
||||
qdev_connect_gpio_out(DEVICE(s->adc_irqs), 0,
|
||||
qdev_get_gpio_in(nvic, ADC_IRQ));
|
||||
qdev_get_gpio_in(armv7m, ADC_IRQ));
|
||||
|
||||
for (i = 0; i < STM_NUM_ADCS; i++) {
|
||||
dev = DEVICE(&(s->adc[i]));
|
||||
@@ -187,12 +198,11 @@ static void stm32f205_soc_realize(DeviceState *dev_soc, Error **errp)
|
||||
}
|
||||
busdev = SYS_BUS_DEVICE(dev);
|
||||
sysbus_mmio_map(busdev, 0, spi_addr[i]);
|
||||
sysbus_connect_irq(busdev, 0, qdev_get_gpio_in(nvic, spi_irq[i]));
|
||||
sysbus_connect_irq(busdev, 0, qdev_get_gpio_in(armv7m, spi_irq[i]));
|
||||
}
|
||||
}
|
||||
|
||||
static Property stm32f205_soc_properties[] = {
|
||||
DEFINE_PROP_STRING("kernel-filename", STM32F205State, kernel_filename),
|
||||
DEFINE_PROP_STRING("cpu-model", STM32F205State, cpu_model),
|
||||
DEFINE_PROP_END_OF_LIST(),
|
||||
};
|
||||
|
||||
@@ -102,9 +102,23 @@ static void bus_add_child(BusState *bus, DeviceState *child)
|
||||
|
||||
void qdev_set_parent_bus(DeviceState *dev, BusState *bus)
|
||||
{
|
||||
bool replugging = dev->parent_bus != NULL;
|
||||
|
||||
if (replugging) {
|
||||
/* Keep a reference to the device while it's not plugged into
|
||||
* any bus, to avoid it potentially evaporating when it is
|
||||
* dereffed in bus_remove_child().
|
||||
*/
|
||||
object_ref(OBJECT(dev));
|
||||
bus_remove_child(dev->parent_bus, dev);
|
||||
object_unref(OBJECT(dev->parent_bus));
|
||||
}
|
||||
dev->parent_bus = bus;
|
||||
object_ref(OBJECT(bus));
|
||||
bus_add_child(bus, dev);
|
||||
if (replugging) {
|
||||
object_unref(OBJECT(dev));
|
||||
}
|
||||
}
|
||||
|
||||
/* Create a new device. This only initializes the device state
|
||||
|
||||
@@ -7,3 +7,4 @@ common-obj-$(CONFIG_GPIO_KEY) += gpio_key.o
|
||||
|
||||
obj-$(CONFIG_OMAP) += omap_gpio.o
|
||||
obj-$(CONFIG_IMX) += imx_gpio.o
|
||||
obj-$(CONFIG_RASPI) += bcm2835_gpio.o
|
||||
|
||||
@@ -0,0 +1,353 @@
|
||||
/*
|
||||
* Raspberry Pi (BCM2835) GPIO Controller
|
||||
*
|
||||
* Copyright (c) 2017 Antfield SAS
|
||||
*
|
||||
* Authors:
|
||||
* Clement Deschamps <clement.deschamps@antfield.fr>
|
||||
* Luc Michel <luc.michel@antfield.fr>
|
||||
*
|
||||
* This work is licensed under the terms of the GNU GPL, version 2 or later.
|
||||
* See the COPYING file in the top-level directory.
|
||||
*/
|
||||
|
||||
#include "qemu/osdep.h"
|
||||
#include "qemu/log.h"
|
||||
#include "qemu/timer.h"
|
||||
#include "qapi/error.h"
|
||||
#include "hw/sysbus.h"
|
||||
#include "hw/sd/sd.h"
|
||||
#include "hw/gpio/bcm2835_gpio.h"
|
||||
|
||||
#define GPFSEL0 0x00
|
||||
#define GPFSEL1 0x04
|
||||
#define GPFSEL2 0x08
|
||||
#define GPFSEL3 0x0C
|
||||
#define GPFSEL4 0x10
|
||||
#define GPFSEL5 0x14
|
||||
#define GPSET0 0x1C
|
||||
#define GPSET1 0x20
|
||||
#define GPCLR0 0x28
|
||||
#define GPCLR1 0x2C
|
||||
#define GPLEV0 0x34
|
||||
#define GPLEV1 0x38
|
||||
#define GPEDS0 0x40
|
||||
#define GPEDS1 0x44
|
||||
#define GPREN0 0x4C
|
||||
#define GPREN1 0x50
|
||||
#define GPFEN0 0x58
|
||||
#define GPFEN1 0x5C
|
||||
#define GPHEN0 0x64
|
||||
#define GPHEN1 0x68
|
||||
#define GPLEN0 0x70
|
||||
#define GPLEN1 0x74
|
||||
#define GPAREN0 0x7C
|
||||
#define GPAREN1 0x80
|
||||
#define GPAFEN0 0x88
|
||||
#define GPAFEN1 0x8C
|
||||
#define GPPUD 0x94
|
||||
#define GPPUDCLK0 0x98
|
||||
#define GPPUDCLK1 0x9C
|
||||
|
||||
static uint32_t gpfsel_get(BCM2835GpioState *s, uint8_t reg)
|
||||
{
|
||||
int i;
|
||||
uint32_t value = 0;
|
||||
for (i = 0; i < 10; i++) {
|
||||
uint32_t index = 10 * reg + i;
|
||||
if (index < sizeof(s->fsel)) {
|
||||
value |= (s->fsel[index] & 0x7) << (3 * i);
|
||||
}
|
||||
}
|
||||
return value;
|
||||
}
|
||||
|
||||
static void gpfsel_set(BCM2835GpioState *s, uint8_t reg, uint32_t value)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < 10; i++) {
|
||||
uint32_t index = 10 * reg + i;
|
||||
if (index < sizeof(s->fsel)) {
|
||||
int fsel = (value >> (3 * i)) & 0x7;
|
||||
s->fsel[index] = fsel;
|
||||
}
|
||||
}
|
||||
|
||||
/* SD controller selection (48-53) */
|
||||
if (s->sd_fsel != 0
|
||||
&& (s->fsel[48] == 0) /* SD_CLK_R */
|
||||
&& (s->fsel[49] == 0) /* SD_CMD_R */
|
||||
&& (s->fsel[50] == 0) /* SD_DATA0_R */
|
||||
&& (s->fsel[51] == 0) /* SD_DATA1_R */
|
||||
&& (s->fsel[52] == 0) /* SD_DATA2_R */
|
||||
&& (s->fsel[53] == 0) /* SD_DATA3_R */
|
||||
) {
|
||||
/* SDHCI controller selected */
|
||||
sdbus_reparent_card(s->sdbus_sdhost, s->sdbus_sdhci);
|
||||
s->sd_fsel = 0;
|
||||
} else if (s->sd_fsel != 4
|
||||
&& (s->fsel[48] == 4) /* SD_CLK_R */
|
||||
&& (s->fsel[49] == 4) /* SD_CMD_R */
|
||||
&& (s->fsel[50] == 4) /* SD_DATA0_R */
|
||||
&& (s->fsel[51] == 4) /* SD_DATA1_R */
|
||||
&& (s->fsel[52] == 4) /* SD_DATA2_R */
|
||||
&& (s->fsel[53] == 4) /* SD_DATA3_R */
|
||||
) {
|
||||
/* SDHost controller selected */
|
||||
sdbus_reparent_card(s->sdbus_sdhci, s->sdbus_sdhost);
|
||||
s->sd_fsel = 4;
|
||||
}
|
||||
}
|
||||
|
||||
static int gpfsel_is_out(BCM2835GpioState *s, int index)
|
||||
{
|
||||
if (index >= 0 && index < 54) {
|
||||
return s->fsel[index] == 1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void gpset(BCM2835GpioState *s,
|
||||
uint32_t val, uint8_t start, uint8_t count, uint32_t *lev)
|
||||
{
|
||||
uint32_t changes = val & ~*lev;
|
||||
uint32_t cur = 1;
|
||||
|
||||
int i;
|
||||
for (i = 0; i < count; i++) {
|
||||
if ((changes & cur) && (gpfsel_is_out(s, start + i))) {
|
||||
qemu_set_irq(s->out[start + i], 1);
|
||||
}
|
||||
cur <<= 1;
|
||||
}
|
||||
|
||||
*lev |= val;
|
||||
}
|
||||
|
||||
static void gpclr(BCM2835GpioState *s,
|
||||
uint32_t val, uint8_t start, uint8_t count, uint32_t *lev)
|
||||
{
|
||||
uint32_t changes = val & *lev;
|
||||
uint32_t cur = 1;
|
||||
|
||||
int i;
|
||||
for (i = 0; i < count; i++) {
|
||||
if ((changes & cur) && (gpfsel_is_out(s, start + i))) {
|
||||
qemu_set_irq(s->out[start + i], 0);
|
||||
}
|
||||
cur <<= 1;
|
||||
}
|
||||
|
||||
*lev &= ~val;
|
||||
}
|
||||
|
||||
static uint64_t bcm2835_gpio_read(void *opaque, hwaddr offset,
|
||||
unsigned size)
|
||||
{
|
||||
BCM2835GpioState *s = (BCM2835GpioState *)opaque;
|
||||
|
||||
switch (offset) {
|
||||
case GPFSEL0:
|
||||
case GPFSEL1:
|
||||
case GPFSEL2:
|
||||
case GPFSEL3:
|
||||
case GPFSEL4:
|
||||
case GPFSEL5:
|
||||
return gpfsel_get(s, offset / 4);
|
||||
case GPSET0:
|
||||
case GPSET1:
|
||||
/* Write Only */
|
||||
return 0;
|
||||
case GPCLR0:
|
||||
case GPCLR1:
|
||||
/* Write Only */
|
||||
return 0;
|
||||
case GPLEV0:
|
||||
return s->lev0;
|
||||
case GPLEV1:
|
||||
return s->lev1;
|
||||
case GPEDS0:
|
||||
case GPEDS1:
|
||||
case GPREN0:
|
||||
case GPREN1:
|
||||
case GPFEN0:
|
||||
case GPFEN1:
|
||||
case GPHEN0:
|
||||
case GPHEN1:
|
||||
case GPLEN0:
|
||||
case GPLEN1:
|
||||
case GPAREN0:
|
||||
case GPAREN1:
|
||||
case GPAFEN0:
|
||||
case GPAFEN1:
|
||||
case GPPUD:
|
||||
case GPPUDCLK0:
|
||||
case GPPUDCLK1:
|
||||
/* Not implemented */
|
||||
return 0;
|
||||
default:
|
||||
qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset %"HWADDR_PRIx"\n",
|
||||
__func__, offset);
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void bcm2835_gpio_write(void *opaque, hwaddr offset,
|
||||
uint64_t value, unsigned size)
|
||||
{
|
||||
BCM2835GpioState *s = (BCM2835GpioState *)opaque;
|
||||
|
||||
switch (offset) {
|
||||
case GPFSEL0:
|
||||
case GPFSEL1:
|
||||
case GPFSEL2:
|
||||
case GPFSEL3:
|
||||
case GPFSEL4:
|
||||
case GPFSEL5:
|
||||
gpfsel_set(s, offset / 4, value);
|
||||
break;
|
||||
case GPSET0:
|
||||
gpset(s, value, 0, 32, &s->lev0);
|
||||
break;
|
||||
case GPSET1:
|
||||
gpset(s, value, 32, 22, &s->lev1);
|
||||
break;
|
||||
case GPCLR0:
|
||||
gpclr(s, value, 0, 32, &s->lev0);
|
||||
break;
|
||||
case GPCLR1:
|
||||
gpclr(s, value, 32, 22, &s->lev1);
|
||||
break;
|
||||
case GPLEV0:
|
||||
case GPLEV1:
|
||||
/* Read Only */
|
||||
break;
|
||||
case GPEDS0:
|
||||
case GPEDS1:
|
||||
case GPREN0:
|
||||
case GPREN1:
|
||||
case GPFEN0:
|
||||
case GPFEN1:
|
||||
case GPHEN0:
|
||||
case GPHEN1:
|
||||
case GPLEN0:
|
||||
case GPLEN1:
|
||||
case GPAREN0:
|
||||
case GPAREN1:
|
||||
case GPAFEN0:
|
||||
case GPAFEN1:
|
||||
case GPPUD:
|
||||
case GPPUDCLK0:
|
||||
case GPPUDCLK1:
|
||||
/* Not implemented */
|
||||
break;
|
||||
default:
|
||||
goto err_out;
|
||||
}
|
||||
return;
|
||||
|
||||
err_out:
|
||||
qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset %"HWADDR_PRIx"\n",
|
||||
__func__, offset);
|
||||
}
|
||||
|
||||
static void bcm2835_gpio_reset(DeviceState *dev)
|
||||
{
|
||||
BCM2835GpioState *s = BCM2835_GPIO(dev);
|
||||
|
||||
int i;
|
||||
for (i = 0; i < 6; i++) {
|
||||
gpfsel_set(s, i, 0);
|
||||
}
|
||||
|
||||
s->sd_fsel = 0;
|
||||
|
||||
/* SDHCI is selected by default */
|
||||
sdbus_reparent_card(&s->sdbus, s->sdbus_sdhci);
|
||||
|
||||
s->lev0 = 0;
|
||||
s->lev1 = 0;
|
||||
}
|
||||
|
||||
static const MemoryRegionOps bcm2835_gpio_ops = {
|
||||
.read = bcm2835_gpio_read,
|
||||
.write = bcm2835_gpio_write,
|
||||
.endianness = DEVICE_NATIVE_ENDIAN,
|
||||
};
|
||||
|
||||
static const VMStateDescription vmstate_bcm2835_gpio = {
|
||||
.name = "bcm2835_gpio",
|
||||
.version_id = 1,
|
||||
.minimum_version_id = 1,
|
||||
.fields = (VMStateField[]) {
|
||||
VMSTATE_UINT8_ARRAY(fsel, BCM2835GpioState, 54),
|
||||
VMSTATE_UINT32(lev0, BCM2835GpioState),
|
||||
VMSTATE_UINT32(lev1, BCM2835GpioState),
|
||||
VMSTATE_UINT8(sd_fsel, BCM2835GpioState),
|
||||
VMSTATE_END_OF_LIST()
|
||||
}
|
||||
};
|
||||
|
||||
static void bcm2835_gpio_init(Object *obj)
|
||||
{
|
||||
BCM2835GpioState *s = BCM2835_GPIO(obj);
|
||||
DeviceState *dev = DEVICE(obj);
|
||||
SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
|
||||
|
||||
qbus_create_inplace(&s->sdbus, sizeof(s->sdbus),
|
||||
TYPE_SD_BUS, DEVICE(s), "sd-bus");
|
||||
|
||||
memory_region_init_io(&s->iomem, obj,
|
||||
&bcm2835_gpio_ops, s, "bcm2835_gpio", 0x1000);
|
||||
sysbus_init_mmio(sbd, &s->iomem);
|
||||
qdev_init_gpio_out(dev, s->out, 54);
|
||||
}
|
||||
|
||||
static void bcm2835_gpio_realize(DeviceState *dev, Error **errp)
|
||||
{
|
||||
BCM2835GpioState *s = BCM2835_GPIO(dev);
|
||||
Object *obj;
|
||||
Error *err = NULL;
|
||||
|
||||
obj = object_property_get_link(OBJECT(dev), "sdbus-sdhci", &err);
|
||||
if (obj == NULL) {
|
||||
error_setg(errp, "%s: required sdhci link not found: %s",
|
||||
__func__, error_get_pretty(err));
|
||||
return;
|
||||
}
|
||||
s->sdbus_sdhci = SD_BUS(obj);
|
||||
|
||||
obj = object_property_get_link(OBJECT(dev), "sdbus-sdhost", &err);
|
||||
if (obj == NULL) {
|
||||
error_setg(errp, "%s: required sdhost link not found: %s",
|
||||
__func__, error_get_pretty(err));
|
||||
return;
|
||||
}
|
||||
s->sdbus_sdhost = SD_BUS(obj);
|
||||
}
|
||||
|
||||
static void bcm2835_gpio_class_init(ObjectClass *klass, void *data)
|
||||
{
|
||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||
|
||||
dc->vmsd = &vmstate_bcm2835_gpio;
|
||||
dc->realize = &bcm2835_gpio_realize;
|
||||
dc->reset = &bcm2835_gpio_reset;
|
||||
}
|
||||
|
||||
static const TypeInfo bcm2835_gpio_info = {
|
||||
.name = TYPE_BCM2835_GPIO,
|
||||
.parent = TYPE_SYS_BUS_DEVICE,
|
||||
.instance_size = sizeof(BCM2835GpioState),
|
||||
.instance_init = bcm2835_gpio_init,
|
||||
.class_init = bcm2835_gpio_class_init,
|
||||
};
|
||||
|
||||
static void bcm2835_gpio_register_types(void)
|
||||
{
|
||||
type_register_static(&bcm2835_gpio_info);
|
||||
}
|
||||
|
||||
type_init(bcm2835_gpio_register_types)
|
||||
@@ -24,7 +24,7 @@ obj-$(CONFIG_APIC) += apic.o apic_common.o
|
||||
obj-$(CONFIG_ARM_GIC_KVM) += arm_gic_kvm.o
|
||||
obj-$(call land,$(CONFIG_ARM_GIC_KVM),$(TARGET_AARCH64)) += arm_gicv3_kvm.o
|
||||
obj-$(call land,$(CONFIG_ARM_GIC_KVM),$(TARGET_AARCH64)) += arm_gicv3_its_kvm.o
|
||||
obj-$(CONFIG_STELLARIS) += armv7m_nvic.o
|
||||
obj-$(CONFIG_ARM_V7M) += armv7m_nvic.o
|
||||
obj-$(CONFIG_EXYNOS4) += exynos4210_gic.o exynos4210_combiner.o
|
||||
obj-$(CONFIG_GRLIB) += grlib_irqmp.o
|
||||
obj-$(CONFIG_IOAPIC) += ioapic.o
|
||||
|
||||
@@ -70,6 +70,38 @@ static const VMStateDescription vmstate_gicv3_cpu_virt = {
|
||||
}
|
||||
};
|
||||
|
||||
static int icc_sre_el1_reg_pre_load(void *opaque)
|
||||
{
|
||||
GICv3CPUState *cs = opaque;
|
||||
|
||||
/*
|
||||
* If the sre_el1 subsection is not transferred this
|
||||
* means SRE_EL1 is 0x7 (which might not be the same as
|
||||
* our reset value).
|
||||
*/
|
||||
cs->icc_sre_el1 = 0x7;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static bool icc_sre_el1_reg_needed(void *opaque)
|
||||
{
|
||||
GICv3CPUState *cs = opaque;
|
||||
|
||||
return cs->icc_sre_el1 != 7;
|
||||
}
|
||||
|
||||
const VMStateDescription vmstate_gicv3_cpu_sre_el1 = {
|
||||
.name = "arm_gicv3_cpu/sre_el1",
|
||||
.version_id = 1,
|
||||
.minimum_version_id = 1,
|
||||
.pre_load = icc_sre_el1_reg_pre_load,
|
||||
.needed = icc_sre_el1_reg_needed,
|
||||
.fields = (VMStateField[]) {
|
||||
VMSTATE_UINT64(icc_sre_el1, GICv3CPUState),
|
||||
VMSTATE_END_OF_LIST()
|
||||
}
|
||||
};
|
||||
|
||||
static const VMStateDescription vmstate_gicv3_cpu = {
|
||||
.name = "arm_gicv3_cpu",
|
||||
.version_id = 1,
|
||||
@@ -100,6 +132,10 @@ static const VMStateDescription vmstate_gicv3_cpu = {
|
||||
.subsections = (const VMStateDescription * []) {
|
||||
&vmstate_gicv3_cpu_virt,
|
||||
NULL
|
||||
},
|
||||
.subsections = (const VMStateDescription * []) {
|
||||
&vmstate_gicv3_cpu_sre_el1,
|
||||
NULL
|
||||
}
|
||||
};
|
||||
|
||||
@@ -216,6 +252,8 @@ static void arm_gicv3_common_realize(DeviceState *dev, Error **errp)
|
||||
|
||||
s->cpu[i].cpu = cpu;
|
||||
s->cpu[i].gic = s;
|
||||
/* Store GICv3CPUState in CPUARMState gicv3state pointer */
|
||||
gicv3_set_gicv3state(cpu, &s->cpu[i]);
|
||||
|
||||
/* Pre-construct the GICR_TYPER:
|
||||
* For our implementation:
|
||||
|
||||
@@ -19,6 +19,14 @@
|
||||
#include "gicv3_internal.h"
|
||||
#include "cpu.h"
|
||||
|
||||
void gicv3_set_gicv3state(CPUState *cpu, GICv3CPUState *s)
|
||||
{
|
||||
ARMCPU *arm_cpu = ARM_CPU(cpu);
|
||||
CPUARMState *env = &arm_cpu->env;
|
||||
|
||||
env->gicv3state = (void *)s;
|
||||
};
|
||||
|
||||
static GICv3CPUState *icc_cs_from_env(CPUARMState *env)
|
||||
{
|
||||
/* Given the CPU, find the right GICv3CPUState struct.
|
||||
|
||||
+615
-14
File diff suppressed because it is too large
Load Diff
+36
-178
@@ -17,8 +17,8 @@
|
||||
#include "hw/sysbus.h"
|
||||
#include "qemu/timer.h"
|
||||
#include "hw/arm/arm.h"
|
||||
#include "hw/arm/armv7m_nvic.h"
|
||||
#include "target/arm/cpu.h"
|
||||
#include "exec/address-spaces.h"
|
||||
#include "qemu/log.h"
|
||||
#include "trace.h"
|
||||
|
||||
@@ -47,7 +47,6 @@
|
||||
* "exception" more or less interchangeably.
|
||||
*/
|
||||
#define NVIC_FIRST_IRQ 16
|
||||
#define NVIC_MAX_VECTORS 512
|
||||
#define NVIC_MAX_IRQ (NVIC_MAX_VECTORS - NVIC_FIRST_IRQ)
|
||||
|
||||
/* Effective running priority of the CPU when no exception is active
|
||||
@@ -55,116 +54,10 @@
|
||||
*/
|
||||
#define NVIC_NOEXC_PRIO 0x100
|
||||
|
||||
typedef struct VecInfo {
|
||||
/* Exception priorities can range from -3 to 255; only the unmodifiable
|
||||
* priority values for RESET, NMI and HardFault can be negative.
|
||||
*/
|
||||
int16_t prio;
|
||||
uint8_t enabled;
|
||||
uint8_t pending;
|
||||
uint8_t active;
|
||||
uint8_t level; /* exceptions <=15 never set level */
|
||||
} VecInfo;
|
||||
|
||||
typedef struct NVICState {
|
||||
/*< private >*/
|
||||
SysBusDevice parent_obj;
|
||||
/*< public >*/
|
||||
|
||||
ARMCPU *cpu;
|
||||
|
||||
VecInfo vectors[NVIC_MAX_VECTORS];
|
||||
uint32_t prigroup;
|
||||
|
||||
/* vectpending and exception_prio are both cached state that can
|
||||
* be recalculated from the vectors[] array and the prigroup field.
|
||||
*/
|
||||
unsigned int vectpending; /* highest prio pending enabled exception */
|
||||
int exception_prio; /* group prio of the highest prio active exception */
|
||||
|
||||
struct {
|
||||
uint32_t control;
|
||||
uint32_t reload;
|
||||
int64_t tick;
|
||||
QEMUTimer *timer;
|
||||
} systick;
|
||||
|
||||
MemoryRegion sysregmem;
|
||||
MemoryRegion container;
|
||||
|
||||
uint32_t num_irq;
|
||||
qemu_irq excpout;
|
||||
qemu_irq sysresetreq;
|
||||
} NVICState;
|
||||
|
||||
#define TYPE_NVIC "armv7m_nvic"
|
||||
|
||||
#define NVIC(obj) \
|
||||
OBJECT_CHECK(NVICState, (obj), TYPE_NVIC)
|
||||
|
||||
static const uint8_t nvic_id[] = {
|
||||
0x00, 0xb0, 0x1b, 0x00, 0x0d, 0xe0, 0x05, 0xb1
|
||||
};
|
||||
|
||||
/* qemu timers run at 1GHz. We want something closer to 1MHz. */
|
||||
#define SYSTICK_SCALE 1000ULL
|
||||
|
||||
#define SYSTICK_ENABLE (1 << 0)
|
||||
#define SYSTICK_TICKINT (1 << 1)
|
||||
#define SYSTICK_CLKSOURCE (1 << 2)
|
||||
#define SYSTICK_COUNTFLAG (1 << 16)
|
||||
|
||||
int system_clock_scale;
|
||||
|
||||
/* Conversion factor from qemu timer to SysTick frequencies. */
|
||||
static inline int64_t systick_scale(NVICState *s)
|
||||
{
|
||||
if (s->systick.control & SYSTICK_CLKSOURCE)
|
||||
return system_clock_scale;
|
||||
else
|
||||
return 1000;
|
||||
}
|
||||
|
||||
static void systick_reload(NVICState *s, int reset)
|
||||
{
|
||||
/* The Cortex-M3 Devices Generic User Guide says that "When the
|
||||
* ENABLE bit is set to 1, the counter loads the RELOAD value from the
|
||||
* SYST RVR register and then counts down". So, we need to check the
|
||||
* ENABLE bit before reloading the value.
|
||||
*/
|
||||
if ((s->systick.control & SYSTICK_ENABLE) == 0) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (reset)
|
||||
s->systick.tick = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
||||
s->systick.tick += (s->systick.reload + 1) * systick_scale(s);
|
||||
timer_mod(s->systick.timer, s->systick.tick);
|
||||
}
|
||||
|
||||
static void systick_timer_tick(void * opaque)
|
||||
{
|
||||
NVICState *s = (NVICState *)opaque;
|
||||
s->systick.control |= SYSTICK_COUNTFLAG;
|
||||
if (s->systick.control & SYSTICK_TICKINT) {
|
||||
/* Trigger the interrupt. */
|
||||
armv7m_nvic_set_pending(s, ARMV7M_EXCP_SYSTICK);
|
||||
}
|
||||
if (s->systick.reload == 0) {
|
||||
s->systick.control &= ~SYSTICK_ENABLE;
|
||||
} else {
|
||||
systick_reload(s, 0);
|
||||
}
|
||||
}
|
||||
|
||||
static void systick_reset(NVICState *s)
|
||||
{
|
||||
s->systick.control = 0;
|
||||
s->systick.reload = 0;
|
||||
s->systick.tick = 0;
|
||||
timer_del(s->systick.timer);
|
||||
}
|
||||
|
||||
static int nvic_pending_prio(NVICState *s)
|
||||
{
|
||||
/* return the priority of the current pending interrupt,
|
||||
@@ -510,30 +403,6 @@ static uint32_t nvic_readl(NVICState *s, uint32_t offset)
|
||||
switch (offset) {
|
||||
case 4: /* Interrupt Control Type. */
|
||||
return ((s->num_irq - NVIC_FIRST_IRQ) / 32) - 1;
|
||||
case 0x10: /* SysTick Control and Status. */
|
||||
val = s->systick.control;
|
||||
s->systick.control &= ~SYSTICK_COUNTFLAG;
|
||||
return val;
|
||||
case 0x14: /* SysTick Reload Value. */
|
||||
return s->systick.reload;
|
||||
case 0x18: /* SysTick Current Value. */
|
||||
{
|
||||
int64_t t;
|
||||
if ((s->systick.control & SYSTICK_ENABLE) == 0)
|
||||
return 0;
|
||||
t = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
||||
if (t >= s->systick.tick)
|
||||
return 0;
|
||||
val = ((s->systick.tick - (t + 1)) / systick_scale(s)) + 1;
|
||||
/* The interrupt in triggered when the timer reaches zero.
|
||||
However the counter is not reloaded until the next clock
|
||||
tick. This is a hack to return zero during the first tick. */
|
||||
if (val > s->systick.reload)
|
||||
val = 0;
|
||||
return val;
|
||||
}
|
||||
case 0x1c: /* SysTick Calibration Value. */
|
||||
return 10000;
|
||||
case 0xd00: /* CPUID Base. */
|
||||
return cpu->midr;
|
||||
case 0xd04: /* Interrupt Control State. */
|
||||
@@ -668,40 +537,8 @@ static uint32_t nvic_readl(NVICState *s, uint32_t offset)
|
||||
static void nvic_writel(NVICState *s, uint32_t offset, uint32_t value)
|
||||
{
|
||||
ARMCPU *cpu = s->cpu;
|
||||
uint32_t oldval;
|
||||
|
||||
switch (offset) {
|
||||
case 0x10: /* SysTick Control and Status. */
|
||||
oldval = s->systick.control;
|
||||
s->systick.control &= 0xfffffff8;
|
||||
s->systick.control |= value & 7;
|
||||
if ((oldval ^ value) & SYSTICK_ENABLE) {
|
||||
int64_t now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
||||
if (value & SYSTICK_ENABLE) {
|
||||
if (s->systick.tick) {
|
||||
s->systick.tick += now;
|
||||
timer_mod(s->systick.timer, s->systick.tick);
|
||||
} else {
|
||||
systick_reload(s, 1);
|
||||
}
|
||||
} else {
|
||||
timer_del(s->systick.timer);
|
||||
s->systick.tick -= now;
|
||||
if (s->systick.tick < 0)
|
||||
s->systick.tick = 0;
|
||||
}
|
||||
} else if ((oldval ^ value) & SYSTICK_CLKSOURCE) {
|
||||
/* This is a hack. Force the timer to be reloaded
|
||||
when the reference clock is changed. */
|
||||
systick_reload(s, 1);
|
||||
}
|
||||
break;
|
||||
case 0x14: /* SysTick Reload Value. */
|
||||
s->systick.reload = value;
|
||||
break;
|
||||
case 0x18: /* SysTick Current Value. Writes reload the timer. */
|
||||
systick_reload(s, 1);
|
||||
s->systick.control &= ~SYSTICK_COUNTFLAG;
|
||||
break;
|
||||
case 0xd04: /* Interrupt Control State. */
|
||||
if (value & (1 << 31)) {
|
||||
armv7m_nvic_set_pending(s, ARMV7M_EXCP_NMI);
|
||||
@@ -1000,16 +837,12 @@ static const VMStateDescription vmstate_VecInfo = {
|
||||
|
||||
static const VMStateDescription vmstate_nvic = {
|
||||
.name = "armv7m_nvic",
|
||||
.version_id = 3,
|
||||
.minimum_version_id = 3,
|
||||
.version_id = 4,
|
||||
.minimum_version_id = 4,
|
||||
.post_load = &nvic_post_load,
|
||||
.fields = (VMStateField[]) {
|
||||
VMSTATE_STRUCT_ARRAY(vectors, NVICState, NVIC_MAX_VECTORS, 1,
|
||||
vmstate_VecInfo, VecInfo),
|
||||
VMSTATE_UINT32(systick.control, NVICState),
|
||||
VMSTATE_UINT32(systick.reload, NVICState),
|
||||
VMSTATE_INT64(systick.tick, NVICState),
|
||||
VMSTATE_TIMER_PTR(systick.timer, NVICState),
|
||||
VMSTATE_UINT32(prigroup, NVICState),
|
||||
VMSTATE_END_OF_LIST()
|
||||
}
|
||||
@@ -1047,13 +880,26 @@ static void armv7m_nvic_reset(DeviceState *dev)
|
||||
|
||||
s->exception_prio = NVIC_NOEXC_PRIO;
|
||||
s->vectpending = 0;
|
||||
}
|
||||
|
||||
systick_reset(s);
|
||||
static void nvic_systick_trigger(void *opaque, int n, int level)
|
||||
{
|
||||
NVICState *s = opaque;
|
||||
|
||||
if (level) {
|
||||
/* SysTick just asked us to pend its exception.
|
||||
* (This is different from an external interrupt line's
|
||||
* behaviour.)
|
||||
*/
|
||||
armv7m_nvic_set_pending(s, ARMV7M_EXCP_SYSTICK);
|
||||
}
|
||||
}
|
||||
|
||||
static void armv7m_nvic_realize(DeviceState *dev, Error **errp)
|
||||
{
|
||||
NVICState *s = NVIC(dev);
|
||||
SysBusDevice *systick_sbd;
|
||||
Error *err = NULL;
|
||||
|
||||
s->cpu = ARM_CPU(qemu_get_cpu(0));
|
||||
assert(s->cpu);
|
||||
@@ -1068,10 +914,19 @@ static void armv7m_nvic_realize(DeviceState *dev, Error **errp)
|
||||
/* include space for internal exception vectors */
|
||||
s->num_irq += NVIC_FIRST_IRQ;
|
||||
|
||||
object_property_set_bool(OBJECT(&s->systick), true, "realized", &err);
|
||||
if (err != NULL) {
|
||||
error_propagate(errp, err);
|
||||
return;
|
||||
}
|
||||
systick_sbd = SYS_BUS_DEVICE(&s->systick);
|
||||
sysbus_connect_irq(systick_sbd, 0,
|
||||
qdev_get_gpio_in_named(dev, "systick-trigger", 0));
|
||||
|
||||
/* The NVIC and System Control Space (SCS) starts at 0xe000e000
|
||||
* and looks like this:
|
||||
* 0x004 - ICTR
|
||||
* 0x010 - 0x1c - systick
|
||||
* 0x010 - 0xff - systick
|
||||
* 0x100..0x7ec - NVIC
|
||||
* 0x7f0..0xcff - Reserved
|
||||
* 0xd00..0xd3c - SCS registers
|
||||
@@ -1089,12 +944,11 @@ static void armv7m_nvic_realize(DeviceState *dev, Error **errp)
|
||||
memory_region_init_io(&s->sysregmem, OBJECT(s), &nvic_sysreg_ops, s,
|
||||
"nvic_sysregs", 0x1000);
|
||||
memory_region_add_subregion(&s->container, 0, &s->sysregmem);
|
||||
memory_region_add_subregion_overlap(&s->container, 0x10,
|
||||
sysbus_mmio_get_region(systick_sbd, 0),
|
||||
1);
|
||||
|
||||
/* Map the whole thing into system memory at the location required
|
||||
* by the v7M architecture.
|
||||
*/
|
||||
memory_region_add_subregion(get_system_memory(), 0xe000e000, &s->container);
|
||||
s->systick.timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, systick_timer_tick, s);
|
||||
sysbus_init_mmio(SYS_BUS_DEVICE(dev), &s->container);
|
||||
}
|
||||
|
||||
static void armv7m_nvic_instance_init(Object *obj)
|
||||
@@ -1109,8 +963,12 @@ static void armv7m_nvic_instance_init(Object *obj)
|
||||
NVICState *nvic = NVIC(obj);
|
||||
SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
|
||||
|
||||
object_initialize(&nvic->systick, sizeof(nvic->systick), TYPE_SYSTICK);
|
||||
qdev_set_parent_bus(DEVICE(&nvic->systick), sysbus_get_default());
|
||||
|
||||
sysbus_init_irq(sbd, &nvic->excpout);
|
||||
qdev_init_gpio_out_named(dev, &nvic->sysresetreq, "SYSRESETREQ", 1);
|
||||
qdev_init_gpio_in_named(dev, nvic_systick_trigger, "systick-trigger", 1);
|
||||
}
|
||||
|
||||
static void armv7m_nvic_class_init(ObjectClass *klass, void *data)
|
||||
|
||||
@@ -138,6 +138,7 @@
|
||||
#define ICC_CTLR_EL1_EOIMODE (1U << 1)
|
||||
#define ICC_CTLR_EL1_PMHE (1U << 6)
|
||||
#define ICC_CTLR_EL1_PRIBITS_SHIFT 8
|
||||
#define ICC_CTLR_EL1_PRIBITS_MASK (7U << ICC_CTLR_EL1_PRIBITS_SHIFT)
|
||||
#define ICC_CTLR_EL1_IDBITS_SHIFT 11
|
||||
#define ICC_CTLR_EL1_SEIS (1U << 14)
|
||||
#define ICC_CTLR_EL1_A3V (1U << 15)
|
||||
@@ -407,4 +408,6 @@ static inline void gicv3_cache_all_target_cpustates(GICv3State *s)
|
||||
}
|
||||
}
|
||||
|
||||
void gicv3_set_gicv3state(CPUState *cpu, GICv3CPUState *s);
|
||||
|
||||
#endif /* QEMU_ARM_GICV3_INTERNAL_H */
|
||||
|
||||
@@ -131,6 +131,33 @@ void sdbus_set_readonly(SDBus *sdbus, bool readonly)
|
||||
}
|
||||
}
|
||||
|
||||
void sdbus_reparent_card(SDBus *from, SDBus *to)
|
||||
{
|
||||
SDState *card = get_card(from);
|
||||
SDCardClass *sc;
|
||||
bool readonly;
|
||||
|
||||
/* We directly reparent the card object rather than implementing this
|
||||
* as a hotpluggable connection because we don't want to expose SD cards
|
||||
* to users as being hotpluggable, and we can get away with it in this
|
||||
* limited use case. This could perhaps be implemented more cleanly in
|
||||
* future by adding support to the hotplug infrastructure for "device
|
||||
* can be hotplugged only via code, not by user".
|
||||
*/
|
||||
|
||||
if (!card) {
|
||||
return;
|
||||
}
|
||||
|
||||
sc = SD_CARD_GET_CLASS(card);
|
||||
readonly = sc->get_readonly(card);
|
||||
|
||||
sdbus_set_inserted(from, false);
|
||||
qdev_set_parent_bus(DEVICE(card), &to->qbus);
|
||||
sdbus_set_inserted(to, true);
|
||||
sdbus_set_readonly(to, readonly);
|
||||
}
|
||||
|
||||
static const TypeInfo sd_bus_info = {
|
||||
.name = TYPE_SD_BUS,
|
||||
.parent = TYPE_BUS,
|
||||
|
||||
@@ -1,5 +1,6 @@
|
||||
common-obj-$(CONFIG_ARM_TIMER) += arm_timer.o
|
||||
common-obj-$(CONFIG_ARM_MPTIMER) += arm_mptimer.o
|
||||
common-obj-$(CONFIG_ARM_V7M) += armv7m_systick.o
|
||||
common-obj-$(CONFIG_A9_GTIMER) += a9gtimer.o
|
||||
common-obj-$(CONFIG_CADENCE) += cadence_ttc.o
|
||||
common-obj-$(CONFIG_DS1338) += ds1338.o
|
||||
|
||||
@@ -0,0 +1,240 @@
|
||||
/*
|
||||
* ARMv7M SysTick timer
|
||||
*
|
||||
* Copyright (c) 2006-2007 CodeSourcery.
|
||||
* Written by Paul Brook
|
||||
* Copyright (c) 2017 Linaro Ltd
|
||||
* Written by Peter Maydell
|
||||
*
|
||||
* This code is licensed under the GPL (version 2 or later).
|
||||
*/
|
||||
|
||||
#include "qemu/osdep.h"
|
||||
#include "hw/timer/armv7m_systick.h"
|
||||
#include "qemu-common.h"
|
||||
#include "hw/sysbus.h"
|
||||
#include "qemu/timer.h"
|
||||
#include "qemu/log.h"
|
||||
#include "trace.h"
|
||||
|
||||
/* qemu timers run at 1GHz. We want something closer to 1MHz. */
|
||||
#define SYSTICK_SCALE 1000ULL
|
||||
|
||||
#define SYSTICK_ENABLE (1 << 0)
|
||||
#define SYSTICK_TICKINT (1 << 1)
|
||||
#define SYSTICK_CLKSOURCE (1 << 2)
|
||||
#define SYSTICK_COUNTFLAG (1 << 16)
|
||||
|
||||
int system_clock_scale;
|
||||
|
||||
/* Conversion factor from qemu timer to SysTick frequencies. */
|
||||
static inline int64_t systick_scale(SysTickState *s)
|
||||
{
|
||||
if (s->control & SYSTICK_CLKSOURCE) {
|
||||
return system_clock_scale;
|
||||
} else {
|
||||
return 1000;
|
||||
}
|
||||
}
|
||||
|
||||
static void systick_reload(SysTickState *s, int reset)
|
||||
{
|
||||
/* The Cortex-M3 Devices Generic User Guide says that "When the
|
||||
* ENABLE bit is set to 1, the counter loads the RELOAD value from the
|
||||
* SYST RVR register and then counts down". So, we need to check the
|
||||
* ENABLE bit before reloading the value.
|
||||
*/
|
||||
trace_systick_reload();
|
||||
|
||||
if ((s->control & SYSTICK_ENABLE) == 0) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (reset) {
|
||||
s->tick = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
||||
}
|
||||
s->tick += (s->reload + 1) * systick_scale(s);
|
||||
timer_mod(s->timer, s->tick);
|
||||
}
|
||||
|
||||
static void systick_timer_tick(void *opaque)
|
||||
{
|
||||
SysTickState *s = (SysTickState *)opaque;
|
||||
|
||||
trace_systick_timer_tick();
|
||||
|
||||
s->control |= SYSTICK_COUNTFLAG;
|
||||
if (s->control & SYSTICK_TICKINT) {
|
||||
/* Tell the NVIC to pend the SysTick exception */
|
||||
qemu_irq_pulse(s->irq);
|
||||
}
|
||||
if (s->reload == 0) {
|
||||
s->control &= ~SYSTICK_ENABLE;
|
||||
} else {
|
||||
systick_reload(s, 0);
|
||||
}
|
||||
}
|
||||
|
||||
static uint64_t systick_read(void *opaque, hwaddr addr, unsigned size)
|
||||
{
|
||||
SysTickState *s = opaque;
|
||||
uint32_t val;
|
||||
|
||||
switch (addr) {
|
||||
case 0x0: /* SysTick Control and Status. */
|
||||
val = s->control;
|
||||
s->control &= ~SYSTICK_COUNTFLAG;
|
||||
break;
|
||||
case 0x4: /* SysTick Reload Value. */
|
||||
val = s->reload;
|
||||
break;
|
||||
case 0x8: /* SysTick Current Value. */
|
||||
{
|
||||
int64_t t;
|
||||
|
||||
if ((s->control & SYSTICK_ENABLE) == 0) {
|
||||
val = 0;
|
||||
break;
|
||||
}
|
||||
t = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
||||
if (t >= s->tick) {
|
||||
val = 0;
|
||||
break;
|
||||
}
|
||||
val = ((s->tick - (t + 1)) / systick_scale(s)) + 1;
|
||||
/* The interrupt in triggered when the timer reaches zero.
|
||||
However the counter is not reloaded until the next clock
|
||||
tick. This is a hack to return zero during the first tick. */
|
||||
if (val > s->reload) {
|
||||
val = 0;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case 0xc: /* SysTick Calibration Value. */
|
||||
val = 10000;
|
||||
break;
|
||||
default:
|
||||
val = 0;
|
||||
qemu_log_mask(LOG_GUEST_ERROR,
|
||||
"SysTick: Bad read offset 0x%" HWADDR_PRIx "\n", addr);
|
||||
break;
|
||||
}
|
||||
|
||||
trace_systick_read(addr, val, size);
|
||||
return val;
|
||||
}
|
||||
|
||||
static void systick_write(void *opaque, hwaddr addr,
|
||||
uint64_t value, unsigned size)
|
||||
{
|
||||
SysTickState *s = opaque;
|
||||
|
||||
trace_systick_write(addr, value, size);
|
||||
|
||||
switch (addr) {
|
||||
case 0x0: /* SysTick Control and Status. */
|
||||
{
|
||||
uint32_t oldval = s->control;
|
||||
|
||||
s->control &= 0xfffffff8;
|
||||
s->control |= value & 7;
|
||||
if ((oldval ^ value) & SYSTICK_ENABLE) {
|
||||
int64_t now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
||||
if (value & SYSTICK_ENABLE) {
|
||||
if (s->tick) {
|
||||
s->tick += now;
|
||||
timer_mod(s->timer, s->tick);
|
||||
} else {
|
||||
systick_reload(s, 1);
|
||||
}
|
||||
} else {
|
||||
timer_del(s->timer);
|
||||
s->tick -= now;
|
||||
if (s->tick < 0) {
|
||||
s->tick = 0;
|
||||
}
|
||||
}
|
||||
} else if ((oldval ^ value) & SYSTICK_CLKSOURCE) {
|
||||
/* This is a hack. Force the timer to be reloaded
|
||||
when the reference clock is changed. */
|
||||
systick_reload(s, 1);
|
||||
}
|
||||
break;
|
||||
}
|
||||
case 0x4: /* SysTick Reload Value. */
|
||||
s->reload = value;
|
||||
break;
|
||||
case 0x8: /* SysTick Current Value. Writes reload the timer. */
|
||||
systick_reload(s, 1);
|
||||
s->control &= ~SYSTICK_COUNTFLAG;
|
||||
break;
|
||||
default:
|
||||
qemu_log_mask(LOG_GUEST_ERROR,
|
||||
"SysTick: Bad write offset 0x%" HWADDR_PRIx "\n", addr);
|
||||
}
|
||||
}
|
||||
|
||||
static const MemoryRegionOps systick_ops = {
|
||||
.read = systick_read,
|
||||
.write = systick_write,
|
||||
.endianness = DEVICE_NATIVE_ENDIAN,
|
||||
.valid.min_access_size = 4,
|
||||
.valid.max_access_size = 4,
|
||||
};
|
||||
|
||||
static void systick_reset(DeviceState *dev)
|
||||
{
|
||||
SysTickState *s = SYSTICK(dev);
|
||||
|
||||
s->control = 0;
|
||||
s->reload = 0;
|
||||
s->tick = 0;
|
||||
timer_del(s->timer);
|
||||
}
|
||||
|
||||
static void systick_instance_init(Object *obj)
|
||||
{
|
||||
SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
|
||||
SysTickState *s = SYSTICK(obj);
|
||||
|
||||
memory_region_init_io(&s->iomem, obj, &systick_ops, s, "systick", 0xe0);
|
||||
sysbus_init_mmio(sbd, &s->iomem);
|
||||
sysbus_init_irq(sbd, &s->irq);
|
||||
s->timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, systick_timer_tick, s);
|
||||
}
|
||||
|
||||
static const VMStateDescription vmstate_systick = {
|
||||
.name = "armv7m_systick",
|
||||
.version_id = 1,
|
||||
.minimum_version_id = 1,
|
||||
.fields = (VMStateField[]) {
|
||||
VMSTATE_UINT32(control, SysTickState),
|
||||
VMSTATE_UINT32(reload, SysTickState),
|
||||
VMSTATE_INT64(tick, SysTickState),
|
||||
VMSTATE_TIMER_PTR(timer, SysTickState),
|
||||
VMSTATE_END_OF_LIST()
|
||||
}
|
||||
};
|
||||
|
||||
static void systick_class_init(ObjectClass *klass, void *data)
|
||||
{
|
||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||
|
||||
dc->vmsd = &vmstate_systick;
|
||||
dc->reset = systick_reset;
|
||||
}
|
||||
|
||||
static const TypeInfo armv7m_systick_info = {
|
||||
.name = TYPE_SYSTICK,
|
||||
.parent = TYPE_SYS_BUS_DEVICE,
|
||||
.instance_init = systick_instance_init,
|
||||
.instance_size = sizeof(SysTickState),
|
||||
.class_init = systick_class_init,
|
||||
};
|
||||
|
||||
static void armv7m_systick_register_types(void)
|
||||
{
|
||||
type_register_static(&armv7m_systick_info);
|
||||
}
|
||||
|
||||
type_init(armv7m_systick_register_types)
|
||||
@@ -49,3 +49,9 @@ aspeed_timer_ctrl_pulse_enable(uint8_t i, bool enable) "Timer %" PRIu8 ": %d"
|
||||
aspeed_timer_set_ctrl2(uint32_t value) "Value: 0x%" PRIx32
|
||||
aspeed_timer_set_value(int timer, int reg, uint32_t value) "Timer %d register %d: 0x%" PRIx32
|
||||
aspeed_timer_read(uint64_t offset, unsigned size, uint64_t value) "From 0x%" PRIx64 ": of size %u: 0x%" PRIx64
|
||||
|
||||
# hw/timer/armv7m_systick.c
|
||||
systick_reload(void) "systick reload"
|
||||
systick_timer_tick(void) "systick reload"
|
||||
systick_read(uint64_t addr, uint32_t value, unsigned size) "systick read addr 0x%" PRIx64 " data 0x%" PRIx32 " size %u"
|
||||
systick_write(uint64_t addr, uint32_t value, unsigned size) "systick write addr 0x%" PRIx64 " data 0x%" PRIx32 " size %u"
|
||||
|
||||
@@ -26,6 +26,18 @@ typedef enum {
|
||||
/* armv7m.c */
|
||||
DeviceState *armv7m_init(MemoryRegion *system_memory, int mem_size, int num_irq,
|
||||
const char *kernel_filename, const char *cpu_model);
|
||||
/**
|
||||
* armv7m_load_kernel:
|
||||
* @cpu: CPU
|
||||
* @kernel_filename: file to load
|
||||
* @mem_size: mem_size: maximum image size to load
|
||||
*
|
||||
* Load the guest image for an ARMv7M system. This must be called by
|
||||
* any ARMv7M board, either directly or via armv7m_init(). (This is
|
||||
* necessary to ensure that the CPU resets correctly on system reset,
|
||||
* as well as for kernel loading.)
|
||||
*/
|
||||
void armv7m_load_kernel(ARMCPU *cpu, const char *kernel_filename, int mem_size);
|
||||
|
||||
/*
|
||||
* struct used as a parameter of the arm_load_kernel machine init
|
||||
|
||||
@@ -0,0 +1,63 @@
|
||||
/*
|
||||
* ARMv7M CPU object
|
||||
*
|
||||
* Copyright (c) 2017 Linaro Ltd
|
||||
* Written by Peter Maydell <peter.maydell@linaro.org>
|
||||
*
|
||||
* This code is licensed under the GPL version 2 or later.
|
||||
*/
|
||||
|
||||
#ifndef HW_ARM_ARMV7M_H
|
||||
#define HW_ARM_ARMV7M_H
|
||||
|
||||
#include "hw/sysbus.h"
|
||||
#include "hw/arm/armv7m_nvic.h"
|
||||
|
||||
#define TYPE_BITBAND "ARM,bitband-memory"
|
||||
#define BITBAND(obj) OBJECT_CHECK(BitBandState, (obj), TYPE_BITBAND)
|
||||
|
||||
typedef struct {
|
||||
/*< private >*/
|
||||
SysBusDevice parent_obj;
|
||||
/*< public >*/
|
||||
|
||||
AddressSpace *source_as;
|
||||
MemoryRegion iomem;
|
||||
uint32_t base;
|
||||
MemoryRegion *source_memory;
|
||||
} BitBandState;
|
||||
|
||||
#define TYPE_ARMV7M "armv7m"
|
||||
#define ARMV7M(obj) OBJECT_CHECK(ARMv7MState, (obj), TYPE_ARMV7M)
|
||||
|
||||
#define ARMV7M_NUM_BITBANDS 2
|
||||
|
||||
/* ARMv7M container object.
|
||||
* + Unnamed GPIO input lines: external IRQ lines for the NVIC
|
||||
* + Named GPIO output SYSRESETREQ: signalled for guest AIRCR.SYSRESETREQ
|
||||
* + Property "cpu-model": CPU model to instantiate
|
||||
* + Property "num-irq": number of external IRQ lines
|
||||
* + Property "memory": MemoryRegion defining the physical address space
|
||||
* that CPU accesses see. (The NVIC, bitbanding and other CPU-internal
|
||||
* devices will be automatically layered on top of this view.)
|
||||
*/
|
||||
typedef struct ARMv7MState {
|
||||
/*< private >*/
|
||||
SysBusDevice parent_obj;
|
||||
/*< public >*/
|
||||
NVICState nvic;
|
||||
BitBandState bitband[ARMV7M_NUM_BITBANDS];
|
||||
ARMCPU *cpu;
|
||||
|
||||
/* MemoryRegion we pass to the CPU, with our devices layered on
|
||||
* top of the ones the board provides in board_memory.
|
||||
*/
|
||||
MemoryRegion container;
|
||||
|
||||
/* Properties */
|
||||
char *cpu_model;
|
||||
/* MemoryRegion the board provides to us (with its devices, RAM, etc) */
|
||||
MemoryRegion *board_memory;
|
||||
} ARMv7MState;
|
||||
|
||||
#endif
|
||||
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user