leon3: introduce the plug and play mechanism
This adds the AHB and APB plug and play devices. They are scanned during the linux boot to discover the various peripheral. Reviewed-by: Fabien Chouteau <chouteau@adacore.com> Signed-off-by: KONRAD Frederic <frederic.konrad@adacore.com> Signed-off-by: Mark Cave-Ayland <mark.cave-ayland@ilande.co.uk>
This commit is contained in:
parent
dbed0d2d2a
commit
162abf1a83
|
@ -1161,7 +1161,7 @@ M: Fabien Chouteau <chouteau@adacore.com>
|
|||
S: Maintained
|
||||
F: hw/sparc/leon3.c
|
||||
F: hw/*/grlib*
|
||||
F: include/hw/sparc/grlib.h
|
||||
F: include/hw/*/grlib*
|
||||
|
||||
S390 Machines
|
||||
-------------
|
||||
|
|
|
@ -77,3 +77,5 @@ obj-$(CONFIG_AUX) += auxbus.o
|
|||
obj-$(CONFIG_ASPEED_SOC) += aspeed_scu.o aspeed_sdmc.o
|
||||
obj-$(CONFIG_MSF2) += msf2-sysreg.o
|
||||
obj-$(CONFIG_NRF51_SOC) += nrf51_rng.o
|
||||
|
||||
obj-$(CONFIG_GRLIB) += grlib_ahb_apb_pnp.o
|
||||
|
|
269
hw/misc/grlib_ahb_apb_pnp.c
Normal file
269
hw/misc/grlib_ahb_apb_pnp.c
Normal file
|
@ -0,0 +1,269 @@
|
|||
/*
|
||||
* GRLIB AHB APB PNP
|
||||
*
|
||||
* Copyright (C) 2019 AdaCore
|
||||
*
|
||||
* Developed by :
|
||||
* Frederic Konrad <frederic.konrad@adacore.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along
|
||||
* with this program; if not, see <http://www.gnu.org/licenses/>.
|
||||
*
|
||||
*/
|
||||
|
||||
#include "qemu/osdep.h"
|
||||
#include "hw/sysbus.h"
|
||||
#include "hw/misc/grlib_ahb_apb_pnp.h"
|
||||
|
||||
#define GRLIB_PNP_VENDOR_SHIFT (24)
|
||||
#define GRLIB_PNP_VENDOR_SIZE (8)
|
||||
#define GRLIB_PNP_DEV_SHIFT (12)
|
||||
#define GRLIB_PNP_DEV_SIZE (12)
|
||||
#define GRLIB_PNP_VER_SHIFT (5)
|
||||
#define GRLIB_PNP_VER_SIZE (5)
|
||||
#define GRLIB_PNP_IRQ_SHIFT (0)
|
||||
#define GRLIB_PNP_IRQ_SIZE (5)
|
||||
#define GRLIB_PNP_ADDR_SHIFT (20)
|
||||
#define GRLIB_PNP_ADDR_SIZE (12)
|
||||
#define GRLIB_PNP_MASK_SHIFT (4)
|
||||
#define GRLIB_PNP_MASK_SIZE (12)
|
||||
|
||||
#define GRLIB_AHB_DEV_ADDR_SHIFT (20)
|
||||
#define GRLIB_AHB_DEV_ADDR_SIZE (12)
|
||||
#define GRLIB_AHB_ENTRY_SIZE (0x20)
|
||||
#define GRLIB_AHB_MAX_DEV (64)
|
||||
#define GRLIB_AHB_SLAVE_OFFSET (0x800)
|
||||
|
||||
#define GRLIB_APB_DEV_ADDR_SHIFT (8)
|
||||
#define GRLIB_APB_DEV_ADDR_SIZE (12)
|
||||
#define GRLIB_APB_ENTRY_SIZE (0x08)
|
||||
#define GRLIB_APB_MAX_DEV (512)
|
||||
|
||||
#define GRLIB_PNP_MAX_REGS (0x1000)
|
||||
|
||||
typedef struct AHBPnp {
|
||||
SysBusDevice parent_obj;
|
||||
MemoryRegion iomem;
|
||||
|
||||
uint32_t regs[GRLIB_PNP_MAX_REGS >> 2];
|
||||
uint8_t master_count;
|
||||
uint8_t slave_count;
|
||||
} AHBPnp;
|
||||
|
||||
void grlib_ahb_pnp_add_entry(AHBPnp *dev, uint32_t address, uint32_t mask,
|
||||
uint8_t vendor, uint16_t device, int slave,
|
||||
int type)
|
||||
{
|
||||
unsigned int reg_start;
|
||||
|
||||
/*
|
||||
* AHB entries look like this:
|
||||
*
|
||||
* 31 -------- 23 -------- 11 ----- 9 -------- 4 --- 0
|
||||
* | VENDOR ID | DEVICE ID | IRQ ? | VERSION | IRQ |
|
||||
* --------------------------------------------------
|
||||
* | USER |
|
||||
* --------------------------------------------------
|
||||
* | USER |
|
||||
* --------------------------------------------------
|
||||
* | USER |
|
||||
* --------------------------------------------------
|
||||
* | USER |
|
||||
* --------------------------------------------------
|
||||
* 31 ----------- 20 --- 15 ----------------- 3 ---- 0
|
||||
* | ADDR[31..12] | 00PC | MASK | TYPE |
|
||||
* --------------------------------------------------
|
||||
* 31 ----------- 20 --- 15 ----------------- 3 ---- 0
|
||||
* | ADDR[31..12] | 00PC | MASK | TYPE |
|
||||
* --------------------------------------------------
|
||||
* 31 ----------- 20 --- 15 ----------------- 3 ---- 0
|
||||
* | ADDR[31..12] | 00PC | MASK | TYPE |
|
||||
* --------------------------------------------------
|
||||
* 31 ----------- 20 --- 15 ----------------- 3 ---- 0
|
||||
* | ADDR[31..12] | 00PC | MASK | TYPE |
|
||||
* --------------------------------------------------
|
||||
*/
|
||||
|
||||
if (slave) {
|
||||
assert(dev->slave_count < GRLIB_AHB_MAX_DEV);
|
||||
reg_start = (GRLIB_AHB_SLAVE_OFFSET
|
||||
+ (dev->slave_count * GRLIB_AHB_ENTRY_SIZE)) >> 2;
|
||||
dev->slave_count++;
|
||||
} else {
|
||||
assert(dev->master_count < GRLIB_AHB_MAX_DEV);
|
||||
reg_start = (dev->master_count * GRLIB_AHB_ENTRY_SIZE) >> 2;
|
||||
dev->master_count++;
|
||||
}
|
||||
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_VENDOR_SHIFT,
|
||||
GRLIB_PNP_VENDOR_SIZE,
|
||||
vendor);
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_DEV_SHIFT,
|
||||
GRLIB_PNP_DEV_SIZE,
|
||||
device);
|
||||
reg_start += 4;
|
||||
/* AHB Memory Space */
|
||||
dev->regs[reg_start] = type;
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_ADDR_SHIFT,
|
||||
GRLIB_PNP_ADDR_SIZE,
|
||||
extract32(address,
|
||||
GRLIB_AHB_DEV_ADDR_SHIFT,
|
||||
GRLIB_AHB_DEV_ADDR_SIZE));
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_MASK_SHIFT,
|
||||
GRLIB_PNP_MASK_SIZE,
|
||||
mask);
|
||||
}
|
||||
|
||||
static uint64_t grlib_ahb_pnp_read(void *opaque, hwaddr offset, unsigned size)
|
||||
{
|
||||
AHBPnp *ahb_pnp = GRLIB_AHB_PNP(opaque);
|
||||
|
||||
return ahb_pnp->regs[offset >> 2];
|
||||
}
|
||||
|
||||
static const MemoryRegionOps grlib_ahb_pnp_ops = {
|
||||
.read = grlib_ahb_pnp_read,
|
||||
.endianness = DEVICE_BIG_ENDIAN,
|
||||
};
|
||||
|
||||
static void grlib_ahb_pnp_realize(DeviceState *dev, Error **errp)
|
||||
{
|
||||
AHBPnp *ahb_pnp = GRLIB_AHB_PNP(dev);
|
||||
SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
|
||||
|
||||
memory_region_init_io(&ahb_pnp->iomem, OBJECT(dev), &grlib_ahb_pnp_ops,
|
||||
ahb_pnp, TYPE_GRLIB_AHB_PNP, GRLIB_PNP_MAX_REGS);
|
||||
sysbus_init_mmio(sbd, &ahb_pnp->iomem);
|
||||
}
|
||||
|
||||
static void grlib_ahb_pnp_class_init(ObjectClass *klass, void *data)
|
||||
{
|
||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||
|
||||
dc->realize = grlib_ahb_pnp_realize;
|
||||
}
|
||||
|
||||
static const TypeInfo grlib_ahb_pnp_info = {
|
||||
.name = TYPE_GRLIB_AHB_PNP,
|
||||
.parent = TYPE_SYS_BUS_DEVICE,
|
||||
.instance_size = sizeof(AHBPnp),
|
||||
.class_init = grlib_ahb_pnp_class_init,
|
||||
};
|
||||
|
||||
/* APBPnp */
|
||||
|
||||
typedef struct APBPnp {
|
||||
SysBusDevice parent_obj;
|
||||
MemoryRegion iomem;
|
||||
|
||||
uint32_t regs[GRLIB_PNP_MAX_REGS >> 2];
|
||||
uint32_t entry_count;
|
||||
} APBPnp;
|
||||
|
||||
void grlib_apb_pnp_add_entry(APBPnp *dev, uint32_t address, uint32_t mask,
|
||||
uint8_t vendor, uint16_t device, uint8_t version,
|
||||
uint8_t irq, int type)
|
||||
{
|
||||
unsigned int reg_start;
|
||||
|
||||
/*
|
||||
* APB entries look like this:
|
||||
*
|
||||
* 31 -------- 23 -------- 11 ----- 9 ------- 4 --- 0
|
||||
* | VENDOR ID | DEVICE ID | IRQ ? | VERSION | IRQ |
|
||||
*
|
||||
* 31 ---------- 20 --- 15 ----------------- 3 ---- 0
|
||||
* | ADDR[20..8] | 0000 | MASK | TYPE |
|
||||
*/
|
||||
|
||||
assert(dev->entry_count < GRLIB_APB_MAX_DEV);
|
||||
reg_start = (dev->entry_count * GRLIB_APB_ENTRY_SIZE) >> 2;
|
||||
dev->entry_count++;
|
||||
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_VENDOR_SHIFT,
|
||||
GRLIB_PNP_VENDOR_SIZE,
|
||||
vendor);
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_DEV_SHIFT,
|
||||
GRLIB_PNP_DEV_SIZE,
|
||||
device);
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_VER_SHIFT,
|
||||
GRLIB_PNP_VER_SIZE,
|
||||
version);
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_IRQ_SHIFT,
|
||||
GRLIB_PNP_IRQ_SIZE,
|
||||
irq);
|
||||
reg_start += 1;
|
||||
dev->regs[reg_start] = type;
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_ADDR_SHIFT,
|
||||
GRLIB_PNP_ADDR_SIZE,
|
||||
extract32(address,
|
||||
GRLIB_APB_DEV_ADDR_SHIFT,
|
||||
GRLIB_APB_DEV_ADDR_SIZE));
|
||||
dev->regs[reg_start] = deposit32(dev->regs[reg_start],
|
||||
GRLIB_PNP_MASK_SHIFT,
|
||||
GRLIB_PNP_MASK_SIZE,
|
||||
mask);
|
||||
}
|
||||
|
||||
static uint64_t grlib_apb_pnp_read(void *opaque, hwaddr offset, unsigned size)
|
||||
{
|
||||
APBPnp *apb_pnp = GRLIB_APB_PNP(opaque);
|
||||
|
||||
return apb_pnp->regs[offset >> 2];
|
||||
}
|
||||
|
||||
static const MemoryRegionOps grlib_apb_pnp_ops = {
|
||||
.read = grlib_apb_pnp_read,
|
||||
.endianness = DEVICE_BIG_ENDIAN,
|
||||
};
|
||||
|
||||
static void grlib_apb_pnp_realize(DeviceState *dev, Error **errp)
|
||||
{
|
||||
APBPnp *apb_pnp = GRLIB_APB_PNP(dev);
|
||||
SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
|
||||
|
||||
memory_region_init_io(&apb_pnp->iomem, OBJECT(dev), &grlib_apb_pnp_ops,
|
||||
apb_pnp, TYPE_GRLIB_APB_PNP, GRLIB_PNP_MAX_REGS);
|
||||
sysbus_init_mmio(sbd, &apb_pnp->iomem);
|
||||
}
|
||||
|
||||
static void grlib_apb_pnp_class_init(ObjectClass *klass, void *data)
|
||||
{
|
||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||
|
||||
dc->realize = grlib_apb_pnp_realize;
|
||||
}
|
||||
|
||||
static const TypeInfo grlib_apb_pnp_info = {
|
||||
.name = TYPE_GRLIB_APB_PNP,
|
||||
.parent = TYPE_SYS_BUS_DEVICE,
|
||||
.instance_size = sizeof(APBPnp),
|
||||
.class_init = grlib_apb_pnp_class_init,
|
||||
};
|
||||
|
||||
static void grlib_ahb_apb_pnp_register_types(void)
|
||||
{
|
||||
type_register_static(&grlib_ahb_pnp_info);
|
||||
type_register_static(&grlib_apb_pnp_info);
|
||||
}
|
||||
|
||||
type_init(grlib_ahb_apb_pnp_register_types)
|
|
@ -39,6 +39,7 @@
|
|||
#include "exec/address-spaces.h"
|
||||
|
||||
#include "hw/sparc/grlib.h"
|
||||
#include "hw/misc/grlib_ahb_apb_pnp.h"
|
||||
|
||||
/* Default system clock. */
|
||||
#define CPU_CLK (40 * 1000 * 1000)
|
||||
|
@ -58,6 +59,9 @@
|
|||
#define LEON3_TIMER_IRQ (6)
|
||||
#define LEON3_TIMER_COUNT (2)
|
||||
|
||||
#define LEON3_APB_PNP_OFFSET (0x800FF000)
|
||||
#define LEON3_AHB_PNP_OFFSET (0xFFFFF000)
|
||||
|
||||
typedef struct ResetData {
|
||||
SPARCCPU *cpu;
|
||||
uint32_t entry; /* save kernel entry in case of reset */
|
||||
|
@ -187,6 +191,8 @@ static void leon3_generic_hw_init(MachineState *machine)
|
|||
ResetData *reset_info;
|
||||
DeviceState *dev;
|
||||
int i;
|
||||
AHBPnp *ahb_pnp;
|
||||
APBPnp *apb_pnp;
|
||||
|
||||
/* Init CPU */
|
||||
cpu = SPARC_CPU(cpu_create(machine->cpu_type));
|
||||
|
@ -200,6 +206,20 @@ static void leon3_generic_hw_init(MachineState *machine)
|
|||
reset_info->sp = LEON3_RAM_OFFSET + ram_size;
|
||||
qemu_register_reset(main_cpu_reset, reset_info);
|
||||
|
||||
ahb_pnp = GRLIB_AHB_PNP(object_new(TYPE_GRLIB_AHB_PNP));
|
||||
object_property_set_bool(OBJECT(ahb_pnp), true, "realized", &error_fatal);
|
||||
sysbus_mmio_map(SYS_BUS_DEVICE(ahb_pnp), 0, LEON3_AHB_PNP_OFFSET);
|
||||
grlib_ahb_pnp_add_entry(ahb_pnp, 0, 0, GRLIB_VENDOR_GAISLER,
|
||||
GRLIB_LEON3_DEV, GRLIB_AHB_MASTER,
|
||||
GRLIB_CPU_AREA);
|
||||
|
||||
apb_pnp = GRLIB_APB_PNP(object_new(TYPE_GRLIB_APB_PNP));
|
||||
object_property_set_bool(OBJECT(apb_pnp), true, "realized", &error_fatal);
|
||||
sysbus_mmio_map(SYS_BUS_DEVICE(apb_pnp), 0, LEON3_APB_PNP_OFFSET);
|
||||
grlib_ahb_pnp_add_entry(ahb_pnp, LEON3_APB_PNP_OFFSET, 0xFFF,
|
||||
GRLIB_VENDOR_GAISLER, GRLIB_APBMST_DEV,
|
||||
GRLIB_AHB_SLAVE, GRLIB_AHBMEM_AREA);
|
||||
|
||||
/* Allocate IRQ manager */
|
||||
dev = qdev_create(NULL, TYPE_GRLIB_IRQMP);
|
||||
qdev_prop_set_ptr(dev, "set_pil_in", leon3_set_pil_in);
|
||||
|
@ -209,6 +229,9 @@ static void leon3_generic_hw_init(MachineState *machine)
|
|||
env->irq_manager = dev;
|
||||
env->qemu_irq_ack = leon3_irq_manager;
|
||||
cpu_irqs = qemu_allocate_irqs(grlib_irqmp_set_irq, dev, MAX_PILS);
|
||||
grlib_apb_pnp_add_entry(apb_pnp, LEON3_IRQMP_OFFSET, 0xFFF,
|
||||
GRLIB_VENDOR_GAISLER, GRLIB_IRQMP_DEV,
|
||||
2, 0, GRLIB_APBIO_AREA);
|
||||
|
||||
/* Allocate RAM */
|
||||
if (ram_size > 1 * GiB) {
|
||||
|
@ -303,6 +326,10 @@ static void leon3_generic_hw_init(MachineState *machine)
|
|||
cpu_irqs[LEON3_TIMER_IRQ + i]);
|
||||
}
|
||||
|
||||
grlib_apb_pnp_add_entry(apb_pnp, LEON3_TIMER_OFFSET, 0xFFF,
|
||||
GRLIB_VENDOR_GAISLER, GRLIB_GPTIMER_DEV,
|
||||
0, LEON3_TIMER_IRQ, GRLIB_APBIO_AREA);
|
||||
|
||||
/* Allocate uart */
|
||||
if (serial_hd(0)) {
|
||||
dev = qdev_create(NULL, TYPE_GRLIB_APB_UART);
|
||||
|
@ -310,6 +337,9 @@ static void leon3_generic_hw_init(MachineState *machine)
|
|||
qdev_init_nofail(dev);
|
||||
sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, LEON3_UART_OFFSET);
|
||||
sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0, cpu_irqs[LEON3_UART_IRQ]);
|
||||
grlib_apb_pnp_add_entry(apb_pnp, LEON3_UART_OFFSET, 0xFFF,
|
||||
GRLIB_VENDOR_GAISLER, GRLIB_APBUART_DEV, 1,
|
||||
LEON3_UART_IRQ, GRLIB_APBIO_AREA);
|
||||
}
|
||||
}
|
||||
|
||||
|
|
60
include/hw/misc/grlib_ahb_apb_pnp.h
Normal file
60
include/hw/misc/grlib_ahb_apb_pnp.h
Normal file
|
@ -0,0 +1,60 @@
|
|||
/*
|
||||
* GRLIB AHB APB PNP
|
||||
*
|
||||
* Copyright (C) 2019 AdaCore
|
||||
*
|
||||
* Developed by :
|
||||
* Frederic Konrad <frederic.konrad@adacore.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along
|
||||
* with this program; if not, see <http://www.gnu.org/licenses/>.
|
||||
*
|
||||
*/
|
||||
|
||||
#ifndef GRLIB_AHB_APB_PNP_H
|
||||
#define GRLIB_AHB_APB_PNP_H
|
||||
|
||||
#define TYPE_GRLIB_AHB_PNP "grlib,ahbpnp"
|
||||
#define GRLIB_AHB_PNP(obj) \
|
||||
OBJECT_CHECK(AHBPnp, (obj), TYPE_GRLIB_AHB_PNP)
|
||||
typedef struct AHBPnp AHBPnp;
|
||||
|
||||
#define TYPE_GRLIB_APB_PNP "grlib,apbpnp"
|
||||
#define GRLIB_APB_PNP(obj) \
|
||||
OBJECT_CHECK(APBPnp, (obj), TYPE_GRLIB_APB_PNP)
|
||||
typedef struct APBPnp APBPnp;
|
||||
|
||||
void grlib_ahb_pnp_add_entry(AHBPnp *dev, uint32_t address, uint32_t mask,
|
||||
uint8_t vendor, uint16_t device, int slave,
|
||||
int type);
|
||||
void grlib_apb_pnp_add_entry(APBPnp *dev, uint32_t address, uint32_t mask,
|
||||
uint8_t vendor, uint16_t device, uint8_t version,
|
||||
uint8_t irq, int type);
|
||||
|
||||
/* VENDORS */
|
||||
#define GRLIB_VENDOR_GAISLER (0x01)
|
||||
/* DEVICES */
|
||||
#define GRLIB_LEON3_DEV (0x03)
|
||||
#define GRLIB_APBMST_DEV (0x06)
|
||||
#define GRLIB_APBUART_DEV (0x0C)
|
||||
#define GRLIB_IRQMP_DEV (0x0D)
|
||||
#define GRLIB_GPTIMER_DEV (0x11)
|
||||
/* TYPE */
|
||||
#define GRLIB_CPU_AREA (0x00)
|
||||
#define GRLIB_APBIO_AREA (0x01)
|
||||
#define GRLIB_AHBMEM_AREA (0x02)
|
||||
|
||||
#define GRLIB_AHB_MASTER (0x00)
|
||||
#define GRLIB_AHB_SLAVE (0x01)
|
||||
|
||||
#endif /* GRLIB_AHB_APB_PNP_H */
|
Loading…
Reference in a new issue