Browse Source
Add RISC-V implementation of the Cluster Power Controller (CPC) device. It is based on the existing MIPS CPC implementations but adapted for RISC-V systems. The CPC device manages power control for CPU clusters in RISC-V systems. This is needed for the MIPS BOSTON AIA board. Signed-off-by: Chao-ying Fu <cfu@mips.com> Signed-off-by: Djordje Todorovic <djordje.todorovic@htecgroup.com> Reviewed-by: Daniel Henrique Barboza <dbarboza@ventanamicro.com> Message-ID: <20260108134128.2218102-9-djordje.todorovic@htecgroup.com> Signed-off-by: Alistair Francis <alistair.francis@wdc.com>pull/316/head
committed by
Alistair Francis
4 changed files with 334 additions and 0 deletions
@ -0,0 +1,265 @@ |
|||
/*
|
|||
* Cluster Power Controller emulation |
|||
* |
|||
* Copyright (c) 2016 Imagination Technologies |
|||
* |
|||
* Copyright (c) 2025 MIPS |
|||
* |
|||
* SPDX-License-Identifier: GPL-2.0-or-later |
|||
* |
|||
* Reference: MIPS P8700 documentation |
|||
* (https://mips.com/products/hardware/p8700/)
|
|||
*/ |
|||
|
|||
#include "qemu/osdep.h" |
|||
#include "qapi/error.h" |
|||
#include "cpu.h" |
|||
#include "qemu/log.h" |
|||
#include "qemu/module.h" |
|||
#include "qemu/timer.h" |
|||
#include "qemu/bitops.h" |
|||
#include "hw/core/sysbus.h" |
|||
#include "migration/vmstate.h" |
|||
|
|||
#include "hw/misc/riscv_cpc.h" |
|||
#include "hw/core/qdev-properties.h" |
|||
#include "hw/intc/riscv_aclint.h" |
|||
#include "hw/core/resettable.h" |
|||
|
|||
static inline uint64_t cpc_vp_run_mask(RISCVCPCState *cpc) |
|||
{ |
|||
return MAKE_64BIT_MASK(0, cpc->num_vp); |
|||
} |
|||
|
|||
static void riscv_cpu_reset_async_work(CPUState *cs, run_on_cpu_data data) |
|||
{ |
|||
RISCVCPCState *cpc = (RISCVCPCState *) data.host_ptr; |
|||
int i; |
|||
|
|||
cpu_reset(cs); |
|||
cs->halted = 0; |
|||
|
|||
/* Find this CPU's index in the CPC's CPU array */ |
|||
for (i = 0; i < cpc->num_vp; i++) { |
|||
if (cpc->cpus[i] == cs) { |
|||
cpc->vps_running_mask |= BIT_ULL(i); |
|||
break; |
|||
} |
|||
} |
|||
} |
|||
|
|||
static void cpc_run_vp(RISCVCPCState *cpc, uint64_t vps_run_mask) |
|||
{ |
|||
int vp; |
|||
|
|||
for (vp = 0; vp < cpc->num_vp; vp++) { |
|||
CPUState *cs = cpc->cpus[vp]; |
|||
|
|||
if (!extract64(vps_run_mask, vp, 1)) { |
|||
continue; |
|||
} |
|||
|
|||
if (extract64(cpc->vps_running_mask, vp, 1)) { |
|||
continue; |
|||
} |
|||
|
|||
/*
|
|||
* To avoid racing with a CPU we are just kicking off. |
|||
* We do the final bit of preparation for the work in |
|||
* the target CPUs context. |
|||
*/ |
|||
async_safe_run_on_cpu(cs, riscv_cpu_reset_async_work, |
|||
RUN_ON_CPU_HOST_PTR(cpc)); |
|||
} |
|||
} |
|||
|
|||
static void cpc_stop_vp(RISCVCPCState *cpc, uint64_t vps_stop_mask) |
|||
{ |
|||
int vp; |
|||
|
|||
for (vp = 0; vp < cpc->num_vp; vp++) { |
|||
CPUState *cs = cpc->cpus[vp]; |
|||
|
|||
if (!extract64(vps_stop_mask, vp, 1)) { |
|||
continue; |
|||
} |
|||
|
|||
if (!extract64(cpc->vps_running_mask, vp, 1)) { |
|||
continue; |
|||
} |
|||
|
|||
cpu_interrupt(cs, CPU_INTERRUPT_HALT); |
|||
cpc->vps_running_mask &= ~BIT_ULL(vp); |
|||
} |
|||
} |
|||
|
|||
static void cpc_write(void *opaque, hwaddr offset, uint64_t data, |
|||
unsigned size) |
|||
{ |
|||
RISCVCPCState *s = opaque; |
|||
int cpu_index, c; |
|||
|
|||
for (c = 0; c < s->num_core; c++) { |
|||
cpu_index = c * s->num_hart + |
|||
s->cluster_id * s->num_core * s->num_hart; |
|||
if (offset == |
|||
CPC_CL_BASE_OFS + CPC_VP_RUN_OFS + c * CPC_CORE_REG_STRIDE) { |
|||
cpc_run_vp(s, (data << cpu_index) & cpc_vp_run_mask(s)); |
|||
return; |
|||
} |
|||
if (offset == |
|||
CPC_CL_BASE_OFS + CPC_VP_STOP_OFS + c * CPC_CORE_REG_STRIDE) { |
|||
cpc_stop_vp(s, (data << cpu_index) & cpc_vp_run_mask(s)); |
|||
return; |
|||
} |
|||
} |
|||
|
|||
switch (offset) { |
|||
default: |
|||
qemu_log_mask(LOG_UNIMP, |
|||
"%s: Bad offset 0x%x\n", __func__, (int)offset); |
|||
break; |
|||
} |
|||
|
|||
return; |
|||
} |
|||
|
|||
static uint64_t cpc_read(void *opaque, hwaddr offset, unsigned size) |
|||
{ |
|||
RISCVCPCState *s = opaque; |
|||
int c; |
|||
|
|||
for (c = 0; c < s->num_core; c++) { |
|||
if (offset == |
|||
CPC_CL_BASE_OFS + CPC_STAT_CONF_OFS + c * CPC_CORE_REG_STRIDE) { |
|||
/* Return the state as U6. */ |
|||
return CPC_Cx_STAT_CONF_SEQ_STATE_U6; |
|||
} |
|||
} |
|||
|
|||
switch (offset) { |
|||
case CPC_CM_STAT_CONF_OFS: |
|||
return CPC_Cx_STAT_CONF_SEQ_STATE_U5; |
|||
case CPC_MTIME_REG_OFS: |
|||
return muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), |
|||
RISCV_ACLINT_DEFAULT_TIMEBASE_FREQ, |
|||
NANOSECONDS_PER_SECOND); |
|||
return 0; |
|||
default: |
|||
qemu_log_mask(LOG_UNIMP, |
|||
"%s: Bad offset 0x%x\n", __func__, (int)offset); |
|||
return 0; |
|||
} |
|||
} |
|||
|
|||
static const MemoryRegionOps cpc_ops = { |
|||
.read = cpc_read, |
|||
.write = cpc_write, |
|||
.endianness = DEVICE_LITTLE_ENDIAN, |
|||
.impl = { |
|||
.min_access_size = 8, |
|||
}, |
|||
}; |
|||
|
|||
static void riscv_cpc_init(Object *obj) |
|||
{ |
|||
SysBusDevice *sbd = SYS_BUS_DEVICE(obj); |
|||
RISCVCPCState *s = RISCV_CPC(obj); |
|||
int i; |
|||
|
|||
memory_region_init_io(&s->mr, OBJECT(s), &cpc_ops, s, "xmips-cpc", |
|||
CPC_ADDRSPACE_SZ); |
|||
sysbus_init_mmio(sbd, &s->mr); |
|||
|
|||
/* Allocate CPU array */ |
|||
s->cpus = g_new0(CPUState *, CPC_MAX_VPS); |
|||
|
|||
/* Create link properties for each possible CPU slot */ |
|||
for (i = 0; i < CPC_MAX_VPS; i++) { |
|||
char *propname = g_strdup_printf("cpu[%d]", i); |
|||
object_property_add_link(obj, propname, TYPE_CPU, |
|||
(Object **)&s->cpus[i], |
|||
qdev_prop_allow_set_link_before_realize, |
|||
OBJ_PROP_LINK_STRONG); |
|||
g_free(propname); |
|||
} |
|||
} |
|||
|
|||
static void riscv_cpc_realize(DeviceState *dev, Error **errp) |
|||
{ |
|||
RISCVCPCState *s = RISCV_CPC(dev); |
|||
int i; |
|||
|
|||
if (s->vps_start_running_mask & ~cpc_vp_run_mask(s)) { |
|||
error_setg(errp, |
|||
"incorrect vps-start-running-mask 0x%" PRIx64 |
|||
" for num_vp = %d", |
|||
s->vps_start_running_mask, s->num_vp); |
|||
return; |
|||
} |
|||
|
|||
/* Verify that required CPUs have been linked */ |
|||
for (i = 0; i < s->num_vp; i++) { |
|||
if (!s->cpus[i]) { |
|||
error_setg(errp, "CPU %d has not been linked", i); |
|||
return; |
|||
} |
|||
} |
|||
} |
|||
|
|||
static void riscv_cpc_reset_hold(Object *obj, ResetType type) |
|||
{ |
|||
RISCVCPCState *s = RISCV_CPC(obj); |
|||
|
|||
/* Reflect the fact that all VPs are halted on reset */ |
|||
s->vps_running_mask = 0; |
|||
|
|||
/* Put selected VPs into run state */ |
|||
cpc_run_vp(s, s->vps_start_running_mask); |
|||
} |
|||
|
|||
static const VMStateDescription vmstate_riscv_cpc = { |
|||
.name = "xmips-cpc", |
|||
.version_id = 0, |
|||
.minimum_version_id = 0, |
|||
.fields = (VMStateField[]) { |
|||
VMSTATE_UINT64(vps_running_mask, RISCVCPCState), |
|||
VMSTATE_END_OF_LIST() |
|||
}, |
|||
}; |
|||
|
|||
static const Property riscv_cpc_properties[] = { |
|||
DEFINE_PROP_UINT32("cluster-id", RISCVCPCState, cluster_id, 0x0), |
|||
DEFINE_PROP_UINT32("num-vp", RISCVCPCState, num_vp, 0x1), |
|||
DEFINE_PROP_UINT32("num-hart", RISCVCPCState, num_hart, 0x1), |
|||
DEFINE_PROP_UINT32("num-core", RISCVCPCState, num_core, 0x1), |
|||
DEFINE_PROP_UINT64("vps-start-running-mask", RISCVCPCState, |
|||
vps_start_running_mask, 0x1), |
|||
}; |
|||
|
|||
static void riscv_cpc_class_init(ObjectClass *klass, const void *data) |
|||
{ |
|||
DeviceClass *dc = DEVICE_CLASS(klass); |
|||
ResettableClass *rc = RESETTABLE_CLASS(klass); |
|||
|
|||
dc->realize = riscv_cpc_realize; |
|||
rc->phases.hold = riscv_cpc_reset_hold; |
|||
dc->vmsd = &vmstate_riscv_cpc; |
|||
device_class_set_props(dc, riscv_cpc_properties); |
|||
dc->user_creatable = false; |
|||
} |
|||
|
|||
static const TypeInfo riscv_cpc_info = { |
|||
.name = TYPE_RISCV_CPC, |
|||
.parent = TYPE_SYS_BUS_DEVICE, |
|||
.instance_size = sizeof(RISCVCPCState), |
|||
.instance_init = riscv_cpc_init, |
|||
.class_init = riscv_cpc_class_init, |
|||
}; |
|||
|
|||
static void riscv_cpc_register_types(void) |
|||
{ |
|||
type_register_static(&riscv_cpc_info); |
|||
} |
|||
|
|||
type_init(riscv_cpc_register_types) |
|||
@ -0,0 +1,64 @@ |
|||
/*
|
|||
* Cluster Power Controller emulation |
|||
* |
|||
* Copyright (c) 2016 Imagination Technologies |
|||
* |
|||
* Copyright (c) 2025 MIPS |
|||
* |
|||
* SPDX-License-Identifier: GPL-2.0-or-later |
|||
* |
|||
*/ |
|||
|
|||
#ifndef RISCV_CPC_H |
|||
#define RISCV_CPC_H |
|||
|
|||
#include "hw/core/sysbus.h" |
|||
#include "qom/object.h" |
|||
|
|||
#define CPC_ADDRSPACE_SZ 0x6000 |
|||
|
|||
/* CPC global register offsets relative to base address */ |
|||
#define CPC_MTIME_REG_OFS 0x50 |
|||
|
|||
#define CPC_CM_STAT_CONF_OFS 0x1008 |
|||
|
|||
/* CPC blocks offsets relative to base address */ |
|||
#define CPC_CL_BASE_OFS 0x2000 |
|||
#define CPC_CORE_REG_STRIDE 0x100 /* Stride between core-specific registers */ |
|||
|
|||
/* CPC register offsets relative to block offsets */ |
|||
#define CPC_STAT_CONF_OFS 0x08 |
|||
#define CPC_VP_STOP_OFS 0x20 |
|||
#define CPC_VP_RUN_OFS 0x28 |
|||
#define CPC_VP_RUNNING_OFS 0x30 |
|||
|
|||
#define SEQ_STATE_BIT 19 |
|||
#define SEQ_STATE_U5 0x6 |
|||
#define SEQ_STATE_U6 0x7 |
|||
#define CPC_Cx_STAT_CONF_SEQ_STATE_U5 (SEQ_STATE_U5 << SEQ_STATE_BIT) |
|||
#define CPC_Cx_STAT_CONF_SEQ_STATE_U6 (SEQ_STATE_U6 << SEQ_STATE_BIT) |
|||
|
|||
#define TYPE_RISCV_CPC "xmips-cpc" |
|||
OBJECT_DECLARE_SIMPLE_TYPE(RISCVCPCState, RISCV_CPC) |
|||
|
|||
typedef struct RISCVCPCState { |
|||
SysBusDevice parent_obj; |
|||
|
|||
uint32_t cluster_id; |
|||
uint32_t num_vp; |
|||
uint32_t num_hart; |
|||
uint32_t num_core; |
|||
/* VPs running from restart mask */ |
|||
uint64_t vps_start_running_mask; |
|||
|
|||
MemoryRegion mr; |
|||
/* Indicates which VPs are in the run state mask */ |
|||
uint64_t vps_running_mask; |
|||
|
|||
/* Array of CPUs managed by this CPC */ |
|||
CPUState **cpus; |
|||
} RISCVCPCState; |
|||
|
|||
#define CPC_MAX_VPS 64 /* Maximum number of VPs supported */ |
|||
|
|||
#endif /* RISCV_CPC_H */ |
|||
Loading…
Reference in new issue