Peter Maydell <peter.mayd...@linaro.org> writes: > Instantiate and wire up the Memory Protection Controllers > in the MPS2 board itself. > > Signed-off-by: Peter Maydell <peter.mayd...@linaro.org>
Reviewed-by: Alex Bennée <alex.ben...@linaro.org> > --- > hw/arm/mps2-tz.c | 71 ++++++++++++++++++++++++++++++------------------ > 1 file changed, 44 insertions(+), 27 deletions(-) > > diff --git a/hw/arm/mps2-tz.c b/hw/arm/mps2-tz.c > index 8dc8bfd4ab..a58b5dea79 100644 > --- a/hw/arm/mps2-tz.c > +++ b/hw/arm/mps2-tz.c > @@ -44,6 +44,7 @@ > #include "hw/timer/cmsdk-apb-timer.h" > #include "hw/misc/mps2-scc.h" > #include "hw/misc/mps2-fpgaio.h" > +#include "hw/misc/tz-mpc.h" > #include "hw/arm/iotkit.h" > #include "hw/devices.h" > #include "net/net.h" > @@ -64,13 +65,12 @@ typedef struct { > > IoTKit iotkit; > MemoryRegion psram; > - MemoryRegion ssram1; > + MemoryRegion ssram[3]; > MemoryRegion ssram1_m; > - MemoryRegion ssram23; > MPS2SCC scc; > MPS2FPGAIO fpgaio; > TZPPC ppc[5]; > - UnimplementedDeviceState ssram_mpc[3]; > + TZMPC ssram_mpc[3]; > UnimplementedDeviceState spi[5]; > UnimplementedDeviceState i2c[4]; > UnimplementedDeviceState i2s_audio; > @@ -95,16 +95,6 @@ typedef struct { > /* Main SYSCLK frequency in Hz */ > #define SYSCLK_FRQ 20000000 > > -/* Initialize the auxiliary RAM region @mr and map it into > - * the memory map at @base. > - */ > -static void make_ram(MemoryRegion *mr, const char *name, > - hwaddr base, hwaddr size) > -{ > - memory_region_init_ram(mr, NULL, name, size, &error_fatal); > - memory_region_add_subregion(get_system_memory(), base, mr); > -} > - > /* Create an alias of an entire original MemoryRegion @orig > * located at @base in the memory map. > */ > @@ -224,6 +214,44 @@ static MemoryRegion *make_fpgaio(MPS2TZMachineState > *mms, void *opaque, > return sysbus_mmio_get_region(SYS_BUS_DEVICE(fpgaio), 0); > } > > +static MemoryRegion *make_mpc(MPS2TZMachineState *mms, void *opaque, > + const char *name, hwaddr size) > +{ > + TZMPC *mpc = opaque; > + int i = mpc - &mms->ssram_mpc[0]; > + MemoryRegion *ssram = &mms->ssram[i]; > + MemoryRegion *upstream; > + char *mpcname = g_strdup_printf("%s-mpc", name); > + static uint32_t ramsize[] = { 0x00400000, 0x00200000, 0x00200000 }; > + static uint32_t rambase[] = { 0x00000000, 0x28000000, 0x28200000 }; > + > + memory_region_init_ram(ssram, NULL, name, ramsize[i], &error_fatal); > + > + init_sysbus_child(OBJECT(mms), mpcname, mpc, > + sizeof(mms->ssram_mpc[0]), TYPE_TZ_MPC); > + object_property_set_link(OBJECT(mpc), OBJECT(ssram), > + "downstream", &error_fatal); > + object_property_set_bool(OBJECT(mpc), true, "realized", &error_fatal); > + /* Map the upstream end of the MPC into system memory */ > + upstream = sysbus_mmio_get_region(SYS_BUS_DEVICE(mpc), 1); > + memory_region_add_subregion(get_system_memory(), rambase[i], upstream); > + /* and connect its interrupt to the IoTKit */ > + qdev_connect_gpio_out_named(DEVICE(mpc), "irq", 0, > + qdev_get_gpio_in_named(DEVICE(&mms->iotkit), > + "mpcexp_status", i)); > + > + /* The first SSRAM is a special case as it has an alias; accesses to > + * the alias region at 0x00400000 must also go to the MPC upstream. > + */ > + if (i == 0) { > + make_ram_alias(&mms->ssram1_m, "mps.ssram1_m", upstream, 0x00400000); > + } > + > + g_free(mpcname); > + /* Return the register interface MR for our caller to map behind the PPC > */ > + return sysbus_mmio_get_region(SYS_BUS_DEVICE(mpc), 0); > +} > + > static void mps2tz_common_init(MachineState *machine) > { > MPS2TZMachineState *mms = MPS2TZ_MACHINE(machine); > @@ -285,14 +313,6 @@ static void mps2tz_common_init(MachineState *machine) > NULL, "mps.ram", 0x01000000); > memory_region_add_subregion(system_memory, 0x80000000, &mms->psram); > > - /* The SSRAM memories should all be behind Memory Protection Controllers, > - * but we don't implement that yet. > - */ > - make_ram(&mms->ssram1, "mps.ssram1", 0x00000000, 0x00400000); > - make_ram_alias(&mms->ssram1_m, "mps.ssram1_m", &mms->ssram1, 0x00400000); > - > - make_ram(&mms->ssram23, "mps.ssram23", 0x28000000, 0x00400000); > - > /* The overflow IRQs for all UARTs are ORed together. > * Tx, Rx and "combined" IRQs are sent to the NVIC separately. > * Create the OR gate for this. > @@ -322,12 +342,9 @@ static void mps2tz_common_init(MachineState *machine) > const PPCInfo ppcs[] = { { > .name = "apb_ppcexp0", > .ports = { > - { "ssram-mpc0", make_unimp_dev, &mms->ssram_mpc[0], > - 0x58007000, 0x1000 }, > - { "ssram-mpc1", make_unimp_dev, &mms->ssram_mpc[1], > - 0x58008000, 0x1000 }, > - { "ssram-mpc2", make_unimp_dev, &mms->ssram_mpc[2], > - 0x58009000, 0x1000 }, > + { "ssram-0", make_mpc, &mms->ssram_mpc[0], 0x58007000, > 0x1000 }, > + { "ssram-1", make_mpc, &mms->ssram_mpc[1], 0x58008000, > 0x1000 }, > + { "ssram-2", make_mpc, &mms->ssram_mpc[2], 0x58009000, > 0x1000 }, > }, > }, { > .name = "apb_ppcexp1", -- Alex Bennée