Merge pull request #895 from lioncash/vfp

vfp: Handle accesses to FPINST/FPINST2 system registers.
This commit is contained in:
bunnei 2015-06-29 09:51:59 -04:00
commit 3085438216
4 changed files with 53 additions and 42 deletions

View file

@ -59,6 +59,8 @@ enum {
VFP_FPSID, VFP_FPSID,
VFP_FPSCR, VFP_FPSCR,
VFP_FPEXC, VFP_FPEXC,
VFP_FPINST,
VFP_FPINST2,
VFP_MVFR0, VFP_MVFR0,
VFP_MVFR1, VFP_MVFR1,

View file

@ -33,6 +33,10 @@ unsigned VFPInit(ARMul_State* state)
state->VFP[VFP_FPEXC] = 0; state->VFP[VFP_FPEXC] = 0;
state->VFP[VFP_FPSCR] = 0; state->VFP[VFP_FPSCR] = 0;
// ARM11 MPCore instruction register reset values.
state->VFP[VFP_FPINST] = 0xEE000A00;
state->VFP[VFP_FPINST2] = 0;
// ARM11 MPCore feature register values. // ARM11 MPCore feature register values.
state->VFP[VFP_MVFR0] = 0x11111111; state->VFP[VFP_MVFR0] = 0x11111111;
state->VFP[VFP_MVFR1] = 0; state->VFP[VFP_MVFR1] = 0;
@ -40,18 +44,6 @@ unsigned VFPInit(ARMul_State* state)
return 0; return 0;
} }
void VMSR(ARMul_State* state, ARMword reg, ARMword Rt)
{
if (reg == 1)
{
state->VFP[VFP_FPSCR] = state->Reg[Rt];
}
else if (reg == 8)
{
state->VFP[VFP_FPEXC] = state->Reg[Rt];
}
}
void VMOVBRS(ARMul_State* state, ARMword to_arm, ARMword t, ARMword n, ARMword* value) void VMOVBRS(ARMul_State* state, ARMword to_arm, ARMword t, ARMword n, ARMword* value)
{ {
if (to_arm) if (to_arm)

View file

@ -36,10 +36,8 @@ void vfp_raise_exceptions(ARMul_State* state, u32 exceptions, u32 inst, u32 fpsc
u32 vfp_single_cpdo(ARMul_State* state, u32 inst, u32 fpscr); u32 vfp_single_cpdo(ARMul_State* state, u32 inst, u32 fpscr);
u32 vfp_double_cpdo(ARMul_State* state, u32 inst, u32 fpscr); u32 vfp_double_cpdo(ARMul_State* state, u32 inst, u32 fpscr);
void VMSR(ARMul_State* state, ARMword reg, ARMword Rt);
void VMOVBRS(ARMul_State* state, ARMword to_arm, ARMword t, ARMword n, ARMword* value); void VMOVBRS(ARMul_State* state, ARMword to_arm, ARMword t, ARMword n, ARMword* value);
void VMOVBRRD(ARMul_State* state, ARMword to_arm, ARMword t, ARMword t2, ARMword n, ARMword* value1, ARMword* value2); void VMOVBRRD(ARMul_State* state, ARMword to_arm, ARMword t, ARMword t2, ARMword n, ARMword* value1, ARMword* value2);
void VMOVBRRSS(ARMul_State* state, ARMword to_arm, ARMword t, ARMword t2, ARMword n, ARMword* value1, ARMword* value2); void VMOVBRRSS(ARMul_State* state, ARMword to_arm, ARMword t, ARMword t2, ARMword n, ARMword* value1, ARMword* value2);
void VMOVI(ARMul_State* state, ARMword single, ARMword d, ARMword imm); void VMOVI(ARMul_State* state, ARMword single, ARMword d, ARMword imm);
void VMOVR(ARMul_State* state, ARMword single, ARMword d, ARMword imm); void VMOVR(ARMul_State* state, ARMword single, ARMword d, ARMword imm);

View file

@ -995,7 +995,7 @@ VMOVBRS_INST:
#ifdef VFP_INTERPRETER_STRUCT #ifdef VFP_INTERPRETER_STRUCT
struct vmsr_inst { struct vmsr_inst {
unsigned int reg; unsigned int reg;
unsigned int Rd; unsigned int Rt;
}; };
#endif #endif
#ifdef VFP_INTERPRETER_TRANS #ifdef VFP_INTERPRETER_TRANS
@ -1009,7 +1009,7 @@ static ARM_INST_PTR INTERPRETER_TRANSLATE(vmsr)(unsigned int inst, int index)
inst_base->br = NON_BRANCH; inst_base->br = NON_BRANCH;
inst_cream->reg = BITS(inst, 16, 19); inst_cream->reg = BITS(inst, 16, 19);
inst_cream->Rd = BITS(inst, 12, 15); inst_cream->Rt = BITS(inst, 12, 15);
return inst_base; return inst_base;
} }
@ -1017,15 +1017,30 @@ static ARM_INST_PTR INTERPRETER_TRANSLATE(vmsr)(unsigned int inst, int index)
#ifdef VFP_INTERPRETER_IMPL #ifdef VFP_INTERPRETER_IMPL
VMSR_INST: VMSR_INST:
{ {
if ((inst_base->cond == 0xe) || CondPassed(cpu, inst_base->cond)) { if (inst_base->cond == 0xE || CondPassed(cpu, inst_base->cond)) {
/* FIXME: special case for access to FPSID and FPEXC, VFP must be disabled , /* FIXME: special case for access to FPSID and FPEXC, VFP must be disabled ,
and in privileged mode */ and in privileged mode */
/* Exceptions must be checked, according to v7 ref manual */ /* Exceptions must be checked, according to v7 ref manual */
CHECK_VFP_ENABLED; CHECK_VFP_ENABLED;
vmsr_inst *inst_cream = (vmsr_inst *)inst_base->component; vmsr_inst* const inst_cream = (vmsr_inst*)inst_base->component;
VMSR(cpu, inst_cream->reg, inst_cream->Rd); unsigned int reg = inst_cream->reg;
unsigned int rt = inst_cream->Rt;
if (reg == 1)
{
cpu->VFP[VFP_FPSCR] = cpu->Reg[rt];
}
else if (InAPrivilegedMode(cpu))
{
if (reg == 8)
cpu->VFP[VFP_FPEXC] = cpu->Reg[rt];
else if (reg == 9)
cpu->VFP[VFP_FPINST] = cpu->Reg[rt];
else if (reg == 10)
cpu->VFP[VFP_FPINST2] = cpu->Reg[rt];
}
} }
cpu->Reg[15] += GET_INST_SIZE(cpu); cpu->Reg[15] += GET_INST_SIZE(cpu);
INC_PC(sizeof(vmsr_inst)); INC_PC(sizeof(vmsr_inst));
@ -1111,19 +1126,22 @@ static ARM_INST_PTR INTERPRETER_TRANSLATE(vmrs)(unsigned int inst, int index)
#ifdef VFP_INTERPRETER_IMPL #ifdef VFP_INTERPRETER_IMPL
VMRS_INST: VMRS_INST:
{ {
if ((inst_base->cond == 0xe) || CondPassed(cpu, inst_base->cond)) { if (inst_base->cond == 0xE || CondPassed(cpu, inst_base->cond)) {
/* FIXME: special case for access to FPSID and FPEXC, VFP must be disabled, /* FIXME: special case for access to FPSID and FPEXC, VFP must be disabled,
and in privileged mode */ and in privileged mode */
/* Exceptions must be checked, according to v7 ref manual */ /* Exceptions must be checked, according to v7 ref manual */
CHECK_VFP_ENABLED; CHECK_VFP_ENABLED;
vmrs_inst *inst_cream = (vmrs_inst *)inst_base->component; vmrs_inst* const inst_cream = (vmrs_inst*)inst_base->component;
if (inst_cream->reg == 1) /* FPSCR */ unsigned int reg = inst_cream->reg;
unsigned int rt = inst_cream->Rt;
if (reg == 1) // FPSCR
{ {
if (inst_cream->Rt != 15) if (rt != 15)
{ {
cpu->Reg[inst_cream->Rt] = cpu->VFP[VFP_FPSCR]; cpu->Reg[rt] = cpu->VFP[VFP_FPSCR];
} }
else else
{ {
@ -1133,25 +1151,26 @@ VMRS_INST:
cpu->VFlag = (cpu->VFP[VFP_FPSCR] >> 28) & 1; cpu->VFlag = (cpu->VFP[VFP_FPSCR] >> 28) & 1;
} }
} }
else else if (reg == 0)
{ {
switch (inst_cream->reg) cpu->Reg[rt] = cpu->VFP[VFP_FPSID];
{ }
case 0: else if (reg == 6)
cpu->Reg[inst_cream->Rt] = cpu->VFP[VFP_FPSID]; {
break; cpu->Reg[rt] = cpu->VFP[VFP_MVFR1];
case 6: }
cpu->Reg[inst_cream->Rt] = cpu->VFP[VFP_MVFR1]; else if (reg == 7)
break; {
case 7: cpu->Reg[rt] = cpu->VFP[VFP_MVFR0];
cpu->Reg[inst_cream->Rt] = cpu->VFP[VFP_MVFR0]; }
break; else if (InAPrivilegedMode(cpu))
case 8: {
cpu->Reg[inst_cream->Rt] = cpu->VFP[VFP_FPEXC]; if (reg == 8)
break; cpu->Reg[rt] = cpu->VFP[VFP_FPEXC];
default: else if (reg == 9)
break; cpu->Reg[rt] = cpu->VFP[VFP_FPINST];
} else if (reg == 10)
cpu->Reg[rt] = cpu->VFP[VFP_FPINST2];
} }
} }
cpu->Reg[15] += GET_INST_SIZE(cpu); cpu->Reg[15] += GET_INST_SIZE(cpu);