|
|
|
@@ -622,6 +622,372 @@ static int kvm_riscv_vcpu_set_reg_isa_ext(struct kvm_vcpu *vcpu,
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int copy_config_reg_indices(const struct kvm_vcpu *vcpu,
|
|
|
|
|
u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
int n = 0;
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < sizeof(struct kvm_riscv_config)/sizeof(unsigned long);
|
|
|
|
|
i++) {
|
|
|
|
|
u64 size;
|
|
|
|
|
u64 reg;
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Avoid reporting config reg if the corresponding extension
|
|
|
|
|
* was not available.
|
|
|
|
|
*/
|
|
|
|
|
if (i == KVM_REG_RISCV_CONFIG_REG(zicbom_block_size) &&
|
|
|
|
|
!riscv_isa_extension_available(vcpu->arch.isa, ZICBOM))
|
|
|
|
|
continue;
|
|
|
|
|
else if (i == KVM_REG_RISCV_CONFIG_REG(zicboz_block_size) &&
|
|
|
|
|
!riscv_isa_extension_available(vcpu->arch.isa, ZICBOZ))
|
|
|
|
|
continue;
|
|
|
|
|
|
|
|
|
|
size = IS_ENABLED(CONFIG_32BIT) ? KVM_REG_SIZE_U32 : KVM_REG_SIZE_U64;
|
|
|
|
|
reg = KVM_REG_RISCV | size | KVM_REG_RISCV_CONFIG | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
n++;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return n;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static unsigned long num_config_regs(const struct kvm_vcpu *vcpu)
|
|
|
|
|
{
|
|
|
|
|
return copy_config_reg_indices(vcpu, NULL);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline unsigned long num_core_regs(void)
|
|
|
|
|
{
|
|
|
|
|
return sizeof(struct kvm_riscv_core) / sizeof(unsigned long);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int copy_core_reg_indices(u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
int n = num_core_regs();
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < n; i++) {
|
|
|
|
|
u64 size = IS_ENABLED(CONFIG_32BIT) ?
|
|
|
|
|
KVM_REG_SIZE_U32 : KVM_REG_SIZE_U64;
|
|
|
|
|
u64 reg = KVM_REG_RISCV | size | KVM_REG_RISCV_CORE | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return n;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline unsigned long num_csr_regs(const struct kvm_vcpu *vcpu)
|
|
|
|
|
{
|
|
|
|
|
unsigned long n = sizeof(struct kvm_riscv_csr) / sizeof(unsigned long);
|
|
|
|
|
|
|
|
|
|
if (riscv_isa_extension_available(vcpu->arch.isa, SSAIA))
|
|
|
|
|
n += sizeof(struct kvm_riscv_aia_csr) / sizeof(unsigned long);
|
|
|
|
|
|
|
|
|
|
return n;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int copy_csr_reg_indices(const struct kvm_vcpu *vcpu,
|
|
|
|
|
u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
int n1 = sizeof(struct kvm_riscv_csr) / sizeof(unsigned long);
|
|
|
|
|
int n2 = 0;
|
|
|
|
|
|
|
|
|
|
/* copy general csr regs */
|
|
|
|
|
for (int i = 0; i < n1; i++) {
|
|
|
|
|
u64 size = IS_ENABLED(CONFIG_32BIT) ?
|
|
|
|
|
KVM_REG_SIZE_U32 : KVM_REG_SIZE_U64;
|
|
|
|
|
u64 reg = KVM_REG_RISCV | size | KVM_REG_RISCV_CSR |
|
|
|
|
|
KVM_REG_RISCV_CSR_GENERAL | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* copy AIA csr regs */
|
|
|
|
|
if (riscv_isa_extension_available(vcpu->arch.isa, SSAIA)) {
|
|
|
|
|
n2 = sizeof(struct kvm_riscv_aia_csr) / sizeof(unsigned long);
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < n2; i++) {
|
|
|
|
|
u64 size = IS_ENABLED(CONFIG_32BIT) ?
|
|
|
|
|
KVM_REG_SIZE_U32 : KVM_REG_SIZE_U64;
|
|
|
|
|
u64 reg = KVM_REG_RISCV | size | KVM_REG_RISCV_CSR |
|
|
|
|
|
KVM_REG_RISCV_CSR_AIA | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return n1 + n2;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline unsigned long num_timer_regs(void)
|
|
|
|
|
{
|
|
|
|
|
return sizeof(struct kvm_riscv_timer) / sizeof(u64);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int copy_timer_reg_indices(u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
int n = num_timer_regs();
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < n; i++) {
|
|
|
|
|
u64 reg = KVM_REG_RISCV | KVM_REG_SIZE_U64 |
|
|
|
|
|
KVM_REG_RISCV_TIMER | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return n;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline unsigned long num_fp_f_regs(const struct kvm_vcpu *vcpu)
|
|
|
|
|
{
|
|
|
|
|
const struct kvm_cpu_context *cntx = &vcpu->arch.guest_context;
|
|
|
|
|
|
|
|
|
|
if (riscv_isa_extension_available(vcpu->arch.isa, f))
|
|
|
|
|
return sizeof(cntx->fp.f) / sizeof(u32);
|
|
|
|
|
else
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int copy_fp_f_reg_indices(const struct kvm_vcpu *vcpu,
|
|
|
|
|
u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
int n = num_fp_f_regs(vcpu);
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < n; i++) {
|
|
|
|
|
u64 reg = KVM_REG_RISCV | KVM_REG_SIZE_U32 |
|
|
|
|
|
KVM_REG_RISCV_FP_F | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return n;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline unsigned long num_fp_d_regs(const struct kvm_vcpu *vcpu)
|
|
|
|
|
{
|
|
|
|
|
const struct kvm_cpu_context *cntx = &vcpu->arch.guest_context;
|
|
|
|
|
|
|
|
|
|
if (riscv_isa_extension_available(vcpu->arch.isa, d))
|
|
|
|
|
return sizeof(cntx->fp.d.f) / sizeof(u64) + 1;
|
|
|
|
|
else
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int copy_fp_d_reg_indices(const struct kvm_vcpu *vcpu,
|
|
|
|
|
u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
int i;
|
|
|
|
|
int n = num_fp_d_regs(vcpu);
|
|
|
|
|
u64 reg;
|
|
|
|
|
|
|
|
|
|
/* copy fp.d.f indices */
|
|
|
|
|
for (i = 0; i < n-1; i++) {
|
|
|
|
|
reg = KVM_REG_RISCV | KVM_REG_SIZE_U64 |
|
|
|
|
|
KVM_REG_RISCV_FP_D | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* copy fp.d.fcsr indices */
|
|
|
|
|
reg = KVM_REG_RISCV | KVM_REG_SIZE_U32 | KVM_REG_RISCV_FP_D | i;
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return n;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int copy_isa_ext_reg_indices(const struct kvm_vcpu *vcpu,
|
|
|
|
|
u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
unsigned int n = 0;
|
|
|
|
|
unsigned long isa_ext;
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < KVM_RISCV_ISA_EXT_MAX; i++) {
|
|
|
|
|
u64 size = IS_ENABLED(CONFIG_32BIT) ?
|
|
|
|
|
KVM_REG_SIZE_U32 : KVM_REG_SIZE_U64;
|
|
|
|
|
u64 reg = KVM_REG_RISCV | size | KVM_REG_RISCV_ISA_EXT | i;
|
|
|
|
|
|
|
|
|
|
isa_ext = kvm_isa_ext_arr[i];
|
|
|
|
|
if (!__riscv_isa_extension_available(vcpu->arch.isa, isa_ext))
|
|
|
|
|
continue;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
n++;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return n;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline unsigned long num_isa_ext_regs(const struct kvm_vcpu *vcpu)
|
|
|
|
|
{
|
|
|
|
|
return copy_isa_ext_reg_indices(vcpu, NULL);;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline unsigned long num_sbi_ext_regs(void)
|
|
|
|
|
{
|
|
|
|
|
/*
|
|
|
|
|
* number of KVM_REG_RISCV_SBI_SINGLE +
|
|
|
|
|
* 2 x (number of KVM_REG_RISCV_SBI_MULTI)
|
|
|
|
|
*/
|
|
|
|
|
return KVM_RISCV_SBI_EXT_MAX + 2*(KVM_REG_RISCV_SBI_MULTI_REG_LAST+1);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int copy_sbi_ext_reg_indices(u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
int n;
|
|
|
|
|
|
|
|
|
|
/* copy KVM_REG_RISCV_SBI_SINGLE */
|
|
|
|
|
n = KVM_RISCV_SBI_EXT_MAX;
|
|
|
|
|
for (int i = 0; i < n; i++) {
|
|
|
|
|
u64 size = IS_ENABLED(CONFIG_32BIT) ?
|
|
|
|
|
KVM_REG_SIZE_U32 : KVM_REG_SIZE_U64;
|
|
|
|
|
u64 reg = KVM_REG_RISCV | size | KVM_REG_RISCV_SBI_EXT |
|
|
|
|
|
KVM_REG_RISCV_SBI_SINGLE | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* copy KVM_REG_RISCV_SBI_MULTI */
|
|
|
|
|
n = KVM_REG_RISCV_SBI_MULTI_REG_LAST + 1;
|
|
|
|
|
for (int i = 0; i < n; i++) {
|
|
|
|
|
u64 size = IS_ENABLED(CONFIG_32BIT) ?
|
|
|
|
|
KVM_REG_SIZE_U32 : KVM_REG_SIZE_U64;
|
|
|
|
|
u64 reg = KVM_REG_RISCV | size | KVM_REG_RISCV_SBI_EXT |
|
|
|
|
|
KVM_REG_RISCV_SBI_MULTI_EN | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
reg = KVM_REG_RISCV | size | KVM_REG_RISCV_SBI_EXT |
|
|
|
|
|
KVM_REG_RISCV_SBI_MULTI_DIS | i;
|
|
|
|
|
|
|
|
|
|
if (uindices) {
|
|
|
|
|
if (put_user(reg, uindices))
|
|
|
|
|
return -EFAULT;
|
|
|
|
|
uindices++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return num_sbi_ext_regs();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* kvm_riscv_vcpu_num_regs - how many registers do we present via KVM_GET/SET_ONE_REG
|
|
|
|
|
*
|
|
|
|
|
* This is for all registers.
|
|
|
|
|
*/
|
|
|
|
|
unsigned long kvm_riscv_vcpu_num_regs(struct kvm_vcpu *vcpu)
|
|
|
|
|
{
|
|
|
|
|
unsigned long res = 0;
|
|
|
|
|
|
|
|
|
|
res += num_config_regs(vcpu);
|
|
|
|
|
res += num_core_regs();
|
|
|
|
|
res += num_csr_regs(vcpu);
|
|
|
|
|
res += num_timer_regs();
|
|
|
|
|
res += num_fp_f_regs(vcpu);
|
|
|
|
|
res += num_fp_d_regs(vcpu);
|
|
|
|
|
res += num_isa_ext_regs(vcpu);
|
|
|
|
|
res += num_sbi_ext_regs();
|
|
|
|
|
|
|
|
|
|
return res;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* kvm_riscv_vcpu_copy_reg_indices - get indices of all registers.
|
|
|
|
|
*/
|
|
|
|
|
int kvm_riscv_vcpu_copy_reg_indices(struct kvm_vcpu *vcpu,
|
|
|
|
|
u64 __user *uindices)
|
|
|
|
|
{
|
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
|
|
ret = copy_config_reg_indices(vcpu, uindices);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
uindices += ret;
|
|
|
|
|
|
|
|
|
|
ret = copy_core_reg_indices(uindices);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
uindices += ret;
|
|
|
|
|
|
|
|
|
|
ret = copy_csr_reg_indices(vcpu, uindices);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
uindices += ret;
|
|
|
|
|
|
|
|
|
|
ret = copy_timer_reg_indices(uindices);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
uindices += ret;
|
|
|
|
|
|
|
|
|
|
ret = copy_fp_f_reg_indices(vcpu, uindices);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
uindices += ret;
|
|
|
|
|
|
|
|
|
|
ret = copy_fp_d_reg_indices(vcpu, uindices);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
uindices += ret;
|
|
|
|
|
|
|
|
|
|
ret = copy_isa_ext_reg_indices(vcpu, uindices);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
uindices += ret;
|
|
|
|
|
|
|
|
|
|
ret = copy_sbi_ext_reg_indices(uindices);
|
|
|
|
|
if (ret < 0)
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int kvm_riscv_vcpu_set_reg(struct kvm_vcpu *vcpu,
|
|
|
|
|
const struct kvm_one_reg *reg)
|
|
|
|
|
{
|
|
|
|
|