Signed-off-by: Sergey Kambalin <sergey.kambalin@auriga.com> Reviewed-by: Peter Maydell <peter.maydell@linaro.org> Message-id: 20240226000259.2752893-11-sergey.kambalin@auriga.com [PMM: Change name to 'raspi4b', not 'raspi4b-2g'] Signed-off-by: Peter Maydell <peter.maydell@linaro.org>
		
			
				
	
	
		
			264 lines
		
	
	
		
			9.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			264 lines
		
	
	
		
			9.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * BCM2838 SoC emulation
 | 
						|
 *
 | 
						|
 * Copyright (C) 2022 Ovchinnikov Vitalii <vitalii.ovchinnikov@auriga.com>
 | 
						|
 *
 | 
						|
 * SPDX-License-Identifier: GPL-2.0-or-later
 | 
						|
 */
 | 
						|
 | 
						|
#include "qemu/osdep.h"
 | 
						|
#include "qapi/error.h"
 | 
						|
#include "qemu/module.h"
 | 
						|
#include "hw/arm/raspi_platform.h"
 | 
						|
#include "hw/sysbus.h"
 | 
						|
#include "hw/arm/bcm2838.h"
 | 
						|
#include "trace.h"
 | 
						|
 | 
						|
#define GIC400_MAINTENANCE_IRQ      9
 | 
						|
#define GIC400_TIMER_NS_EL2_IRQ     10
 | 
						|
#define GIC400_TIMER_VIRT_IRQ       11
 | 
						|
#define GIC400_LEGACY_FIQ           12
 | 
						|
#define GIC400_TIMER_S_EL1_IRQ      13
 | 
						|
#define GIC400_TIMER_NS_EL1_IRQ     14
 | 
						|
#define GIC400_LEGACY_IRQ           15
 | 
						|
 | 
						|
/* Number of external interrupt lines to configure the GIC with */
 | 
						|
#define GIC_NUM_IRQS                192
 | 
						|
 | 
						|
#define PPI(cpu, irq) (GIC_NUM_IRQS + (cpu) * GIC_INTERNAL + GIC_NR_SGIS + irq)
 | 
						|
 | 
						|
#define GIC_BASE_OFS                0x0000
 | 
						|
#define GIC_DIST_OFS                0x1000
 | 
						|
#define GIC_CPU_OFS                 0x2000
 | 
						|
#define GIC_VIFACE_THIS_OFS         0x4000
 | 
						|
#define GIC_VIFACE_OTHER_OFS(cpu)  (0x5000 + (cpu) * 0x200)
 | 
						|
#define GIC_VCPU_OFS                0x6000
 | 
						|
 | 
						|
#define VIRTUAL_PMU_IRQ 7
 | 
						|
 | 
						|
static void bcm2838_gic_set_irq(void *opaque, int irq, int level)
 | 
						|
{
 | 
						|
    BCM2838State *s = (BCM2838State *)opaque;
 | 
						|
 | 
						|
    trace_bcm2838_gic_set_irq(irq, level);
 | 
						|
    qemu_set_irq(qdev_get_gpio_in(DEVICE(&s->gic), irq), level);
 | 
						|
}
 | 
						|
 | 
						|
static void bcm2838_init(Object *obj)
 | 
						|
{
 | 
						|
    BCM2838State *s = BCM2838(obj);
 | 
						|
 | 
						|
    object_initialize_child(obj, "peripherals", &s->peripherals,
 | 
						|
                            TYPE_BCM2838_PERIPHERALS);
 | 
						|
    object_property_add_alias(obj, "board-rev", OBJECT(&s->peripherals),
 | 
						|
                              "board-rev");
 | 
						|
    object_property_add_alias(obj, "vcram-size", OBJECT(&s->peripherals),
 | 
						|
                              "vcram-size");
 | 
						|
    object_property_add_alias(obj, "vcram-base", OBJECT(&s->peripherals),
 | 
						|
                              "vcram-base");
 | 
						|
    object_property_add_alias(obj, "command-line", OBJECT(&s->peripherals),
 | 
						|
                              "command-line");
 | 
						|
 | 
						|
    object_initialize_child(obj, "gic", &s->gic, TYPE_ARM_GIC);
 | 
						|
}
 | 
						|
 | 
						|
static void bcm2838_realize(DeviceState *dev, Error **errp)
 | 
						|
{
 | 
						|
    BCM2838State *s = BCM2838(dev);
 | 
						|
    BCM283XBaseState *s_base = BCM283X_BASE(dev);
 | 
						|
    BCM283XBaseClass *bc_base = BCM283X_BASE_GET_CLASS(dev);
 | 
						|
    BCM2838PeripheralState *ps = BCM2838_PERIPHERALS(&s->peripherals);
 | 
						|
    BCMSocPeripheralBaseState *ps_base =
 | 
						|
        BCM_SOC_PERIPHERALS_BASE(&s->peripherals);
 | 
						|
 | 
						|
    DeviceState *gicdev = NULL;
 | 
						|
 | 
						|
    if (!bcm283x_common_realize(dev, ps_base, errp)) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
    sysbus_mmio_map_overlap(SYS_BUS_DEVICE(ps), 1, BCM2838_PERI_LOW_BASE, 1);
 | 
						|
 | 
						|
    /* bcm2836 interrupt controller (and mailboxes, etc.) */
 | 
						|
    if (!sysbus_realize(SYS_BUS_DEVICE(&s_base->control), errp)) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
    sysbus_mmio_map(SYS_BUS_DEVICE(&s_base->control), 0, bc_base->ctrl_base);
 | 
						|
 | 
						|
    /* Create cores */
 | 
						|
    for (int n = 0; n < bc_base->core_count; n++) {
 | 
						|
 | 
						|
        object_property_set_int(OBJECT(&s_base->cpu[n].core), "mp-affinity",
 | 
						|
                                (bc_base->clusterid << 8) | n, &error_abort);
 | 
						|
 | 
						|
        /* set periphbase/CBAR value for CPU-local registers */
 | 
						|
        object_property_set_int(OBJECT(&s_base->cpu[n].core), "reset-cbar",
 | 
						|
                                bc_base->peri_base, &error_abort);
 | 
						|
 | 
						|
        /* start powered off if not enabled */
 | 
						|
        object_property_set_bool(OBJECT(&s_base->cpu[n].core),
 | 
						|
                                 "start-powered-off",
 | 
						|
                                 n >= s_base->enabled_cpus, &error_abort);
 | 
						|
 | 
						|
        if (!qdev_realize(DEVICE(&s_base->cpu[n].core), NULL, errp)) {
 | 
						|
            return;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    if (!object_property_set_uint(OBJECT(&s->gic), "revision", 2, errp)) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    if (!object_property_set_uint(OBJECT(&s->gic), "num-cpu", BCM283X_NCPUS,
 | 
						|
                                  errp)) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    if (!object_property_set_uint(OBJECT(&s->gic), "num-irq",
 | 
						|
                                  GIC_NUM_IRQS + GIC_INTERNAL, errp)) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    if (!object_property_set_bool(OBJECT(&s->gic),
 | 
						|
                                  "has-virtualization-extensions", true,
 | 
						|
                                  errp)) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    if (!sysbus_realize(SYS_BUS_DEVICE(&s->gic), errp)) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    sysbus_mmio_map(SYS_BUS_DEVICE(&s->gic), 0,
 | 
						|
                    bc_base->ctrl_base + BCM2838_GIC_BASE + GIC_DIST_OFS);
 | 
						|
    sysbus_mmio_map(SYS_BUS_DEVICE(&s->gic), 1,
 | 
						|
                    bc_base->ctrl_base + BCM2838_GIC_BASE + GIC_CPU_OFS);
 | 
						|
    sysbus_mmio_map(SYS_BUS_DEVICE(&s->gic), 2,
 | 
						|
                    bc_base->ctrl_base + BCM2838_GIC_BASE + GIC_VIFACE_THIS_OFS);
 | 
						|
    sysbus_mmio_map(SYS_BUS_DEVICE(&s->gic), 3,
 | 
						|
                    bc_base->ctrl_base + BCM2838_GIC_BASE + GIC_VCPU_OFS);
 | 
						|
 | 
						|
    for (int n = 0; n < BCM283X_NCPUS; n++) {
 | 
						|
        sysbus_mmio_map(SYS_BUS_DEVICE(&s->gic), 4 + n,
 | 
						|
                        bc_base->ctrl_base + BCM2838_GIC_BASE
 | 
						|
                            + GIC_VIFACE_OTHER_OFS(n));
 | 
						|
    }
 | 
						|
 | 
						|
    gicdev = DEVICE(&s->gic);
 | 
						|
 | 
						|
    for (int n = 0; n < BCM283X_NCPUS; n++) {
 | 
						|
        DeviceState *cpudev = DEVICE(&s_base->cpu[n]);
 | 
						|
 | 
						|
        /* Connect the GICv2 outputs to the CPU */
 | 
						|
        sysbus_connect_irq(SYS_BUS_DEVICE(&s->gic), n,
 | 
						|
                           qdev_get_gpio_in(cpudev, ARM_CPU_IRQ));
 | 
						|
        sysbus_connect_irq(SYS_BUS_DEVICE(&s->gic), n + BCM283X_NCPUS,
 | 
						|
                           qdev_get_gpio_in(cpudev, ARM_CPU_FIQ));
 | 
						|
        sysbus_connect_irq(SYS_BUS_DEVICE(&s->gic), n + 2 * BCM283X_NCPUS,
 | 
						|
                           qdev_get_gpio_in(cpudev, ARM_CPU_VIRQ));
 | 
						|
        sysbus_connect_irq(SYS_BUS_DEVICE(&s->gic), n + 3 * BCM283X_NCPUS,
 | 
						|
                           qdev_get_gpio_in(cpudev, ARM_CPU_VFIQ));
 | 
						|
 | 
						|
        sysbus_connect_irq(SYS_BUS_DEVICE(&s->gic), n + 4 * BCM283X_NCPUS,
 | 
						|
                           qdev_get_gpio_in(gicdev,
 | 
						|
                                            PPI(n, GIC400_MAINTENANCE_IRQ)));
 | 
						|
 | 
						|
        /* Connect timers from the CPU to the interrupt controller */
 | 
						|
        qdev_connect_gpio_out(cpudev, GTIMER_PHYS,
 | 
						|
                    qdev_get_gpio_in(gicdev, PPI(n, GIC400_TIMER_NS_EL1_IRQ)));
 | 
						|
        qdev_connect_gpio_out(cpudev, GTIMER_VIRT,
 | 
						|
                    qdev_get_gpio_in(gicdev, PPI(n, GIC400_TIMER_VIRT_IRQ)));
 | 
						|
        qdev_connect_gpio_out(cpudev, GTIMER_HYP,
 | 
						|
                    qdev_get_gpio_in(gicdev, PPI(n, GIC400_TIMER_NS_EL2_IRQ)));
 | 
						|
        qdev_connect_gpio_out(cpudev, GTIMER_SEC,
 | 
						|
                    qdev_get_gpio_in(gicdev, PPI(n, GIC400_TIMER_S_EL1_IRQ)));
 | 
						|
        /* PMU interrupt */
 | 
						|
        qdev_connect_gpio_out_named(cpudev, "pmu-interrupt", 0,
 | 
						|
                    qdev_get_gpio_in(gicdev, PPI(n, VIRTUAL_PMU_IRQ)));
 | 
						|
    }
 | 
						|
 | 
						|
    /* Connect UART0 to the interrupt controller */
 | 
						|
    sysbus_connect_irq(SYS_BUS_DEVICE(&ps_base->uart0), 0,
 | 
						|
                       qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_UART0));
 | 
						|
 | 
						|
    /* Connect AUX / UART1 to the interrupt controller */
 | 
						|
    sysbus_connect_irq(SYS_BUS_DEVICE(&ps_base->aux), 0,
 | 
						|
                       qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_AUX_UART1));
 | 
						|
 | 
						|
    /* Connect VC mailbox to the interrupt controller */
 | 
						|
    sysbus_connect_irq(SYS_BUS_DEVICE(&ps_base->mboxes), 0,
 | 
						|
                       qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_MBOX));
 | 
						|
 | 
						|
    /* Connect SD host to the interrupt controller */
 | 
						|
    sysbus_connect_irq(SYS_BUS_DEVICE(&ps_base->sdhost), 0,
 | 
						|
                       qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_SDHOST));
 | 
						|
 | 
						|
    /* According to DTS, EMMC and EMMC2 share one irq */
 | 
						|
    DeviceState *mmc_irq_orgate = DEVICE(&ps->mmc_irq_orgate);
 | 
						|
 | 
						|
    /* Connect EMMC and EMMC2 to the interrupt controller */
 | 
						|
    qdev_connect_gpio_out(mmc_irq_orgate, 0,
 | 
						|
                          qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_EMMC_EMMC2));
 | 
						|
 | 
						|
    /* Connect USB OTG and MPHI to the interrupt controller */
 | 
						|
    sysbus_connect_irq(SYS_BUS_DEVICE(&ps_base->mphi), 0,
 | 
						|
                       qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_MPHI));
 | 
						|
    sysbus_connect_irq(SYS_BUS_DEVICE(&ps_base->dwc2), 0,
 | 
						|
                       qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_DWC2));
 | 
						|
 | 
						|
    /* Connect DMA 0-6 to the interrupt controller */
 | 
						|
    for (int n = GIC_SPI_INTERRUPT_DMA_0; n <= GIC_SPI_INTERRUPT_DMA_6; n++) {
 | 
						|
        sysbus_connect_irq(SYS_BUS_DEVICE(&ps_base->dma),
 | 
						|
                           n - GIC_SPI_INTERRUPT_DMA_0,
 | 
						|
                           qdev_get_gpio_in(gicdev, n));
 | 
						|
    }
 | 
						|
 | 
						|
    /* According to DTS, DMA 7 and 8 share one irq */
 | 
						|
    DeviceState *dma_7_8_irq_orgate = DEVICE(&ps->dma_7_8_irq_orgate);
 | 
						|
 | 
						|
    /* Connect DMA 7-8 to the interrupt controller */
 | 
						|
    qdev_connect_gpio_out(dma_7_8_irq_orgate, 0,
 | 
						|
                          qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_DMA_7_8));
 | 
						|
 | 
						|
    /* According to DTS, DMA 9 and 10 share one irq */
 | 
						|
    DeviceState *dma_9_10_irq_orgate = DEVICE(&ps->dma_9_10_irq_orgate);
 | 
						|
 | 
						|
    /* Connect DMA 9-10 to the interrupt controller */
 | 
						|
    qdev_connect_gpio_out(dma_9_10_irq_orgate, 0,
 | 
						|
                          qdev_get_gpio_in(gicdev, GIC_SPI_INTERRUPT_DMA_9_10));
 | 
						|
 | 
						|
    /* Pass through inbound GPIO lines to the GIC */
 | 
						|
    qdev_init_gpio_in(dev, bcm2838_gic_set_irq, GIC_NUM_IRQS);
 | 
						|
 | 
						|
    /* Pass through outbound IRQ lines from the GIC */
 | 
						|
    qdev_pass_gpios(DEVICE(&s->gic), DEVICE(&s->peripherals), NULL);
 | 
						|
}
 | 
						|
 | 
						|
static void bcm2838_class_init(ObjectClass *oc, void *data)
 | 
						|
{
 | 
						|
    DeviceClass *dc = DEVICE_CLASS(oc);
 | 
						|
    BCM283XBaseClass *bc_base = BCM283X_BASE_CLASS(oc);
 | 
						|
 | 
						|
    bc_base->cpu_type = ARM_CPU_TYPE_NAME("cortex-a72");
 | 
						|
    bc_base->core_count = BCM283X_NCPUS;
 | 
						|
    bc_base->peri_base = 0xfe000000;
 | 
						|
    bc_base->ctrl_base = 0xff800000;
 | 
						|
    bc_base->clusterid = 0x0;
 | 
						|
    dc->realize = bcm2838_realize;
 | 
						|
}
 | 
						|
 | 
						|
static const TypeInfo bcm2838_type = {
 | 
						|
    .name           = TYPE_BCM2838,
 | 
						|
    .parent         = TYPE_BCM283X_BASE,
 | 
						|
    .instance_size  = sizeof(BCM2838State),
 | 
						|
    .instance_init  = bcm2838_init,
 | 
						|
    .class_size     = sizeof(BCM283XBaseClass),
 | 
						|
    .class_init     = bcm2838_class_init,
 | 
						|
};
 | 
						|
 | 
						|
static void bcm2838_register_types(void)
 | 
						|
{
 | 
						|
    type_register_static(&bcm2838_type);
 | 
						|
}
 | 
						|
 | 
						|
type_init(bcm2838_register_types);
 |