mirror of
				https://github.com/qemu/qemu.git
				synced 2025-10-26 03:33:28 +00:00 
			
		
		
		
	 668f62ec62
			
		
	
	
		668f62ec62
		
	
	
	
	
		
			
			When all we do with an Error we receive into a local variable is
propagating to somewhere else, we can just as well receive it there
right away.  Convert
    if (!foo(..., &err)) {
        ...
        error_propagate(errp, err);
        ...
        return ...
    }
to
    if (!foo(..., errp)) {
        ...
        ...
        return ...
    }
where nothing else needs @err.  Coccinelle script:
    @rule1 forall@
    identifier fun, err, errp, lbl;
    expression list args, args2;
    binary operator op;
    constant c1, c2;
    symbol false;
    @@
         if (
    (
    -        fun(args, &err, args2)
    +        fun(args, errp, args2)
    |
    -        !fun(args, &err, args2)
    +        !fun(args, errp, args2)
    |
    -        fun(args, &err, args2) op c1
    +        fun(args, errp, args2) op c1
    )
            )
         {
             ... when != err
                 when != lbl:
                 when strict
    -        error_propagate(errp, err);
             ... when != err
    (
             return;
    |
             return c2;
    |
             return false;
    )
         }
    @rule2 forall@
    identifier fun, err, errp, lbl;
    expression list args, args2;
    expression var;
    binary operator op;
    constant c1, c2;
    symbol false;
    @@
    -    var = fun(args, &err, args2);
    +    var = fun(args, errp, args2);
         ... when != err
         if (
    (
             var
    |
             !var
    |
             var op c1
    )
            )
         {
             ... when != err
                 when != lbl:
                 when strict
    -        error_propagate(errp, err);
             ... when != err
    (
             return;
    |
             return c2;
    |
             return false;
    |
             return var;
    )
         }
    @depends on rule1 || rule2@
    identifier err;
    @@
    -    Error *err = NULL;
         ... when != err
Not exactly elegant, I'm afraid.
The "when != lbl:" is necessary to avoid transforming
         if (fun(args, &err)) {
             goto out
         }
         ...
     out:
         error_propagate(errp, err);
even though other paths to label out still need the error_propagate().
For an actual example, see sclp_realize().
Without the "when strict", Coccinelle transforms vfio_msix_setup(),
incorrectly.  I don't know what exactly "when strict" does, only that
it helps here.
The match of return is narrower than what I want, but I can't figure
out how to express "return where the operand doesn't use @err".  For
an example where it's too narrow, see vfio_intx_enable().
Silently fails to convert hw/arm/armsse.c, because Coccinelle gets
confused by ARMSSE being used both as typedef and function-like macro
there.  Converted manually.
Line breaks tidied up manually.  One nested declaration of @local_err
deleted manually.  Preexisting unwanted blank line dropped in
hw/riscv/sifive_e.c.
Signed-off-by: Markus Armbruster <armbru@redhat.com>
Reviewed-by: Eric Blake <eblake@redhat.com>
Message-Id: <20200707160613.848843-35-armbru@redhat.com>
		
	
			
		
			
				
	
	
		
			1187 lines
		
	
	
		
			45 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1187 lines
		
	
	
		
			45 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Arm SSE (Subsystems for Embedded): IoTKit
 | |
|  *
 | |
|  * Copyright (c) 2018 Linaro Limited
 | |
|  * Written by Peter Maydell
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License version 2 or
 | |
|  * (at your option) any later version.
 | |
|  */
 | |
| 
 | |
| #include "qemu/osdep.h"
 | |
| #include "qemu/log.h"
 | |
| #include "qemu/module.h"
 | |
| #include "qemu/bitops.h"
 | |
| #include "qapi/error.h"
 | |
| #include "trace.h"
 | |
| #include "hw/sysbus.h"
 | |
| #include "migration/vmstate.h"
 | |
| #include "hw/registerfields.h"
 | |
| #include "hw/arm/armsse.h"
 | |
| #include "hw/arm/boot.h"
 | |
| #include "hw/irq.h"
 | |
| 
 | |
| /* Format of the System Information block SYS_CONFIG register */
 | |
| typedef enum SysConfigFormat {
 | |
|     IoTKitFormat,
 | |
|     SSE200Format,
 | |
| } SysConfigFormat;
 | |
| 
 | |
| struct ARMSSEInfo {
 | |
|     const char *name;
 | |
|     int sram_banks;
 | |
|     int num_cpus;
 | |
|     uint32_t sys_version;
 | |
|     uint32_t cpuwait_rst;
 | |
|     SysConfigFormat sys_config_format;
 | |
|     bool has_mhus;
 | |
|     bool has_ppus;
 | |
|     bool has_cachectrl;
 | |
|     bool has_cpusecctrl;
 | |
|     bool has_cpuid;
 | |
|     Property *props;
 | |
| };
 | |
| 
 | |
| static Property iotkit_properties[] = {
 | |
|     DEFINE_PROP_LINK("memory", ARMSSE, board_memory, TYPE_MEMORY_REGION,
 | |
|                      MemoryRegion *),
 | |
|     DEFINE_PROP_UINT32("EXP_NUMIRQ", ARMSSE, exp_numirq, 64),
 | |
|     DEFINE_PROP_UINT32("MAINCLK", ARMSSE, mainclk_frq, 0),
 | |
|     DEFINE_PROP_UINT32("SRAM_ADDR_WIDTH", ARMSSE, sram_addr_width, 15),
 | |
|     DEFINE_PROP_UINT32("init-svtor", ARMSSE, init_svtor, 0x10000000),
 | |
|     DEFINE_PROP_BOOL("CPU0_FPU", ARMSSE, cpu_fpu[0], true),
 | |
|     DEFINE_PROP_BOOL("CPU0_DSP", ARMSSE, cpu_dsp[0], true),
 | |
|     DEFINE_PROP_END_OF_LIST()
 | |
| };
 | |
| 
 | |
| static Property armsse_properties[] = {
 | |
|     DEFINE_PROP_LINK("memory", ARMSSE, board_memory, TYPE_MEMORY_REGION,
 | |
|                      MemoryRegion *),
 | |
|     DEFINE_PROP_UINT32("EXP_NUMIRQ", ARMSSE, exp_numirq, 64),
 | |
|     DEFINE_PROP_UINT32("MAINCLK", ARMSSE, mainclk_frq, 0),
 | |
|     DEFINE_PROP_UINT32("SRAM_ADDR_WIDTH", ARMSSE, sram_addr_width, 15),
 | |
|     DEFINE_PROP_UINT32("init-svtor", ARMSSE, init_svtor, 0x10000000),
 | |
|     DEFINE_PROP_BOOL("CPU0_FPU", ARMSSE, cpu_fpu[0], false),
 | |
|     DEFINE_PROP_BOOL("CPU0_DSP", ARMSSE, cpu_dsp[0], false),
 | |
|     DEFINE_PROP_BOOL("CPU1_FPU", ARMSSE, cpu_fpu[1], true),
 | |
|     DEFINE_PROP_BOOL("CPU1_DSP", ARMSSE, cpu_dsp[1], true),
 | |
|     DEFINE_PROP_END_OF_LIST()
 | |
| };
 | |
| 
 | |
| static const ARMSSEInfo armsse_variants[] = {
 | |
|     {
 | |
|         .name = TYPE_IOTKIT,
 | |
|         .sram_banks = 1,
 | |
|         .num_cpus = 1,
 | |
|         .sys_version = 0x41743,
 | |
|         .cpuwait_rst = 0,
 | |
|         .sys_config_format = IoTKitFormat,
 | |
|         .has_mhus = false,
 | |
|         .has_ppus = false,
 | |
|         .has_cachectrl = false,
 | |
|         .has_cpusecctrl = false,
 | |
|         .has_cpuid = false,
 | |
|         .props = iotkit_properties,
 | |
|     },
 | |
|     {
 | |
|         .name = TYPE_SSE200,
 | |
|         .sram_banks = 4,
 | |
|         .num_cpus = 2,
 | |
|         .sys_version = 0x22041743,
 | |
|         .cpuwait_rst = 2,
 | |
|         .sys_config_format = SSE200Format,
 | |
|         .has_mhus = true,
 | |
|         .has_ppus = true,
 | |
|         .has_cachectrl = true,
 | |
|         .has_cpusecctrl = true,
 | |
|         .has_cpuid = true,
 | |
|         .props = armsse_properties,
 | |
|     },
 | |
| };
 | |
| 
 | |
| static uint32_t armsse_sys_config_value(ARMSSE *s, const ARMSSEInfo *info)
 | |
| {
 | |
|     /* Return the SYS_CONFIG value for this SSE */
 | |
|     uint32_t sys_config;
 | |
| 
 | |
|     switch (info->sys_config_format) {
 | |
|     case IoTKitFormat:
 | |
|         sys_config = 0;
 | |
|         sys_config = deposit32(sys_config, 0, 4, info->sram_banks);
 | |
|         sys_config = deposit32(sys_config, 4, 4, s->sram_addr_width - 12);
 | |
|         break;
 | |
|     case SSE200Format:
 | |
|         sys_config = 0;
 | |
|         sys_config = deposit32(sys_config, 0, 4, info->sram_banks);
 | |
|         sys_config = deposit32(sys_config, 4, 5, s->sram_addr_width);
 | |
|         sys_config = deposit32(sys_config, 24, 4, 2);
 | |
|         if (info->num_cpus > 1) {
 | |
|             sys_config = deposit32(sys_config, 10, 1, 1);
 | |
|             sys_config = deposit32(sys_config, 20, 4, info->sram_banks - 1);
 | |
|             sys_config = deposit32(sys_config, 28, 4, 2);
 | |
|         }
 | |
|         break;
 | |
|     default:
 | |
|         g_assert_not_reached();
 | |
|     }
 | |
|     return sys_config;
 | |
| }
 | |
| 
 | |
| /* Clock frequency in HZ of the 32KHz "slow clock" */
 | |
| #define S32KCLK (32 * 1000)
 | |
| 
 | |
| /* Is internal IRQ n shared between CPUs in a multi-core SSE ? */
 | |
| static bool irq_is_common[32] = {
 | |
|     [0 ... 5] = true,
 | |
|     /* 6, 7: per-CPU MHU interrupts */
 | |
|     [8 ... 12] = true,
 | |
|     /* 13: per-CPU icache interrupt */
 | |
|     /* 14: reserved */
 | |
|     [15 ... 20] = true,
 | |
|     /* 21: reserved */
 | |
|     [22 ... 26] = true,
 | |
|     /* 27: reserved */
 | |
|     /* 28, 29: per-CPU CTI interrupts */
 | |
|     /* 30, 31: reserved */
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * Create an alias region in @container of @size bytes starting at @base
 | |
|  * which mirrors the memory starting at @orig.
 | |
|  */
 | |
| static void make_alias(ARMSSE *s, MemoryRegion *mr, MemoryRegion *container,
 | |
|                        const char *name, hwaddr base, hwaddr size, hwaddr orig)
 | |
| {
 | |
|     memory_region_init_alias(mr, NULL, name, container, orig, size);
 | |
|     /* The alias is even lower priority than unimplemented_device regions */
 | |
|     memory_region_add_subregion_overlap(container, base, mr, -1500);
 | |
| }
 | |
| 
 | |
| static void irq_status_forwarder(void *opaque, int n, int level)
 | |
| {
 | |
|     qemu_irq destirq = opaque;
 | |
| 
 | |
|     qemu_set_irq(destirq, level);
 | |
| }
 | |
| 
 | |
| static void nsccfg_handler(void *opaque, int n, int level)
 | |
| {
 | |
|     ARMSSE *s = ARMSSE(opaque);
 | |
| 
 | |
|     s->nsccfg = level;
 | |
| }
 | |
| 
 | |
| static void armsse_forward_ppc(ARMSSE *s, const char *ppcname, int ppcnum)
 | |
| {
 | |
|     /* Each of the 4 AHB and 4 APB PPCs that might be present in a
 | |
|      * system using the ARMSSE has a collection of control lines which
 | |
|      * are provided by the security controller and which we want to
 | |
|      * expose as control lines on the ARMSSE device itself, so the
 | |
|      * code using the ARMSSE can wire them up to the PPCs.
 | |
|      */
 | |
|     SplitIRQ *splitter = &s->ppc_irq_splitter[ppcnum];
 | |
|     DeviceState *armssedev = DEVICE(s);
 | |
|     DeviceState *dev_secctl = DEVICE(&s->secctl);
 | |
|     DeviceState *dev_splitter = DEVICE(splitter);
 | |
|     char *name;
 | |
| 
 | |
|     name = g_strdup_printf("%s_nonsec", ppcname);
 | |
|     qdev_pass_gpios(dev_secctl, armssedev, name);
 | |
|     g_free(name);
 | |
|     name = g_strdup_printf("%s_ap", ppcname);
 | |
|     qdev_pass_gpios(dev_secctl, armssedev, name);
 | |
|     g_free(name);
 | |
|     name = g_strdup_printf("%s_irq_enable", ppcname);
 | |
|     qdev_pass_gpios(dev_secctl, armssedev, name);
 | |
|     g_free(name);
 | |
|     name = g_strdup_printf("%s_irq_clear", ppcname);
 | |
|     qdev_pass_gpios(dev_secctl, armssedev, name);
 | |
|     g_free(name);
 | |
| 
 | |
|     /* irq_status is a little more tricky, because we need to
 | |
|      * split it so we can send it both to the security controller
 | |
|      * and to our OR gate for the NVIC interrupt line.
 | |
|      * Connect up the splitter's outputs, and create a GPIO input
 | |
|      * which will pass the line state to the input splitter.
 | |
|      */
 | |
|     name = g_strdup_printf("%s_irq_status", ppcname);
 | |
|     qdev_connect_gpio_out(dev_splitter, 0,
 | |
|                           qdev_get_gpio_in_named(dev_secctl,
 | |
|                                                  name, 0));
 | |
|     qdev_connect_gpio_out(dev_splitter, 1,
 | |
|                           qdev_get_gpio_in(DEVICE(&s->ppc_irq_orgate), ppcnum));
 | |
|     s->irq_status_in[ppcnum] = qdev_get_gpio_in(dev_splitter, 0);
 | |
|     qdev_init_gpio_in_named_with_opaque(armssedev, irq_status_forwarder,
 | |
|                                         s->irq_status_in[ppcnum], name, 1);
 | |
|     g_free(name);
 | |
| }
 | |
| 
 | |
| static void armsse_forward_sec_resp_cfg(ARMSSE *s)
 | |
| {
 | |
|     /* Forward the 3rd output from the splitter device as a
 | |
|      * named GPIO output of the armsse object.
 | |
|      */
 | |
|     DeviceState *dev = DEVICE(s);
 | |
|     DeviceState *dev_splitter = DEVICE(&s->sec_resp_splitter);
 | |
| 
 | |
|     qdev_init_gpio_out_named(dev, &s->sec_resp_cfg, "sec_resp_cfg", 1);
 | |
|     s->sec_resp_cfg_in = qemu_allocate_irq(irq_status_forwarder,
 | |
|                                            s->sec_resp_cfg, 1);
 | |
|     qdev_connect_gpio_out(dev_splitter, 2, s->sec_resp_cfg_in);
 | |
| }
 | |
| 
 | |
| static void armsse_init(Object *obj)
 | |
| {
 | |
|     ARMSSE *s = ARMSSE(obj);
 | |
|     ARMSSEClass *asc = ARMSSE_GET_CLASS(obj);
 | |
|     const ARMSSEInfo *info = asc->info;
 | |
|     int i;
 | |
| 
 | |
|     assert(info->sram_banks <= MAX_SRAM_BANKS);
 | |
|     assert(info->num_cpus <= SSE_MAX_CPUS);
 | |
| 
 | |
|     memory_region_init(&s->container, obj, "armsse-container", UINT64_MAX);
 | |
| 
 | |
|     for (i = 0; i < info->num_cpus; i++) {
 | |
|         /*
 | |
|          * We put each CPU in its own cluster as they are logically
 | |
|          * distinct and may be configured differently.
 | |
|          */
 | |
|         char *name;
 | |
| 
 | |
|         name = g_strdup_printf("cluster%d", i);
 | |
|         object_initialize_child(obj, name, &s->cluster[i], TYPE_CPU_CLUSTER);
 | |
|         qdev_prop_set_uint32(DEVICE(&s->cluster[i]), "cluster-id", i);
 | |
|         g_free(name);
 | |
| 
 | |
|         name = g_strdup_printf("armv7m%d", i);
 | |
|         object_initialize_child(OBJECT(&s->cluster[i]), name, &s->armv7m[i],
 | |
|                                 TYPE_ARMV7M);
 | |
|         qdev_prop_set_string(DEVICE(&s->armv7m[i]), "cpu-type",
 | |
|                              ARM_CPU_TYPE_NAME("cortex-m33"));
 | |
|         g_free(name);
 | |
|         name = g_strdup_printf("arm-sse-cpu-container%d", i);
 | |
|         memory_region_init(&s->cpu_container[i], obj, name, UINT64_MAX);
 | |
|         g_free(name);
 | |
|         if (i > 0) {
 | |
|             name = g_strdup_printf("arm-sse-container-alias%d", i);
 | |
|             memory_region_init_alias(&s->container_alias[i - 1], obj,
 | |
|                                      name, &s->container, 0, UINT64_MAX);
 | |
|             g_free(name);
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     object_initialize_child(obj, "secctl", &s->secctl, TYPE_IOTKIT_SECCTL);
 | |
|     object_initialize_child(obj, "apb-ppc0", &s->apb_ppc0, TYPE_TZ_PPC);
 | |
|     object_initialize_child(obj, "apb-ppc1", &s->apb_ppc1, TYPE_TZ_PPC);
 | |
|     for (i = 0; i < info->sram_banks; i++) {
 | |
|         char *name = g_strdup_printf("mpc%d", i);
 | |
|         object_initialize_child(obj, name, &s->mpc[i], TYPE_TZ_MPC);
 | |
|         g_free(name);
 | |
|     }
 | |
|     object_initialize_child(obj, "mpc-irq-orgate", &s->mpc_irq_orgate,
 | |
|                             TYPE_OR_IRQ);
 | |
| 
 | |
|     for (i = 0; i < IOTS_NUM_EXP_MPC + info->sram_banks; i++) {
 | |
|         char *name = g_strdup_printf("mpc-irq-splitter-%d", i);
 | |
|         SplitIRQ *splitter = &s->mpc_irq_splitter[i];
 | |
| 
 | |
|         object_initialize_child(obj, name, splitter, TYPE_SPLIT_IRQ);
 | |
|         g_free(name);
 | |
|     }
 | |
|     object_initialize_child(obj, "timer0", &s->timer0, TYPE_CMSDK_APB_TIMER);
 | |
|     object_initialize_child(obj, "timer1", &s->timer1, TYPE_CMSDK_APB_TIMER);
 | |
|     object_initialize_child(obj, "s32ktimer", &s->s32ktimer,
 | |
|                             TYPE_CMSDK_APB_TIMER);
 | |
|     object_initialize_child(obj, "dualtimer", &s->dualtimer,
 | |
|                             TYPE_CMSDK_APB_DUALTIMER);
 | |
|     object_initialize_child(obj, "s32kwatchdog", &s->s32kwatchdog,
 | |
|                             TYPE_CMSDK_APB_WATCHDOG);
 | |
|     object_initialize_child(obj, "nswatchdog", &s->nswatchdog,
 | |
|                             TYPE_CMSDK_APB_WATCHDOG);
 | |
|     object_initialize_child(obj, "swatchdog", &s->swatchdog,
 | |
|                             TYPE_CMSDK_APB_WATCHDOG);
 | |
|     object_initialize_child(obj, "armsse-sysctl", &s->sysctl,
 | |
|                             TYPE_IOTKIT_SYSCTL);
 | |
|     object_initialize_child(obj, "armsse-sysinfo", &s->sysinfo,
 | |
|                             TYPE_IOTKIT_SYSINFO);
 | |
|     if (info->has_mhus) {
 | |
|         object_initialize_child(obj, "mhu0", &s->mhu[0], TYPE_ARMSSE_MHU);
 | |
|         object_initialize_child(obj, "mhu1", &s->mhu[1], TYPE_ARMSSE_MHU);
 | |
|     }
 | |
|     if (info->has_ppus) {
 | |
|         for (i = 0; i < info->num_cpus; i++) {
 | |
|             char *name = g_strdup_printf("CPU%dCORE_PPU", i);
 | |
|             int ppuidx = CPU0CORE_PPU + i;
 | |
| 
 | |
|             object_initialize_child(obj, name, &s->ppu[ppuidx],
 | |
|                                     TYPE_UNIMPLEMENTED_DEVICE);
 | |
|             g_free(name);
 | |
|         }
 | |
|         object_initialize_child(obj, "DBG_PPU", &s->ppu[DBG_PPU],
 | |
|                                 TYPE_UNIMPLEMENTED_DEVICE);
 | |
|         for (i = 0; i < info->sram_banks; i++) {
 | |
|             char *name = g_strdup_printf("RAM%d_PPU", i);
 | |
|             int ppuidx = RAM0_PPU + i;
 | |
| 
 | |
|             object_initialize_child(obj, name, &s->ppu[ppuidx],
 | |
|                                     TYPE_UNIMPLEMENTED_DEVICE);
 | |
|             g_free(name);
 | |
|         }
 | |
|     }
 | |
|     if (info->has_cachectrl) {
 | |
|         for (i = 0; i < info->num_cpus; i++) {
 | |
|             char *name = g_strdup_printf("cachectrl%d", i);
 | |
| 
 | |
|             object_initialize_child(obj, name, &s->cachectrl[i],
 | |
|                                     TYPE_UNIMPLEMENTED_DEVICE);
 | |
|             g_free(name);
 | |
|         }
 | |
|     }
 | |
|     if (info->has_cpusecctrl) {
 | |
|         for (i = 0; i < info->num_cpus; i++) {
 | |
|             char *name = g_strdup_printf("cpusecctrl%d", i);
 | |
| 
 | |
|             object_initialize_child(obj, name, &s->cpusecctrl[i],
 | |
|                                     TYPE_UNIMPLEMENTED_DEVICE);
 | |
|             g_free(name);
 | |
|         }
 | |
|     }
 | |
|     if (info->has_cpuid) {
 | |
|         for (i = 0; i < info->num_cpus; i++) {
 | |
|             char *name = g_strdup_printf("cpuid%d", i);
 | |
| 
 | |
|             object_initialize_child(obj, name, &s->cpuid[i],
 | |
|                                     TYPE_ARMSSE_CPUID);
 | |
|             g_free(name);
 | |
|         }
 | |
|     }
 | |
|     object_initialize_child(obj, "nmi-orgate", &s->nmi_orgate, TYPE_OR_IRQ);
 | |
|     object_initialize_child(obj, "ppc-irq-orgate", &s->ppc_irq_orgate,
 | |
|                             TYPE_OR_IRQ);
 | |
|     object_initialize_child(obj, "sec-resp-splitter", &s->sec_resp_splitter,
 | |
|                             TYPE_SPLIT_IRQ);
 | |
|     for (i = 0; i < ARRAY_SIZE(s->ppc_irq_splitter); i++) {
 | |
|         char *name = g_strdup_printf("ppc-irq-splitter-%d", i);
 | |
|         SplitIRQ *splitter = &s->ppc_irq_splitter[i];
 | |
| 
 | |
|         object_initialize_child(obj, name, splitter, TYPE_SPLIT_IRQ);
 | |
|         g_free(name);
 | |
|     }
 | |
|     if (info->num_cpus > 1) {
 | |
|         for (i = 0; i < ARRAY_SIZE(s->cpu_irq_splitter); i++) {
 | |
|             if (irq_is_common[i]) {
 | |
|                 char *name = g_strdup_printf("cpu-irq-splitter%d", i);
 | |
|                 SplitIRQ *splitter = &s->cpu_irq_splitter[i];
 | |
| 
 | |
|                 object_initialize_child(obj, name, splitter, TYPE_SPLIT_IRQ);
 | |
|                 g_free(name);
 | |
|             }
 | |
|         }
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void armsse_exp_irq(void *opaque, int n, int level)
 | |
| {
 | |
|     qemu_irq *irqarray = opaque;
 | |
| 
 | |
|     qemu_set_irq(irqarray[n], level);
 | |
| }
 | |
| 
 | |
| static void armsse_mpcexp_status(void *opaque, int n, int level)
 | |
| {
 | |
|     ARMSSE *s = ARMSSE(opaque);
 | |
|     qemu_set_irq(s->mpcexp_status_in[n], level);
 | |
| }
 | |
| 
 | |
| static qemu_irq armsse_get_common_irq_in(ARMSSE *s, int irqno)
 | |
| {
 | |
|     /*
 | |
|      * Return a qemu_irq which can be used to signal IRQ n to
 | |
|      * all CPUs in the SSE.
 | |
|      */
 | |
|     ARMSSEClass *asc = ARMSSE_GET_CLASS(s);
 | |
|     const ARMSSEInfo *info = asc->info;
 | |
| 
 | |
|     assert(irq_is_common[irqno]);
 | |
| 
 | |
|     if (info->num_cpus == 1) {
 | |
|         /* Only one CPU -- just connect directly to it */
 | |
|         return qdev_get_gpio_in(DEVICE(&s->armv7m[0]), irqno);
 | |
|     } else {
 | |
|         /* Connect to the splitter which feeds all CPUs */
 | |
|         return qdev_get_gpio_in(DEVICE(&s->cpu_irq_splitter[irqno]), 0);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void map_ppu(ARMSSE *s, int ppuidx, const char *name, hwaddr addr)
 | |
| {
 | |
|     /* Map a PPU unimplemented device stub */
 | |
|     DeviceState *dev = DEVICE(&s->ppu[ppuidx]);
 | |
| 
 | |
|     qdev_prop_set_string(dev, "name", name);
 | |
|     qdev_prop_set_uint64(dev, "size", 0x1000);
 | |
|     sysbus_realize(SYS_BUS_DEVICE(dev), &error_fatal);
 | |
|     sysbus_mmio_map(SYS_BUS_DEVICE(&s->ppu[ppuidx]), 0, addr);
 | |
| }
 | |
| 
 | |
| static void armsse_realize(DeviceState *dev, Error **errp)
 | |
| {
 | |
|     ARMSSE *s = ARMSSE(dev);
 | |
|     ARMSSEClass *asc = ARMSSE_GET_CLASS(dev);
 | |
|     const ARMSSEInfo *info = asc->info;
 | |
|     int i;
 | |
|     MemoryRegion *mr;
 | |
|     Error *err = NULL;
 | |
|     SysBusDevice *sbd_apb_ppc0;
 | |
|     SysBusDevice *sbd_secctl;
 | |
|     DeviceState *dev_apb_ppc0;
 | |
|     DeviceState *dev_apb_ppc1;
 | |
|     DeviceState *dev_secctl;
 | |
|     DeviceState *dev_splitter;
 | |
|     uint32_t addr_width_max;
 | |
| 
 | |
|     if (!s->board_memory) {
 | |
|         error_setg(errp, "memory property was not set");
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     if (!s->mainclk_frq) {
 | |
|         error_setg(errp, "MAINCLK property was not set");
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     /* max SRAM_ADDR_WIDTH: 24 - log2(SRAM_NUM_BANK) */
 | |
|     assert(is_power_of_2(info->sram_banks));
 | |
|     addr_width_max = 24 - ctz32(info->sram_banks);
 | |
|     if (s->sram_addr_width < 1 || s->sram_addr_width > addr_width_max) {
 | |
|         error_setg(errp, "SRAM_ADDR_WIDTH must be between 1 and %d",
 | |
|                    addr_width_max);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     /* Handling of which devices should be available only to secure
 | |
|      * code is usually done differently for M profile than for A profile.
 | |
|      * Instead of putting some devices only into the secure address space,
 | |
|      * devices exist in both address spaces but with hard-wired security
 | |
|      * permissions that will cause the CPU to fault for non-secure accesses.
 | |
|      *
 | |
|      * The ARMSSE has an IDAU (Implementation Defined Access Unit),
 | |
|      * which specifies hard-wired security permissions for different
 | |
|      * areas of the physical address space. For the ARMSSE IDAU, the
 | |
|      * top 4 bits of the physical address are the IDAU region ID, and
 | |
|      * if bit 28 (ie the lowest bit of the ID) is 0 then this is an NS
 | |
|      * region, otherwise it is an S region.
 | |
|      *
 | |
|      * The various devices and RAMs are generally all mapped twice,
 | |
|      * once into a region that the IDAU defines as secure and once
 | |
|      * into a non-secure region. They sit behind either a Memory
 | |
|      * Protection Controller (for RAM) or a Peripheral Protection
 | |
|      * Controller (for devices), which allow a more fine grained
 | |
|      * configuration of whether non-secure accesses are permitted.
 | |
|      *
 | |
|      * (The other place that guest software can configure security
 | |
|      * permissions is in the architected SAU (Security Attribution
 | |
|      * Unit), which is entirely inside the CPU. The IDAU can upgrade
 | |
|      * the security attributes for a region to more restrictive than
 | |
|      * the SAU specifies, but cannot downgrade them.)
 | |
|      *
 | |
|      * 0x10000000..0x1fffffff  alias of 0x00000000..0x0fffffff
 | |
|      * 0x20000000..0x2007ffff  32KB FPGA block RAM
 | |
|      * 0x30000000..0x3fffffff  alias of 0x20000000..0x2fffffff
 | |
|      * 0x40000000..0x4000ffff  base peripheral region 1
 | |
|      * 0x40010000..0x4001ffff  CPU peripherals (none for ARMSSE)
 | |
|      * 0x40020000..0x4002ffff  system control element peripherals
 | |
|      * 0x40080000..0x400fffff  base peripheral region 2
 | |
|      * 0x50000000..0x5fffffff  alias of 0x40000000..0x4fffffff
 | |
|      */
 | |
| 
 | |
|     memory_region_add_subregion_overlap(&s->container, 0, s->board_memory, -2);
 | |
| 
 | |
|     for (i = 0; i < info->num_cpus; i++) {
 | |
|         DeviceState *cpudev = DEVICE(&s->armv7m[i]);
 | |
|         Object *cpuobj = OBJECT(&s->armv7m[i]);
 | |
|         int j;
 | |
|         char *gpioname;
 | |
| 
 | |
|         qdev_prop_set_uint32(cpudev, "num-irq", s->exp_numirq + 32);
 | |
|         /*
 | |
|          * In real hardware the initial Secure VTOR is set from the INITSVTOR*
 | |
|          * registers in the IoT Kit System Control Register block. In QEMU
 | |
|          * we set the initial value here, and also the reset value of the
 | |
|          * sysctl register, from this object's QOM init-svtor property.
 | |
|          * If the guest changes the INITSVTOR* registers at runtime then the
 | |
|          * code in iotkit-sysctl.c will update the CPU init-svtor property
 | |
|          * (which will then take effect on the next CPU warm-reset).
 | |
|          *
 | |
|          * Note that typically a board using the SSE-200 will have a system
 | |
|          * control processor whose boot firmware initializes the INITSVTOR*
 | |
|          * registers before powering up the CPUs. QEMU doesn't emulate
 | |
|          * the control processor, so instead we behave in the way that the
 | |
|          * firmware does: the initial value should be set by the board code
 | |
|          * (using the init-svtor property on the ARMSSE object) to match
 | |
|          * whatever its firmware does.
 | |
|          */
 | |
|         qdev_prop_set_uint32(cpudev, "init-svtor", s->init_svtor);
 | |
|         /*
 | |
|          * CPUs start powered down if the corresponding bit in the CPUWAIT
 | |
|          * register is 1. In real hardware the CPUWAIT register reset value is
 | |
|          * a configurable property of the SSE-200 (via the CPUWAIT0_RST and
 | |
|          * CPUWAIT1_RST parameters), but since all the boards we care about
 | |
|          * start CPU0 and leave CPU1 powered off, we hard-code that in
 | |
|          * info->cpuwait_rst for now. We can add QOM properties for this
 | |
|          * later if necessary.
 | |
|          */
 | |
|         if (extract32(info->cpuwait_rst, i, 1)) {
 | |
|             if (!object_property_set_bool(cpuobj, "start-powered-off", true,
 | |
|                                           errp)) {
 | |
|                 return;
 | |
|             }
 | |
|         }
 | |
|         if (!s->cpu_fpu[i]) {
 | |
|             if (!object_property_set_bool(cpuobj, "vfp", false, errp)) {
 | |
|                 return;
 | |
|             }
 | |
|         }
 | |
|         if (!s->cpu_dsp[i]) {
 | |
|             if (!object_property_set_bool(cpuobj, "dsp", false, errp)) {
 | |
|                 return;
 | |
|             }
 | |
|         }
 | |
| 
 | |
|         if (i > 0) {
 | |
|             memory_region_add_subregion_overlap(&s->cpu_container[i], 0,
 | |
|                                                 &s->container_alias[i - 1], -1);
 | |
|         } else {
 | |
|             memory_region_add_subregion_overlap(&s->cpu_container[i], 0,
 | |
|                                                 &s->container, -1);
 | |
|         }
 | |
|         object_property_set_link(cpuobj, "memory",
 | |
|                                  OBJECT(&s->cpu_container[i]), &error_abort);
 | |
|         object_property_set_link(cpuobj, "idau", OBJECT(s), &error_abort);
 | |
|         if (!sysbus_realize(SYS_BUS_DEVICE(cpuobj), errp)) {
 | |
|             return;
 | |
|         }
 | |
|         /*
 | |
|          * The cluster must be realized after the armv7m container, as
 | |
|          * the container's CPU object is only created on realize, and the
 | |
|          * CPU must exist and have been parented into the cluster before
 | |
|          * the cluster is realized.
 | |
|          */
 | |
|         if (!qdev_realize(DEVICE(&s->cluster[i]), NULL, errp)) {
 | |
|             return;
 | |
|         }
 | |
| 
 | |
|         /* Connect EXP_IRQ/EXP_CPUn_IRQ GPIOs to the NVIC's lines 32 and up */
 | |
|         s->exp_irqs[i] = g_new(qemu_irq, s->exp_numirq);
 | |
|         for (j = 0; j < s->exp_numirq; j++) {
 | |
|             s->exp_irqs[i][j] = qdev_get_gpio_in(cpudev, j + 32);
 | |
|         }
 | |
|         if (i == 0) {
 | |
|             gpioname = g_strdup("EXP_IRQ");
 | |
|         } else {
 | |
|             gpioname = g_strdup_printf("EXP_CPU%d_IRQ", i);
 | |
|         }
 | |
|         qdev_init_gpio_in_named_with_opaque(dev, armsse_exp_irq,
 | |
|                                             s->exp_irqs[i],
 | |
|                                             gpioname, s->exp_numirq);
 | |
|         g_free(gpioname);
 | |
|     }
 | |
| 
 | |
|     /* Wire up the splitters that connect common IRQs to all CPUs */
 | |
|     if (info->num_cpus > 1) {
 | |
|         for (i = 0; i < ARRAY_SIZE(s->cpu_irq_splitter); i++) {
 | |
|             if (irq_is_common[i]) {
 | |
|                 Object *splitter = OBJECT(&s->cpu_irq_splitter[i]);
 | |
|                 DeviceState *devs = DEVICE(splitter);
 | |
|                 int cpunum;
 | |
| 
 | |
|                 if (!object_property_set_int(splitter, "num-lines",
 | |
|                                              info->num_cpus, errp)) {
 | |
|                     return;
 | |
|                 }
 | |
|                 if (!qdev_realize(DEVICE(splitter), NULL, errp)) {
 | |
|                     return;
 | |
|                 }
 | |
|                 for (cpunum = 0; cpunum < info->num_cpus; cpunum++) {
 | |
|                     DeviceState *cpudev = DEVICE(&s->armv7m[cpunum]);
 | |
| 
 | |
|                     qdev_connect_gpio_out(devs, cpunum,
 | |
|                                           qdev_get_gpio_in(cpudev, i));
 | |
|                 }
 | |
|             }
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* Set up the big aliases first */
 | |
|     make_alias(s, &s->alias1, &s->container, "alias 1",
 | |
|                0x10000000, 0x10000000, 0x00000000);
 | |
|     make_alias(s, &s->alias2, &s->container,
 | |
|                "alias 2", 0x30000000, 0x10000000, 0x20000000);
 | |
|     /* The 0x50000000..0x5fffffff region is not a pure alias: it has
 | |
|      * a few extra devices that only appear there (generally the
 | |
|      * control interfaces for the protection controllers).
 | |
|      * We implement this by mapping those devices over the top of this
 | |
|      * alias MR at a higher priority. Some of the devices in this range
 | |
|      * are per-CPU, so we must put this alias in the per-cpu containers.
 | |
|      */
 | |
|     for (i = 0; i < info->num_cpus; i++) {
 | |
|         make_alias(s, &s->alias3[i], &s->cpu_container[i],
 | |
|                    "alias 3", 0x50000000, 0x10000000, 0x40000000);
 | |
|     }
 | |
| 
 | |
|     /* Security controller */
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->secctl), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sbd_secctl = SYS_BUS_DEVICE(&s->secctl);
 | |
|     dev_secctl = DEVICE(&s->secctl);
 | |
|     sysbus_mmio_map(sbd_secctl, 0, 0x50080000);
 | |
|     sysbus_mmio_map(sbd_secctl, 1, 0x40080000);
 | |
| 
 | |
|     s->nsc_cfg_in = qemu_allocate_irq(nsccfg_handler, s, 1);
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "nsc_cfg", 0, s->nsc_cfg_in);
 | |
| 
 | |
|     /* The sec_resp_cfg output from the security controller must be split into
 | |
|      * multiple lines, one for each of the PPCs within the ARMSSE and one
 | |
|      * that will be an output from the ARMSSE to the system.
 | |
|      */
 | |
|     if (!object_property_set_int(OBJECT(&s->sec_resp_splitter),
 | |
|                                  "num-lines", 3, errp)) {
 | |
|         return;
 | |
|     }
 | |
|     if (!qdev_realize(DEVICE(&s->sec_resp_splitter), NULL, errp)) {
 | |
|         return;
 | |
|     }
 | |
|     dev_splitter = DEVICE(&s->sec_resp_splitter);
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "sec_resp_cfg", 0,
 | |
|                                 qdev_get_gpio_in(dev_splitter, 0));
 | |
| 
 | |
|     /* Each SRAM bank lives behind its own Memory Protection Controller */
 | |
|     for (i = 0; i < info->sram_banks; i++) {
 | |
|         char *ramname = g_strdup_printf("armsse.sram%d", i);
 | |
|         SysBusDevice *sbd_mpc;
 | |
|         uint32_t sram_bank_size = 1 << s->sram_addr_width;
 | |
| 
 | |
|         memory_region_init_ram(&s->sram[i], NULL, ramname,
 | |
|                                sram_bank_size, &err);
 | |
|         g_free(ramname);
 | |
|         if (err) {
 | |
|             error_propagate(errp, err);
 | |
|             return;
 | |
|         }
 | |
|         object_property_set_link(OBJECT(&s->mpc[i]), "downstream",
 | |
|                                  OBJECT(&s->sram[i]), &error_abort);
 | |
|         if (!sysbus_realize(SYS_BUS_DEVICE(&s->mpc[i]), errp)) {
 | |
|             return;
 | |
|         }
 | |
|         /* Map the upstream end of the MPC into the right place... */
 | |
|         sbd_mpc = SYS_BUS_DEVICE(&s->mpc[i]);
 | |
|         memory_region_add_subregion(&s->container,
 | |
|                                     0x20000000 + i * sram_bank_size,
 | |
|                                     sysbus_mmio_get_region(sbd_mpc, 1));
 | |
|         /* ...and its register interface */
 | |
|         memory_region_add_subregion(&s->container, 0x50083000 + i * 0x1000,
 | |
|                                     sysbus_mmio_get_region(sbd_mpc, 0));
 | |
|     }
 | |
| 
 | |
|     /* We must OR together lines from the MPC splitters to go to the NVIC */
 | |
|     if (!object_property_set_int(OBJECT(&s->mpc_irq_orgate), "num-lines",
 | |
|                                  IOTS_NUM_EXP_MPC + info->sram_banks,
 | |
|                                  errp)) {
 | |
|         return;
 | |
|     }
 | |
|     if (!qdev_realize(DEVICE(&s->mpc_irq_orgate), NULL, errp)) {
 | |
|         return;
 | |
|     }
 | |
|     qdev_connect_gpio_out(DEVICE(&s->mpc_irq_orgate), 0,
 | |
|                           armsse_get_common_irq_in(s, 9));
 | |
| 
 | |
|     /* Devices behind APB PPC0:
 | |
|      *   0x40000000: timer0
 | |
|      *   0x40001000: timer1
 | |
|      *   0x40002000: dual timer
 | |
|      *   0x40003000: MHU0 (SSE-200 only)
 | |
|      *   0x40004000: MHU1 (SSE-200 only)
 | |
|      * We must configure and realize each downstream device and connect
 | |
|      * it to the appropriate PPC port; then we can realize the PPC and
 | |
|      * map its upstream ends to the right place in the container.
 | |
|      */
 | |
|     qdev_prop_set_uint32(DEVICE(&s->timer0), "pclk-frq", s->mainclk_frq);
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->timer0), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sysbus_connect_irq(SYS_BUS_DEVICE(&s->timer0), 0,
 | |
|                        armsse_get_common_irq_in(s, 3));
 | |
|     mr = sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->timer0), 0);
 | |
|     object_property_set_link(OBJECT(&s->apb_ppc0), "port[0]", OBJECT(mr),
 | |
|                              &error_abort);
 | |
| 
 | |
|     qdev_prop_set_uint32(DEVICE(&s->timer1), "pclk-frq", s->mainclk_frq);
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->timer1), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sysbus_connect_irq(SYS_BUS_DEVICE(&s->timer1), 0,
 | |
|                        armsse_get_common_irq_in(s, 4));
 | |
|     mr = sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->timer1), 0);
 | |
|     object_property_set_link(OBJECT(&s->apb_ppc0), "port[1]", OBJECT(mr),
 | |
|                              &error_abort);
 | |
| 
 | |
|     qdev_prop_set_uint32(DEVICE(&s->dualtimer), "pclk-frq", s->mainclk_frq);
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->dualtimer), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sysbus_connect_irq(SYS_BUS_DEVICE(&s->dualtimer), 0,
 | |
|                        armsse_get_common_irq_in(s, 5));
 | |
|     mr = sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->dualtimer), 0);
 | |
|     object_property_set_link(OBJECT(&s->apb_ppc0), "port[2]", OBJECT(mr),
 | |
|                              &error_abort);
 | |
| 
 | |
|     if (info->has_mhus) {
 | |
|         /*
 | |
|          * An SSE-200 with only one CPU should have only one MHU created,
 | |
|          * with the region where the second MHU usually is being RAZ/WI.
 | |
|          * We don't implement that SSE-200 config; if we want to support
 | |
|          * it then this code needs to be enhanced to handle creating the
 | |
|          * RAZ/WI region instead of the second MHU.
 | |
|          */
 | |
|         assert(info->num_cpus == ARRAY_SIZE(s->mhu));
 | |
| 
 | |
|         for (i = 0; i < ARRAY_SIZE(s->mhu); i++) {
 | |
|             char *port;
 | |
|             int cpunum;
 | |
|             SysBusDevice *mhu_sbd = SYS_BUS_DEVICE(&s->mhu[i]);
 | |
| 
 | |
|             if (!sysbus_realize(SYS_BUS_DEVICE(&s->mhu[i]), errp)) {
 | |
|                 return;
 | |
|             }
 | |
|             port = g_strdup_printf("port[%d]", i + 3);
 | |
|             mr = sysbus_mmio_get_region(mhu_sbd, 0);
 | |
|             object_property_set_link(OBJECT(&s->apb_ppc0), port, OBJECT(mr),
 | |
|                                      &error_abort);
 | |
|             g_free(port);
 | |
| 
 | |
|             /*
 | |
|              * Each MHU has an irq line for each CPU:
 | |
|              *  MHU 0 irq line 0 -> CPU 0 IRQ 6
 | |
|              *  MHU 0 irq line 1 -> CPU 1 IRQ 6
 | |
|              *  MHU 1 irq line 0 -> CPU 0 IRQ 7
 | |
|              *  MHU 1 irq line 1 -> CPU 1 IRQ 7
 | |
|              */
 | |
|             for (cpunum = 0; cpunum < info->num_cpus; cpunum++) {
 | |
|                 DeviceState *cpudev = DEVICE(&s->armv7m[cpunum]);
 | |
| 
 | |
|                 sysbus_connect_irq(mhu_sbd, cpunum,
 | |
|                                    qdev_get_gpio_in(cpudev, 6 + i));
 | |
|             }
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->apb_ppc0), errp)) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     sbd_apb_ppc0 = SYS_BUS_DEVICE(&s->apb_ppc0);
 | |
|     dev_apb_ppc0 = DEVICE(&s->apb_ppc0);
 | |
| 
 | |
|     mr = sysbus_mmio_get_region(sbd_apb_ppc0, 0);
 | |
|     memory_region_add_subregion(&s->container, 0x40000000, mr);
 | |
|     mr = sysbus_mmio_get_region(sbd_apb_ppc0, 1);
 | |
|     memory_region_add_subregion(&s->container, 0x40001000, mr);
 | |
|     mr = sysbus_mmio_get_region(sbd_apb_ppc0, 2);
 | |
|     memory_region_add_subregion(&s->container, 0x40002000, mr);
 | |
|     if (info->has_mhus) {
 | |
|         mr = sysbus_mmio_get_region(sbd_apb_ppc0, 3);
 | |
|         memory_region_add_subregion(&s->container, 0x40003000, mr);
 | |
|         mr = sysbus_mmio_get_region(sbd_apb_ppc0, 4);
 | |
|         memory_region_add_subregion(&s->container, 0x40004000, mr);
 | |
|     }
 | |
|     for (i = 0; i < IOTS_APB_PPC0_NUM_PORTS; i++) {
 | |
|         qdev_connect_gpio_out_named(dev_secctl, "apb_ppc0_nonsec", i,
 | |
|                                     qdev_get_gpio_in_named(dev_apb_ppc0,
 | |
|                                                            "cfg_nonsec", i));
 | |
|         qdev_connect_gpio_out_named(dev_secctl, "apb_ppc0_ap", i,
 | |
|                                     qdev_get_gpio_in_named(dev_apb_ppc0,
 | |
|                                                            "cfg_ap", i));
 | |
|     }
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "apb_ppc0_irq_enable", 0,
 | |
|                                 qdev_get_gpio_in_named(dev_apb_ppc0,
 | |
|                                                        "irq_enable", 0));
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "apb_ppc0_irq_clear", 0,
 | |
|                                 qdev_get_gpio_in_named(dev_apb_ppc0,
 | |
|                                                        "irq_clear", 0));
 | |
|     qdev_connect_gpio_out(dev_splitter, 0,
 | |
|                           qdev_get_gpio_in_named(dev_apb_ppc0,
 | |
|                                                  "cfg_sec_resp", 0));
 | |
| 
 | |
|     /* All the PPC irq lines (from the 2 internal PPCs and the 8 external
 | |
|      * ones) are sent individually to the security controller, and also
 | |
|      * ORed together to give a single combined PPC interrupt to the NVIC.
 | |
|      */
 | |
|     if (!object_property_set_int(OBJECT(&s->ppc_irq_orgate),
 | |
|                                  "num-lines", NUM_PPCS, errp)) {
 | |
|         return;
 | |
|     }
 | |
|     if (!qdev_realize(DEVICE(&s->ppc_irq_orgate), NULL, errp)) {
 | |
|         return;
 | |
|     }
 | |
|     qdev_connect_gpio_out(DEVICE(&s->ppc_irq_orgate), 0,
 | |
|                           armsse_get_common_irq_in(s, 10));
 | |
| 
 | |
|     /*
 | |
|      * 0x40010000 .. 0x4001ffff (and the 0x5001000... secure-only alias):
 | |
|      * private per-CPU region (all these devices are SSE-200 only):
 | |
|      *  0x50010000: L1 icache control registers
 | |
|      *  0x50011000: CPUSECCTRL (CPU local security control registers)
 | |
|      *  0x4001f000 and 0x5001f000: CPU_IDENTITY register block
 | |
|      */
 | |
|     if (info->has_cachectrl) {
 | |
|         for (i = 0; i < info->num_cpus; i++) {
 | |
|             char *name = g_strdup_printf("cachectrl%d", i);
 | |
|             MemoryRegion *mr;
 | |
| 
 | |
|             qdev_prop_set_string(DEVICE(&s->cachectrl[i]), "name", name);
 | |
|             g_free(name);
 | |
|             qdev_prop_set_uint64(DEVICE(&s->cachectrl[i]), "size", 0x1000);
 | |
|             if (!sysbus_realize(SYS_BUS_DEVICE(&s->cachectrl[i]), errp)) {
 | |
|                 return;
 | |
|             }
 | |
| 
 | |
|             mr = sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->cachectrl[i]), 0);
 | |
|             memory_region_add_subregion(&s->cpu_container[i], 0x50010000, mr);
 | |
|         }
 | |
|     }
 | |
|     if (info->has_cpusecctrl) {
 | |
|         for (i = 0; i < info->num_cpus; i++) {
 | |
|             char *name = g_strdup_printf("CPUSECCTRL%d", i);
 | |
|             MemoryRegion *mr;
 | |
| 
 | |
|             qdev_prop_set_string(DEVICE(&s->cpusecctrl[i]), "name", name);
 | |
|             g_free(name);
 | |
|             qdev_prop_set_uint64(DEVICE(&s->cpusecctrl[i]), "size", 0x1000);
 | |
|             if (!sysbus_realize(SYS_BUS_DEVICE(&s->cpusecctrl[i]), errp)) {
 | |
|                 return;
 | |
|             }
 | |
| 
 | |
|             mr = sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->cpusecctrl[i]), 0);
 | |
|             memory_region_add_subregion(&s->cpu_container[i], 0x50011000, mr);
 | |
|         }
 | |
|     }
 | |
|     if (info->has_cpuid) {
 | |
|         for (i = 0; i < info->num_cpus; i++) {
 | |
|             MemoryRegion *mr;
 | |
| 
 | |
|             qdev_prop_set_uint32(DEVICE(&s->cpuid[i]), "CPUID", i);
 | |
|             if (!sysbus_realize(SYS_BUS_DEVICE(&s->cpuid[i]), errp)) {
 | |
|                 return;
 | |
|             }
 | |
| 
 | |
|             mr = sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->cpuid[i]), 0);
 | |
|             memory_region_add_subregion(&s->cpu_container[i], 0x4001F000, mr);
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* 0x40020000 .. 0x4002ffff : ARMSSE system control peripheral region */
 | |
|     /* Devices behind APB PPC1:
 | |
|      *   0x4002f000: S32K timer
 | |
|      */
 | |
|     qdev_prop_set_uint32(DEVICE(&s->s32ktimer), "pclk-frq", S32KCLK);
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->s32ktimer), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sysbus_connect_irq(SYS_BUS_DEVICE(&s->s32ktimer), 0,
 | |
|                        armsse_get_common_irq_in(s, 2));
 | |
|     mr = sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->s32ktimer), 0);
 | |
|     object_property_set_link(OBJECT(&s->apb_ppc1), "port[0]", OBJECT(mr),
 | |
|                              &error_abort);
 | |
| 
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->apb_ppc1), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     mr = sysbus_mmio_get_region(SYS_BUS_DEVICE(&s->apb_ppc1), 0);
 | |
|     memory_region_add_subregion(&s->container, 0x4002f000, mr);
 | |
| 
 | |
|     dev_apb_ppc1 = DEVICE(&s->apb_ppc1);
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "apb_ppc1_nonsec", 0,
 | |
|                                 qdev_get_gpio_in_named(dev_apb_ppc1,
 | |
|                                                        "cfg_nonsec", 0));
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "apb_ppc1_ap", 0,
 | |
|                                 qdev_get_gpio_in_named(dev_apb_ppc1,
 | |
|                                                        "cfg_ap", 0));
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "apb_ppc1_irq_enable", 0,
 | |
|                                 qdev_get_gpio_in_named(dev_apb_ppc1,
 | |
|                                                        "irq_enable", 0));
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "apb_ppc1_irq_clear", 0,
 | |
|                                 qdev_get_gpio_in_named(dev_apb_ppc1,
 | |
|                                                        "irq_clear", 0));
 | |
|     qdev_connect_gpio_out(dev_splitter, 1,
 | |
|                           qdev_get_gpio_in_named(dev_apb_ppc1,
 | |
|                                                  "cfg_sec_resp", 0));
 | |
| 
 | |
|     if (!object_property_set_int(OBJECT(&s->sysinfo), "SYS_VERSION",
 | |
|                                  info->sys_version, errp)) {
 | |
|         return;
 | |
|     }
 | |
|     if (!object_property_set_int(OBJECT(&s->sysinfo), "SYS_CONFIG",
 | |
|                                  armsse_sys_config_value(s, info), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->sysinfo), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     /* System information registers */
 | |
|     sysbus_mmio_map(SYS_BUS_DEVICE(&s->sysinfo), 0, 0x40020000);
 | |
|     /* System control registers */
 | |
|     object_property_set_int(OBJECT(&s->sysctl), "SYS_VERSION",
 | |
|                             info->sys_version, &error_abort);
 | |
|     object_property_set_int(OBJECT(&s->sysctl), "CPUWAIT_RST",
 | |
|                             info->cpuwait_rst, &error_abort);
 | |
|     object_property_set_int(OBJECT(&s->sysctl), "INITSVTOR0_RST",
 | |
|                             s->init_svtor, &error_abort);
 | |
|     object_property_set_int(OBJECT(&s->sysctl), "INITSVTOR1_RST",
 | |
|                             s->init_svtor, &error_abort);
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->sysctl), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sysbus_mmio_map(SYS_BUS_DEVICE(&s->sysctl), 0, 0x50021000);
 | |
| 
 | |
|     if (info->has_ppus) {
 | |
|         /* CPUnCORE_PPU for each CPU */
 | |
|         for (i = 0; i < info->num_cpus; i++) {
 | |
|             char *name = g_strdup_printf("CPU%dCORE_PPU", i);
 | |
| 
 | |
|             map_ppu(s, CPU0CORE_PPU + i, name, 0x50023000 + i * 0x2000);
 | |
|             /*
 | |
|              * We don't support CPU debug so don't create the
 | |
|              * CPU0DEBUG_PPU at 0x50024000 and 0x50026000.
 | |
|              */
 | |
|             g_free(name);
 | |
|         }
 | |
|         map_ppu(s, DBG_PPU, "DBG_PPU", 0x50029000);
 | |
| 
 | |
|         for (i = 0; i < info->sram_banks; i++) {
 | |
|             char *name = g_strdup_printf("RAM%d_PPU", i);
 | |
| 
 | |
|             map_ppu(s, RAM0_PPU + i, name, 0x5002a000 + i * 0x1000);
 | |
|             g_free(name);
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* This OR gate wires together outputs from the secure watchdogs to NMI */
 | |
|     if (!object_property_set_int(OBJECT(&s->nmi_orgate), "num-lines", 2,
 | |
|                                  errp)) {
 | |
|         return;
 | |
|     }
 | |
|     if (!qdev_realize(DEVICE(&s->nmi_orgate), NULL, errp)) {
 | |
|         return;
 | |
|     }
 | |
|     qdev_connect_gpio_out(DEVICE(&s->nmi_orgate), 0,
 | |
|                           qdev_get_gpio_in_named(DEVICE(&s->armv7m), "NMI", 0));
 | |
| 
 | |
|     qdev_prop_set_uint32(DEVICE(&s->s32kwatchdog), "wdogclk-frq", S32KCLK);
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->s32kwatchdog), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sysbus_connect_irq(SYS_BUS_DEVICE(&s->s32kwatchdog), 0,
 | |
|                        qdev_get_gpio_in(DEVICE(&s->nmi_orgate), 0));
 | |
|     sysbus_mmio_map(SYS_BUS_DEVICE(&s->s32kwatchdog), 0, 0x5002e000);
 | |
| 
 | |
|     /* 0x40080000 .. 0x4008ffff : ARMSSE second Base peripheral region */
 | |
| 
 | |
|     qdev_prop_set_uint32(DEVICE(&s->nswatchdog), "wdogclk-frq", s->mainclk_frq);
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->nswatchdog), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sysbus_connect_irq(SYS_BUS_DEVICE(&s->nswatchdog), 0,
 | |
|                        armsse_get_common_irq_in(s, 1));
 | |
|     sysbus_mmio_map(SYS_BUS_DEVICE(&s->nswatchdog), 0, 0x40081000);
 | |
| 
 | |
|     qdev_prop_set_uint32(DEVICE(&s->swatchdog), "wdogclk-frq", s->mainclk_frq);
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->swatchdog), errp)) {
 | |
|         return;
 | |
|     }
 | |
|     sysbus_connect_irq(SYS_BUS_DEVICE(&s->swatchdog), 0,
 | |
|                        qdev_get_gpio_in(DEVICE(&s->nmi_orgate), 1));
 | |
|     sysbus_mmio_map(SYS_BUS_DEVICE(&s->swatchdog), 0, 0x50081000);
 | |
| 
 | |
|     for (i = 0; i < ARRAY_SIZE(s->ppc_irq_splitter); i++) {
 | |
|         Object *splitter = OBJECT(&s->ppc_irq_splitter[i]);
 | |
| 
 | |
|         if (!object_property_set_int(splitter, "num-lines", 2, errp)) {
 | |
|             return;
 | |
|         }
 | |
|         if (!qdev_realize(DEVICE(splitter), NULL, errp)) {
 | |
|             return;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     for (i = 0; i < IOTS_NUM_AHB_EXP_PPC; i++) {
 | |
|         char *ppcname = g_strdup_printf("ahb_ppcexp%d", i);
 | |
| 
 | |
|         armsse_forward_ppc(s, ppcname, i);
 | |
|         g_free(ppcname);
 | |
|     }
 | |
| 
 | |
|     for (i = 0; i < IOTS_NUM_APB_EXP_PPC; i++) {
 | |
|         char *ppcname = g_strdup_printf("apb_ppcexp%d", i);
 | |
| 
 | |
|         armsse_forward_ppc(s, ppcname, i + IOTS_NUM_AHB_EXP_PPC);
 | |
|         g_free(ppcname);
 | |
|     }
 | |
| 
 | |
|     for (i = NUM_EXTERNAL_PPCS; i < NUM_PPCS; i++) {
 | |
|         /* Wire up IRQ splitter for internal PPCs */
 | |
|         DeviceState *devs = DEVICE(&s->ppc_irq_splitter[i]);
 | |
|         char *gpioname = g_strdup_printf("apb_ppc%d_irq_status",
 | |
|                                          i - NUM_EXTERNAL_PPCS);
 | |
|         TZPPC *ppc = (i == NUM_EXTERNAL_PPCS) ? &s->apb_ppc0 : &s->apb_ppc1;
 | |
| 
 | |
|         qdev_connect_gpio_out(devs, 0,
 | |
|                               qdev_get_gpio_in_named(dev_secctl, gpioname, 0));
 | |
|         qdev_connect_gpio_out(devs, 1,
 | |
|                               qdev_get_gpio_in(DEVICE(&s->ppc_irq_orgate), i));
 | |
|         qdev_connect_gpio_out_named(DEVICE(ppc), "irq", 0,
 | |
|                                     qdev_get_gpio_in(devs, 0));
 | |
|         g_free(gpioname);
 | |
|     }
 | |
| 
 | |
|     /* Wire up the splitters for the MPC IRQs */
 | |
|     for (i = 0; i < IOTS_NUM_EXP_MPC + info->sram_banks; i++) {
 | |
|         SplitIRQ *splitter = &s->mpc_irq_splitter[i];
 | |
|         DeviceState *dev_splitter = DEVICE(splitter);
 | |
| 
 | |
|         if (!object_property_set_int(OBJECT(splitter), "num-lines", 2,
 | |
|                                      errp)) {
 | |
|             return;
 | |
|         }
 | |
|         if (!qdev_realize(DEVICE(splitter), NULL, errp)) {
 | |
|             return;
 | |
|         }
 | |
| 
 | |
|         if (i < IOTS_NUM_EXP_MPC) {
 | |
|             /* Splitter input is from GPIO input line */
 | |
|             s->mpcexp_status_in[i] = qdev_get_gpio_in(dev_splitter, 0);
 | |
|             qdev_connect_gpio_out(dev_splitter, 0,
 | |
|                                   qdev_get_gpio_in_named(dev_secctl,
 | |
|                                                          "mpcexp_status", i));
 | |
|         } else {
 | |
|             /* Splitter input is from our own MPC */
 | |
|             qdev_connect_gpio_out_named(DEVICE(&s->mpc[i - IOTS_NUM_EXP_MPC]),
 | |
|                                         "irq", 0,
 | |
|                                         qdev_get_gpio_in(dev_splitter, 0));
 | |
|             qdev_connect_gpio_out(dev_splitter, 0,
 | |
|                                   qdev_get_gpio_in_named(dev_secctl,
 | |
|                                                          "mpc_status", 0));
 | |
|         }
 | |
| 
 | |
|         qdev_connect_gpio_out(dev_splitter, 1,
 | |
|                               qdev_get_gpio_in(DEVICE(&s->mpc_irq_orgate), i));
 | |
|     }
 | |
|     /* Create GPIO inputs which will pass the line state for our
 | |
|      * mpcexp_irq inputs to the correct splitter devices.
 | |
|      */
 | |
|     qdev_init_gpio_in_named(dev, armsse_mpcexp_status, "mpcexp_status",
 | |
|                             IOTS_NUM_EXP_MPC);
 | |
| 
 | |
|     armsse_forward_sec_resp_cfg(s);
 | |
| 
 | |
|     /* Forward the MSC related signals */
 | |
|     qdev_pass_gpios(dev_secctl, dev, "mscexp_status");
 | |
|     qdev_pass_gpios(dev_secctl, dev, "mscexp_clear");
 | |
|     qdev_pass_gpios(dev_secctl, dev, "mscexp_ns");
 | |
|     qdev_connect_gpio_out_named(dev_secctl, "msc_irq", 0,
 | |
|                                 armsse_get_common_irq_in(s, 11));
 | |
| 
 | |
|     /*
 | |
|      * Expose our container region to the board model; this corresponds
 | |
|      * to the AHB Slave Expansion ports which allow bus master devices
 | |
|      * (eg DMA controllers) in the board model to make transactions into
 | |
|      * devices in the ARMSSE.
 | |
|      */
 | |
|     sysbus_init_mmio(SYS_BUS_DEVICE(s), &s->container);
 | |
| 
 | |
|     system_clock_scale = NANOSECONDS_PER_SECOND / s->mainclk_frq;
 | |
| }
 | |
| 
 | |
| static void armsse_idau_check(IDAUInterface *ii, uint32_t address,
 | |
|                               int *iregion, bool *exempt, bool *ns, bool *nsc)
 | |
| {
 | |
|     /*
 | |
|      * For ARMSSE systems the IDAU responses are simple logical functions
 | |
|      * of the address bits. The NSC attribute is guest-adjustable via the
 | |
|      * NSCCFG register in the security controller.
 | |
|      */
 | |
|     ARMSSE *s = ARMSSE(ii);
 | |
|     int region = extract32(address, 28, 4);
 | |
| 
 | |
|     *ns = !(region & 1);
 | |
|     *nsc = (region == 1 && (s->nsccfg & 1)) || (region == 3 && (s->nsccfg & 2));
 | |
|     /* 0xe0000000..0xe00fffff and 0xf0000000..0xf00fffff are exempt */
 | |
|     *exempt = (address & 0xeff00000) == 0xe0000000;
 | |
|     *iregion = region;
 | |
| }
 | |
| 
 | |
| static const VMStateDescription armsse_vmstate = {
 | |
|     .name = "iotkit",
 | |
|     .version_id = 1,
 | |
|     .minimum_version_id = 1,
 | |
|     .fields = (VMStateField[]) {
 | |
|         VMSTATE_UINT32(nsccfg, ARMSSE),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     }
 | |
| };
 | |
| 
 | |
| static void armsse_reset(DeviceState *dev)
 | |
| {
 | |
|     ARMSSE *s = ARMSSE(dev);
 | |
| 
 | |
|     s->nsccfg = 0;
 | |
| }
 | |
| 
 | |
| static void armsse_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     IDAUInterfaceClass *iic = IDAU_INTERFACE_CLASS(klass);
 | |
|     ARMSSEClass *asc = ARMSSE_CLASS(klass);
 | |
|     const ARMSSEInfo *info = data;
 | |
| 
 | |
|     dc->realize = armsse_realize;
 | |
|     dc->vmsd = &armsse_vmstate;
 | |
|     device_class_set_props(dc, info->props);
 | |
|     dc->reset = armsse_reset;
 | |
|     iic->check = armsse_idau_check;
 | |
|     asc->info = info;
 | |
| }
 | |
| 
 | |
| static const TypeInfo armsse_info = {
 | |
|     .name = TYPE_ARMSSE,
 | |
|     .parent = TYPE_SYS_BUS_DEVICE,
 | |
|     .instance_size = sizeof(ARMSSE),
 | |
|     .instance_init = armsse_init,
 | |
|     .abstract = true,
 | |
|     .interfaces = (InterfaceInfo[]) {
 | |
|         { TYPE_IDAU_INTERFACE },
 | |
|         { }
 | |
|     }
 | |
| };
 | |
| 
 | |
| static void armsse_register_types(void)
 | |
| {
 | |
|     int i;
 | |
| 
 | |
|     type_register_static(&armsse_info);
 | |
| 
 | |
|     for (i = 0; i < ARRAY_SIZE(armsse_variants); i++) {
 | |
|         TypeInfo ti = {
 | |
|             .name = armsse_variants[i].name,
 | |
|             .parent = TYPE_ARMSSE,
 | |
|             .class_init = armsse_class_init,
 | |
|             .class_data = (void *)&armsse_variants[i],
 | |
|         };
 | |
|         type_register(&ti);
 | |
|     }
 | |
| }
 | |
| 
 | |
| type_init(armsse_register_types);
 |