target/arm: Add aa{32, 64}_vfp_{dreg, qreg} helpers

Helpers that return a pointer into env->vfp.regs so that we isolate
the logic of how to index the regs array for different cpu modes.

Signed-off-by: Richard Henderson <richard.henderson@linaro.org>
Message-id: 20180119045438.28582-7-richard.henderson@linaro.org
Reviewed-by: Alex Bennée <alex.bennee@linaro.org>
Signed-off-by: Peter Maydell <peter.maydell@linaro.org>
This commit is contained in:
Richard Henderson 2018-01-25 11:45:29 +00:00 committed by Peter Maydell
parent 3f68b8a5a6
commit 9a2b5256ea
9 changed files with 96 additions and 74 deletions

View File

@ -1487,12 +1487,13 @@ static int target_setup_sigframe(struct target_rt_sigframe *sf,
} }
for (i = 0; i < 32; i++) { for (i = 0; i < 32; i++) {
uint64_t *q = aa64_vfp_qreg(env, i);
#ifdef TARGET_WORDS_BIGENDIAN #ifdef TARGET_WORDS_BIGENDIAN
__put_user(env->vfp.regs[i * 2], &aux->fpsimd.vregs[i * 2 + 1]); __put_user(q[0], &aux->fpsimd.vregs[i * 2 + 1]);
__put_user(env->vfp.regs[i * 2 + 1], &aux->fpsimd.vregs[i * 2]); __put_user(q[1], &aux->fpsimd.vregs[i * 2]);
#else #else
__put_user(env->vfp.regs[i * 2], &aux->fpsimd.vregs[i * 2]); __put_user(q[0], &aux->fpsimd.vregs[i * 2]);
__put_user(env->vfp.regs[i * 2 + 1], &aux->fpsimd.vregs[i * 2 + 1]); __put_user(q[1], &aux->fpsimd.vregs[i * 2 + 1]);
#endif #endif
} }
__put_user(vfp_get_fpsr(env), &aux->fpsimd.fpsr); __put_user(vfp_get_fpsr(env), &aux->fpsimd.fpsr);
@ -1539,12 +1540,13 @@ static int target_restore_sigframe(CPUARMState *env,
} }
for (i = 0; i < 32; i++) { for (i = 0; i < 32; i++) {
uint64_t *q = aa64_vfp_qreg(env, i);
#ifdef TARGET_WORDS_BIGENDIAN #ifdef TARGET_WORDS_BIGENDIAN
__get_user(env->vfp.regs[i * 2], &aux->fpsimd.vregs[i * 2 + 1]); __get_user(q[0], &aux->fpsimd.vregs[i * 2 + 1]);
__get_user(env->vfp.regs[i * 2 + 1], &aux->fpsimd.vregs[i * 2]); __get_user(q[1], &aux->fpsimd.vregs[i * 2]);
#else #else
__get_user(env->vfp.regs[i * 2], &aux->fpsimd.vregs[i * 2]); __get_user(q[0], &aux->fpsimd.vregs[i * 2]);
__get_user(env->vfp.regs[i * 2 + 1], &aux->fpsimd.vregs[i * 2 + 1]); __get_user(q[1], &aux->fpsimd.vregs[i * 2 + 1]);
#endif #endif
} }
__get_user(fpsr, &aux->fpsimd.fpsr); __get_user(fpsr, &aux->fpsimd.fpsr);
@ -1903,7 +1905,7 @@ static abi_ulong *setup_sigframe_v2_vfp(abi_ulong *regspace, CPUARMState *env)
__put_user(TARGET_VFP_MAGIC, &vfpframe->magic); __put_user(TARGET_VFP_MAGIC, &vfpframe->magic);
__put_user(sizeof(*vfpframe), &vfpframe->size); __put_user(sizeof(*vfpframe), &vfpframe->size);
for (i = 0; i < 32; i++) { for (i = 0; i < 32; i++) {
__put_user(float64_val(env->vfp.regs[i]), &vfpframe->ufp.fpregs[i]); __put_user(*aa32_vfp_dreg(env, i), &vfpframe->ufp.fpregs[i]);
} }
__put_user(vfp_get_fpscr(env), &vfpframe->ufp.fpscr); __put_user(vfp_get_fpscr(env), &vfpframe->ufp.fpscr);
__put_user(env->vfp.xregs[ARM_VFP_FPEXC], &vfpframe->ufp_exc.fpexc); __put_user(env->vfp.xregs[ARM_VFP_FPEXC], &vfpframe->ufp_exc.fpexc);
@ -2210,7 +2212,7 @@ static abi_ulong *restore_sigframe_v2_vfp(CPUARMState *env, abi_ulong *regspace)
return 0; return 0;
} }
for (i = 0; i < 32; i++) { for (i = 0; i < 32; i++) {
__get_user(float64_val(env->vfp.regs[i]), &vfpframe->ufp.fpregs[i]); __get_user(*aa32_vfp_dreg(env, i), &vfpframe->ufp.fpregs[i]);
} }
__get_user(fpscr, &vfpframe->ufp.fpscr); __get_user(fpscr, &vfpframe->ufp.fpscr);
vfp_set_fpscr(env, fpscr); vfp_set_fpscr(env, fpscr);

View File

@ -99,8 +99,10 @@ static int aarch64_write_elf64_prfpreg(WriteCoreDumpFunction f,
aarch64_note_init(&note, s, "CORE", 5, NT_PRFPREG, sizeof(note.vfp)); aarch64_note_init(&note, s, "CORE", 5, NT_PRFPREG, sizeof(note.vfp));
for (i = 0; i < 64; ++i) { for (i = 0; i < 32; ++i) {
note.vfp.vregs[i] = cpu_to_dump64(s, env->vfp.regs[i]); uint64_t *q = aa64_vfp_qreg(env, i);
note.vfp.vregs[2*i + 0] = cpu_to_dump64(s, q[0]);
note.vfp.vregs[2*i + 1] = cpu_to_dump64(s, q[1]);
} }
if (s->dump_info.d_endian == ELFDATA2MSB) { if (s->dump_info.d_endian == ELFDATA2MSB) {
@ -229,7 +231,7 @@ static int arm_write_elf32_vfp(WriteCoreDumpFunction f, CPUARMState *env,
arm_note_init(&note, s, "LINUX", 6, NT_ARM_VFP, sizeof(note.vfp)); arm_note_init(&note, s, "LINUX", 6, NT_ARM_VFP, sizeof(note.vfp));
for (i = 0; i < 32; ++i) { for (i = 0; i < 32; ++i) {
note.vfp.vregs[i] = cpu_to_dump64(s, env->vfp.regs[i]); note.vfp.vregs[i] = cpu_to_dump64(s, *aa32_vfp_dreg(env, i));
} }
note.vfp.fpscr = cpu_to_dump32(s, vfp_get_fpscr(env)); note.vfp.fpscr = cpu_to_dump32(s, vfp_get_fpscr(env));

View File

@ -2885,4 +2885,31 @@ static inline void *arm_get_el_change_hook_opaque(ARMCPU *cpu)
return cpu->el_change_hook_opaque; return cpu->el_change_hook_opaque;
} }
/**
* aa32_vfp_dreg:
* Return a pointer to the Dn register within env in 32-bit mode.
*/
static inline uint64_t *aa32_vfp_dreg(CPUARMState *env, unsigned regno)
{
return &env->vfp.regs[regno];
}
/**
* aa32_vfp_qreg:
* Return a pointer to the Qn register within env in 32-bit mode.
*/
static inline uint64_t *aa32_vfp_qreg(CPUARMState *env, unsigned regno)
{
return &env->vfp.regs[2 * regno];
}
/**
* aa64_vfp_qreg:
* Return a pointer to the Qn register within env in 64-bit mode.
*/
static inline uint64_t *aa64_vfp_qreg(CPUARMState *env, unsigned regno)
{
return &env->vfp.regs[2 * regno];
}
#endif #endif

View File

@ -153,13 +153,14 @@ uint64_t HELPER(simd_tbl)(CPUARMState *env, uint64_t result, uint64_t indices,
if (index < 16 * numregs) { if (index < 16 * numregs) {
/* Convert index (a byte offset into the virtual table /* Convert index (a byte offset into the virtual table
* which is a series of 128-bit vectors concatenated) * which is a series of 128-bit vectors concatenated)
* into the correct vfp.regs[] element plus a bit offset * into the correct register element plus a bit offset
* into that element, bearing in mind that the table * into that element, bearing in mind that the table
* can wrap around from V31 to V0. * can wrap around from V31 to V0.
*/ */
int elt = (rn * 2 + (index >> 3)) % 64; int elt = (rn * 2 + (index >> 3)) % 64;
int bitidx = (index & 7) * 8; int bitidx = (index & 7) * 8;
uint64_t val = extract64(env->vfp.regs[elt], bitidx, 8); uint64_t *q = aa64_vfp_qreg(env, elt >> 1);
uint64_t val = extract64(q[elt & 1], bitidx, 8);
result = deposit64(result, shift, 8, val); result = deposit64(result, shift, 8, val);
} }

View File

@ -64,15 +64,16 @@ static int vfp_gdb_get_reg(CPUARMState *env, uint8_t *buf, int reg)
/* VFP data registers are always little-endian. */ /* VFP data registers are always little-endian. */
nregs = arm_feature(env, ARM_FEATURE_VFP3) ? 32 : 16; nregs = arm_feature(env, ARM_FEATURE_VFP3) ? 32 : 16;
if (reg < nregs) { if (reg < nregs) {
stq_le_p(buf, env->vfp.regs[reg]); stq_le_p(buf, *aa32_vfp_dreg(env, reg));
return 8; return 8;
} }
if (arm_feature(env, ARM_FEATURE_NEON)) { if (arm_feature(env, ARM_FEATURE_NEON)) {
/* Aliases for Q regs. */ /* Aliases for Q regs. */
nregs += 16; nregs += 16;
if (reg < nregs) { if (reg < nregs) {
stq_le_p(buf, env->vfp.regs[(reg - 32) * 2]); uint64_t *q = aa32_vfp_qreg(env, reg - 32);
stq_le_p(buf + 8, env->vfp.regs[(reg - 32) * 2 + 1]); stq_le_p(buf, q[0]);
stq_le_p(buf + 8, q[1]);
return 16; return 16;
} }
} }
@ -90,14 +91,15 @@ static int vfp_gdb_set_reg(CPUARMState *env, uint8_t *buf, int reg)
nregs = arm_feature(env, ARM_FEATURE_VFP3) ? 32 : 16; nregs = arm_feature(env, ARM_FEATURE_VFP3) ? 32 : 16;
if (reg < nregs) { if (reg < nregs) {
env->vfp.regs[reg] = ldq_le_p(buf); *aa32_vfp_dreg(env, reg) = ldq_le_p(buf);
return 8; return 8;
} }
if (arm_feature(env, ARM_FEATURE_NEON)) { if (arm_feature(env, ARM_FEATURE_NEON)) {
nregs += 16; nregs += 16;
if (reg < nregs) { if (reg < nregs) {
env->vfp.regs[(reg - 32) * 2] = ldq_le_p(buf); uint64_t *q = aa32_vfp_qreg(env, reg - 32);
env->vfp.regs[(reg - 32) * 2 + 1] = ldq_le_p(buf + 8); q[0] = ldq_le_p(buf);
q[1] = ldq_le_p(buf + 8);
return 16; return 16;
} }
} }
@ -114,9 +116,12 @@ static int aarch64_fpu_gdb_get_reg(CPUARMState *env, uint8_t *buf, int reg)
switch (reg) { switch (reg) {
case 0 ... 31: case 0 ... 31:
/* 128 bit FP register */ /* 128 bit FP register */
stq_le_p(buf, env->vfp.regs[reg * 2]); {
stq_le_p(buf + 8, env->vfp.regs[reg * 2 + 1]); uint64_t *q = aa64_vfp_qreg(env, reg);
return 16; stq_le_p(buf, q[0]);
stq_le_p(buf + 8, q[1]);
return 16;
}
case 32: case 32:
/* FPSR */ /* FPSR */
stl_p(buf, vfp_get_fpsr(env)); stl_p(buf, vfp_get_fpsr(env));
@ -135,9 +140,12 @@ static int aarch64_fpu_gdb_set_reg(CPUARMState *env, uint8_t *buf, int reg)
switch (reg) { switch (reg) {
case 0 ... 31: case 0 ... 31:
/* 128 bit FP register */ /* 128 bit FP register */
env->vfp.regs[reg * 2] = ldq_le_p(buf); {
env->vfp.regs[reg * 2 + 1] = ldq_le_p(buf + 8); uint64_t *q = aa64_vfp_qreg(env, reg);
return 16; q[0] = ldq_le_p(buf);
q[1] = ldq_le_p(buf + 8);
return 16;
}
case 32: case 32:
/* FPSR */ /* FPSR */
vfp_set_fpsr(env, ldl_p(buf)); vfp_set_fpsr(env, ldl_p(buf));

View File

@ -358,7 +358,7 @@ int kvm_arch_put_registers(CPUState *cs, int level)
/* VFP registers */ /* VFP registers */
r.id = KVM_REG_ARM | KVM_REG_SIZE_U64 | KVM_REG_ARM_VFP; r.id = KVM_REG_ARM | KVM_REG_SIZE_U64 | KVM_REG_ARM_VFP;
for (i = 0; i < 32; i++) { for (i = 0; i < 32; i++) {
r.addr = (uintptr_t)(&env->vfp.regs[i]); r.addr = (uintptr_t)aa32_vfp_dreg(env, i);
ret = kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &r); ret = kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &r);
if (ret) { if (ret) {
return ret; return ret;
@ -445,7 +445,7 @@ int kvm_arch_get_registers(CPUState *cs)
/* VFP registers */ /* VFP registers */
r.id = KVM_REG_ARM | KVM_REG_SIZE_U64 | KVM_REG_ARM_VFP; r.id = KVM_REG_ARM | KVM_REG_SIZE_U64 | KVM_REG_ARM_VFP;
for (i = 0; i < 32; i++) { for (i = 0; i < 32; i++) {
r.addr = (uintptr_t)(&env->vfp.regs[i]); r.addr = (uintptr_t)aa32_vfp_dreg(env, i);
ret = kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &r); ret = kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &r);
if (ret) { if (ret) {
return ret; return ret;

View File

@ -696,21 +696,16 @@ int kvm_arch_put_registers(CPUState *cs, int level)
} }
} }
/* Advanced SIMD and FP registers /* Advanced SIMD and FP registers. */
* We map Qn = regs[2n+1]:regs[2n]
*/
for (i = 0; i < 32; i++) { for (i = 0; i < 32; i++) {
int rd = i << 1; uint64_t *q = aa64_vfp_qreg(env, i);
uint64_t fp_val[2];
#ifdef HOST_WORDS_BIGENDIAN #ifdef HOST_WORDS_BIGENDIAN
fp_val[0] = env->vfp.regs[rd + 1]; uint64_t fp_val[2] = { q[1], q[0] };
fp_val[1] = env->vfp.regs[rd]; reg.addr = (uintptr_t)fp_val;
#else #else
fp_val[1] = env->vfp.regs[rd + 1]; reg.addr = (uintptr_t)q;
fp_val[0] = env->vfp.regs[rd];
#endif #endif
reg.id = AARCH64_SIMD_CORE_REG(fp_regs.vregs[i]); reg.id = AARCH64_SIMD_CORE_REG(fp_regs.vregs[i]);
reg.addr = (uintptr_t)(&fp_val);
ret = kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &reg); ret = kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &reg);
if (ret) { if (ret) {
return ret; return ret;
@ -837,24 +832,18 @@ int kvm_arch_get_registers(CPUState *cs)
env->spsr = env->banked_spsr[i]; env->spsr = env->banked_spsr[i];
} }
/* Advanced SIMD and FP registers /* Advanced SIMD and FP registers */
* We map Qn = regs[2n+1]:regs[2n]
*/
for (i = 0; i < 32; i++) { for (i = 0; i < 32; i++) {
uint64_t fp_val[2]; uint64_t *q = aa64_vfp_qreg(env, i);
reg.id = AARCH64_SIMD_CORE_REG(fp_regs.vregs[i]); reg.id = AARCH64_SIMD_CORE_REG(fp_regs.vregs[i]);
reg.addr = (uintptr_t)(&fp_val); reg.addr = (uintptr_t)q;
ret = kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &reg); ret = kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &reg);
if (ret) { if (ret) {
return ret; return ret;
} else { } else {
int rd = i << 1;
#ifdef HOST_WORDS_BIGENDIAN #ifdef HOST_WORDS_BIGENDIAN
env->vfp.regs[rd + 1] = fp_val[0]; uint64_t t;
env->vfp.regs[rd] = fp_val[1]; t = q[0], q[0] = q[1], q[1] = t;
#else
env->vfp.regs[rd + 1] = fp_val[1];
env->vfp.regs[rd] = fp_val[0];
#endif #endif
} }
} }

View File

@ -164,15 +164,12 @@ void aarch64_cpu_dump_state(CPUState *cs, FILE *f,
if (flags & CPU_DUMP_FPU) { if (flags & CPU_DUMP_FPU) {
int numvfpregs = 32; int numvfpregs = 32;
for (i = 0; i < numvfpregs; i += 2) { for (i = 0; i < numvfpregs; i++) {
uint64_t vlo = env->vfp.regs[i * 2]; uint64_t *q = aa64_vfp_qreg(env, i);
uint64_t vhi = env->vfp.regs[(i * 2) + 1]; uint64_t vlo = q[0];
cpu_fprintf(f, "q%02d=%016" PRIx64 ":%016" PRIx64 " ", uint64_t vhi = q[1];
i, vhi, vlo); cpu_fprintf(f, "q%02d=%016" PRIx64 ":%016" PRIx64 "%c",
vlo = env->vfp.regs[(i + 1) * 2]; i, vhi, vlo, (i & 1 ? '\n' : ' '));
vhi = env->vfp.regs[((i + 1) * 2) + 1];
cpu_fprintf(f, "q%02d=%016" PRIx64 ":%016" PRIx64 "\n",
i + 1, vhi, vlo);
} }
cpu_fprintf(f, "FPCR: %08x FPSR: %08x\n", cpu_fprintf(f, "FPCR: %08x FPSR: %08x\n",
vfp_get_fpcr(env), vfp_get_fpsr(env)); vfp_get_fpcr(env), vfp_get_fpsr(env));
@ -558,19 +555,13 @@ static TCGv_ptr vec_full_reg_ptr(DisasContext *s, int regno)
*/ */
static inline int fp_reg_offset(DisasContext *s, int regno, TCGMemOp size) static inline int fp_reg_offset(DisasContext *s, int regno, TCGMemOp size)
{ {
int offs = offsetof(CPUARMState, vfp.regs[regno * 2]); return vec_reg_offset(s, regno, 0, size);
#ifdef HOST_WORDS_BIGENDIAN
offs += (8 - (1 << size));
#endif
assert_fp_access_checked(s);
return offs;
} }
/* Offset of the high half of the 128 bit vector Qn */ /* Offset of the high half of the 128 bit vector Qn */
static inline int fp_reg_hi_offset(DisasContext *s, int regno) static inline int fp_reg_hi_offset(DisasContext *s, int regno)
{ {
assert_fp_access_checked(s); return vec_reg_offset(s, regno, 1, MO_64);
return offsetof(CPUARMState, vfp.regs[regno * 2 + 1]);
} }
/* Convenience accessors for reading and writing single and double /* Convenience accessors for reading and writing single and double

View File

@ -1515,14 +1515,16 @@ static inline void gen_vfp_st(DisasContext *s, int dp, TCGv_i32 addr)
static inline long static inline long
vfp_reg_offset (int dp, int reg) vfp_reg_offset (int dp, int reg)
{ {
if (dp) if (dp) {
return offsetof(CPUARMState, vfp.regs[reg]); return offsetof(CPUARMState, vfp.regs[reg]);
else if (reg & 1) {
return offsetof(CPUARMState, vfp.regs[reg >> 1])
+ offsetof(CPU_DoubleU, l.upper);
} else { } else {
return offsetof(CPUARMState, vfp.regs[reg >> 1]) long ofs = offsetof(CPUARMState, vfp.regs[reg >> 1]);
+ offsetof(CPU_DoubleU, l.lower); if (reg & 1) {
ofs += offsetof(CPU_DoubleU, l.upper);
} else {
ofs += offsetof(CPU_DoubleU, l.lower);
}
return ofs;
} }
} }
@ -12572,7 +12574,7 @@ void arm_cpu_dump_state(CPUState *cs, FILE *f, fprintf_function cpu_fprintf,
numvfpregs += 16; numvfpregs += 16;
} }
for (i = 0; i < numvfpregs; i++) { for (i = 0; i < numvfpregs; i++) {
uint64_t v = env->vfp.regs[i]; uint64_t v = *aa32_vfp_dreg(env, i);
cpu_fprintf(f, "s%02d=%08x s%02d=%08x d%02d=%016" PRIx64 "\n", cpu_fprintf(f, "s%02d=%08x s%02d=%08x d%02d=%016" PRIx64 "\n",
i * 2, (uint32_t)v, i * 2, (uint32_t)v,
i * 2 + 1, (uint32_t)(v >> 32), i * 2 + 1, (uint32_t)(v >> 32),