armemu: Implement SMLSD

This commit is contained in:
Lioncash 2014-12-19 09:38:10 -05:00
parent 017e6a488e
commit 0f3a6a161c

View File

@ -6317,11 +6317,14 @@ L_stm_s_takeabort:
} }
case 0x70: case 0x70:
// ichfly // ichfly
// SMUAD, SMUSD, SMLAD // SMUAD, SMUSD, SMLAD, and SMLSD
if ((instr & 0xf0d0) == 0xf010 || (instr & 0xf0d0) == 0xf050 || (instr & 0xd0) == 0x10) { if ((instr & 0xf0d0) == 0xf010 || (instr & 0xf0d0) == 0xf050 ||
(instr & 0xd0) == 0x10 || (instr & 0xd0) == 0x50)
{
const u8 rd_idx = BITS(16, 19); const u8 rd_idx = BITS(16, 19);
const u8 rn_idx = BITS(0, 3); const u8 rn_idx = BITS(0, 3);
const u8 rm_idx = BITS(8, 11); const u8 rm_idx = BITS(8, 11);
const u8 ra_idx = BITS(12, 15);
const bool do_swap = (BIT(5) == 1); const bool do_swap = (BIT(5) == 1);
u32 rm_val = state->Reg[rm_idx]; u32 rm_val = state->Reg[rm_idx];
@ -6344,13 +6347,14 @@ L_stm_s_takeabort:
state->Reg[rd_idx] = (rn_lo * rm_lo) - (rn_hi * rm_hi); state->Reg[rd_idx] = (rn_lo * rm_lo) - (rn_hi * rm_hi);
} }
// SMLAD // SMLAD
else { else if ((instr & 0xd0) == 0x10) {
const u8 ra_idx = BITS(12, 15);
state->Reg[rd_idx] = (rn_lo * rm_lo) + (rn_hi * rm_hi) + (s32)state->Reg[ra_idx]; state->Reg[rd_idx] = (rn_lo * rm_lo) + (rn_hi * rm_hi) + (s32)state->Reg[ra_idx];
} }
// SMLSD
else {
state->Reg[rd_idx] = ((rn_lo * rm_lo) - (rn_hi * rm_hi)) + (s32)state->Reg[ra_idx];
}
return 1; return 1;
} else {
printf ("Unhandled v6 insn: smlsd\n");
} }
break; break;
case 0x74: case 0x74: