// license:BSD-3-Clause // copyright-holders:Bryan McPhail /* arm.c ARM 2/3/6 Emulation (26 bit address bus) Todo: Timing - Currently very approximated, nothing relies on proper timing so far. IRQ timing not yet correct (again, nothing is affected by this so far). Recent changes (2005): Fixed software interrupts Fixed various mode change bugs Added preliminary co-processor support. By Bryan McPhail (bmcphail@tendril.co.uk) and Phil Stroffolino */ #include "emu.h" #include "debugger.h" #include "arm.h" CPU_DISASSEMBLE( arm ); CPU_DISASSEMBLE( arm_be ); #define ARM_DEBUG_CORE 0 #define ARM_DEBUG_COPRO 0 enum { eARM_MODE_USER = 0x0, eARM_MODE_FIQ = 0x1, eARM_MODE_IRQ = 0x2, eARM_MODE_SVC = 0x3, kNumModes }; /* There are 27 32 bit processor registers */ enum { eR0=0,eR1,eR2,eR3,eR4,eR5,eR6,eR7, eR8,eR9,eR10,eR11,eR12, eR13, /* Stack Pointer */ eR14, /* Link Register (holds return address) */ eR15, /* Program Counter */ /* Fast Interrupt */ eR8_FIQ,eR9_FIQ,eR10_FIQ,eR11_FIQ,eR12_FIQ,eR13_FIQ,eR14_FIQ, /* IRQ */ eR13_IRQ,eR14_IRQ, /* Software Interrupt */ eR13_SVC,eR14_SVC, kNumRegisters }; /* 16 processor registers are visible at any given time, * banked depending on processor mode. */ static const int sRegisterTable[kNumModes][16] = { { /* USR */ eR0,eR1,eR2,eR3,eR4,eR5,eR6,eR7, eR8,eR9,eR10,eR11,eR12, eR13,eR14, eR15 }, { /* FIQ */ eR0,eR1,eR2,eR3,eR4,eR5,eR6,eR7, eR8_FIQ,eR9_FIQ,eR10_FIQ,eR11_FIQ,eR12_FIQ, eR13_FIQ,eR14_FIQ, eR15 }, { /* IRQ */ eR0,eR1,eR2,eR3,eR4,eR5,eR6,eR7, eR8,eR9,eR10,eR11,eR12, eR13_IRQ,eR14_IRQ, eR15 }, { /* SVC */ eR0,eR1,eR2,eR3,eR4,eR5,eR6,eR7, eR8,eR9,eR10,eR11,eR12, eR13_SVC,eR14_SVC, eR15 } }; #define N_BIT 31 #define Z_BIT 30 #define C_BIT 29 #define V_BIT 28 #define I_BIT 27 #define F_BIT 26 #define N_MASK ((uint32_t)(1<> 31) /* Deconstructing an instruction */ #define INSN_COND ((uint32_t) 0xf0000000u) #define INSN_SDT_L ((uint32_t) 0x00100000u) #define INSN_SDT_W ((uint32_t) 0x00200000u) #define INSN_SDT_B ((uint32_t) 0x00400000u) #define INSN_SDT_U ((uint32_t) 0x00800000u) #define INSN_SDT_P ((uint32_t) 0x01000000u) #define INSN_BDT_L ((uint32_t) 0x00100000u) #define INSN_BDT_W ((uint32_t) 0x00200000u) #define INSN_BDT_S ((uint32_t) 0x00400000u) #define INSN_BDT_U ((uint32_t) 0x00800000u) #define INSN_BDT_P ((uint32_t) 0x01000000u) #define INSN_BDT_REGS ((uint32_t) 0x0000ffffu) #define INSN_SDT_IMM ((uint32_t) 0x00000fffu) #define INSN_MUL_A ((uint32_t) 0x00200000u) #define INSN_MUL_RM ((uint32_t) 0x0000000fu) #define INSN_MUL_RS ((uint32_t) 0x00000f00u) #define INSN_MUL_RN ((uint32_t) 0x0000f000u) #define INSN_MUL_RD ((uint32_t) 0x000f0000u) #define INSN_I ((uint32_t) 0x02000000u) #define INSN_OPCODE ((uint32_t) 0x01e00000u) #define INSN_S ((uint32_t) 0x00100000u) #define INSN_BL ((uint32_t) 0x01000000u) #define INSN_BRANCH ((uint32_t) 0x00ffffffu) #define INSN_SWI ((uint32_t) 0x00ffffffu) #define INSN_RN ((uint32_t) 0x000f0000u) #define INSN_RD ((uint32_t) 0x0000f000u) #define INSN_OP2 ((uint32_t) 0x00000fffu) #define INSN_OP2_SHIFT ((uint32_t) 0x00000f80u) #define INSN_OP2_SHIFT_TYPE ((uint32_t) 0x00000070u) #define INSN_OP2_RM ((uint32_t) 0x0000000fu) #define INSN_OP2_ROTATE ((uint32_t) 0x00000f00u) #define INSN_OP2_IMM ((uint32_t) 0x000000ffu) #define INSN_OP2_SHIFT_TYPE_SHIFT 4 #define INSN_OP2_SHIFT_SHIFT 7 #define INSN_OP2_ROTATE_SHIFT 8 #define INSN_MUL_RS_SHIFT 8 #define INSN_MUL_RN_SHIFT 12 #define INSN_MUL_RD_SHIFT 16 #define INSN_OPCODE_SHIFT 21 #define INSN_RN_SHIFT 16 #define INSN_RD_SHIFT 12 #define INSN_COND_SHIFT 28 #define S_CYCLE 1 #define N_CYCLE 1 #define I_CYCLE 1 enum { OPCODE_AND, /* 0000 */ OPCODE_EOR, /* 0001 */ OPCODE_SUB, /* 0010 */ OPCODE_RSB, /* 0011 */ OPCODE_ADD, /* 0100 */ OPCODE_ADC, /* 0101 */ OPCODE_SBC, /* 0110 */ OPCODE_RSC, /* 0111 */ OPCODE_TST, /* 1000 */ OPCODE_TEQ, /* 1001 */ OPCODE_CMP, /* 1010 */ OPCODE_CMN, /* 1011 */ OPCODE_ORR, /* 1100 */ OPCODE_MOV, /* 1101 */ OPCODE_BIC, /* 1110 */ OPCODE_MVN /* 1111 */ }; enum { COND_EQ = 0, /* Z: equal */ COND_NE, /* ~Z: not equal */ COND_CS, COND_HS = 2, /* C: unsigned higher or same */ COND_CC, COND_LO = 3, /* ~C: unsigned lower */ COND_MI, /* N: negative */ COND_PL, /* ~N: positive or zero */ COND_VS, /* V: overflow */ COND_VC, /* ~V: no overflow */ COND_HI, /* C && ~Z: unsigned higher */ COND_LS, /* ~C || Z: unsigned lower or same */ COND_GE, /* N == V: greater or equal */ COND_LT, /* N != V: less than */ COND_GT, /* ~Z && (N == V): greater than */ COND_LE, /* Z || (N != V): less than or equal */ COND_AL, /* always */ COND_NV /* never */ }; #define LSL(v,s) ((v) << (s)) #define LSR(v,s) ((v) >> (s)) #define ROL(v,s) (LSL((v),(s)) | (LSR((v),32u - (s)))) #define ROR(v,s) (LSR((v),(s)) | (LSL((v),32u - (s)))) /***************************************************************************/ const device_type ARM = &device_creator; const device_type ARM_BE = &device_creator; arm_cpu_device::arm_cpu_device(const machine_config &mconfig, const char *tag, device_t *owner, uint32_t clock) : cpu_device(mconfig, ARM, "ARM", tag, owner, clock, "arm", __FILE__) , m_program_config("program", ENDIANNESS_LITTLE, 32, 26, 0) , m_endian(ENDIANNESS_LITTLE) , m_copro_type(ARM_COPRO_TYPE_UNKNOWN_CP15) { memset(m_sArmRegister, 0x00, sizeof(m_sArmRegister)); } arm_cpu_device::arm_cpu_device(const machine_config &mconfig, device_type type, const char *name, const char *tag, device_t *owner, uint32_t clock, const char *shortname, const char *source, endianness_t endianness) : cpu_device(mconfig, type, name, tag, owner, clock, shortname, source) , m_program_config("program", endianness, 32, 26, 0) , m_endian(endianness) , m_copro_type(ARM_COPRO_TYPE_UNKNOWN_CP15) { memset(m_sArmRegister, 0x00, sizeof(m_sArmRegister)); } arm_be_cpu_device::arm_be_cpu_device(const machine_config &mconfig, const char *tag, device_t *owner, uint32_t clock) : arm_cpu_device(mconfig, ARM_BE, "ARM (big endian)", tag, owner, clock, "arm be", __FILE__, ENDIANNESS_BIG) { } void arm_cpu_device::cpu_write32( int addr, uint32_t data ) { /* Unaligned writes are treated as normal writes */ m_program->write_dword(addr&ADDRESS_MASK,data); if (ARM_DEBUG_CORE && !DWORD_ALIGNED(addr)) logerror("%08x: Unaligned write %08x\n",R15,addr); } void arm_cpu_device::cpu_write8( int addr, uint8_t data ) { m_program->write_byte(addr,data); } uint32_t arm_cpu_device::cpu_read32( int addr ) { uint32_t result = m_program->read_dword(addr&ADDRESS_MASK); /* Unaligned reads rotate the word, they never combine words */ if (!DWORD_ALIGNED(addr)) { if (ARM_DEBUG_CORE && !WORD_ALIGNED(addr)) logerror("%08x: Unaligned byte read %08x\n",R15,addr); if ((addr&3)==1) return ((result&0x000000ff)<<24)|((result&0xffffff00)>> 8); if ((addr&3)==2) return ((result&0x0000ffff)<<16)|((result&0xffff0000)>>16); if ((addr&3)==3) return ((result&0x00ffffff)<< 8)|((result&0xff000000)>>24); } return result; } uint8_t arm_cpu_device::cpu_read8( int addr ) { return m_program->read_byte(addr); } uint32_t arm_cpu_device::GetRegister( int rIndex ) { return m_sArmRegister[sRegisterTable[MODE][rIndex]]; } void arm_cpu_device::SetRegister( int rIndex, uint32_t value ) { m_sArmRegister[sRegisterTable[MODE][rIndex]] = value; } uint32_t arm_cpu_device::GetModeRegister( int mode, int rIndex ) { return m_sArmRegister[sRegisterTable[mode][rIndex]]; } void arm_cpu_device::SetModeRegister( int mode, int rIndex, uint32_t value ) { m_sArmRegister[sRegisterTable[mode][rIndex]] = value; } /***************************************************************************/ void arm_cpu_device::device_reset() { for (auto & elem : m_sArmRegister) { elem = 0; } for (auto & elem : m_coproRegister) { elem = 0; } m_pendingIrq = 0; m_pendingFiq = 0; /* start up in SVC mode with interrupts disabled. */ R15 = eARM_MODE_SVC|I_MASK|F_MASK; } void arm_cpu_device::execute_run() { uint32_t pc; uint32_t insn; do { debugger_instruction_hook(this, R15 & ADDRESS_MASK); /* load instruction */ pc = R15; insn = m_direct->read_dword( pc & ADDRESS_MASK ); switch (insn >> INSN_COND_SHIFT) { case COND_EQ: if (Z_IS_CLEAR(pc)) goto L_Next; break; case COND_NE: if (Z_IS_SET(pc)) goto L_Next; break; case COND_CS: if (C_IS_CLEAR(pc)) goto L_Next; break; case COND_CC: if (C_IS_SET(pc)) goto L_Next; break; case COND_MI: if (N_IS_CLEAR(pc)) goto L_Next; break; case COND_PL: if (N_IS_SET(pc)) goto L_Next; break; case COND_VS: if (V_IS_CLEAR(pc)) goto L_Next; break; case COND_VC: if (V_IS_SET(pc)) goto L_Next; break; case COND_HI: if (C_IS_CLEAR(pc) || Z_IS_SET(pc)) goto L_Next; break; case COND_LS: if (C_IS_SET(pc) && Z_IS_CLEAR(pc)) goto L_Next; break; case COND_GE: if (!(pc & N_MASK) != !(pc & V_MASK)) goto L_Next; /* Use x ^ (x >> ...) method */ break; case COND_LT: if (!(pc & N_MASK) == !(pc & V_MASK)) goto L_Next; break; case COND_GT: if (Z_IS_SET(pc) || (!(pc & N_MASK) != !(pc & V_MASK))) goto L_Next; break; case COND_LE: if (Z_IS_CLEAR(pc) && (!(pc & N_MASK) == !(pc & V_MASK))) goto L_Next; break; case COND_NV: goto L_Next; } /* Condition satisfied, so decode the instruction */ if ((insn & 0x0fc000f0u) == 0x00000090u) /* Multiplication */ { HandleMul(insn); R15 += 4; } else if (!(insn & 0x0c000000u)) /* Data processing */ { HandleALU(insn); } else if ((insn & 0x0c000000u) == 0x04000000u) /* Single data access */ { HandleMemSingle(insn); R15 += 4; } else if ((insn & 0x0e000000u) == 0x08000000u ) /* Block data access */ { HandleMemBlock(insn); R15 += 4; } else if ((insn & 0x0e000000u) == 0x0a000000u) /* Branch */ { HandleBranch(insn); } else if ((insn & 0x0f000000u) == 0x0e000000u) /* Coprocessor */ { if (m_copro_type == ARM_COPRO_TYPE_VL86C020) HandleCoProVL86C020(insn); else HandleCoPro(insn); R15 += 4; } else if ((insn & 0x0f000000u) == 0x0f000000u) /* Software interrupt */ { pc=R15+4; R15 = eARM_MODE_SVC; /* Set SVC mode so PC is saved to correct R14 bank */ SetRegister( 14, pc ); /* save PC */ R15 = (pc&PSR_MASK)|(pc&IRQ_MASK)|0x8|eARM_MODE_SVC|I_MASK|(pc&MODE_MASK); m_icount -= 2 * S_CYCLE + N_CYCLE; } else /* Undefined */ { logerror("%08x: Undefined instruction\n",R15); L_Next: m_icount -= S_CYCLE; R15 += 4; } arm_check_irq_state(); } while( m_icount > 0 ); } /* arm_execute */ void arm_cpu_device::arm_check_irq_state() { uint32_t pc = R15+4; /* save old pc (already incremented in pipeline) */; /* Exception priorities (from ARM6, not specifically ARM2/3): Reset Data abort FIRQ IRQ Prefetch abort Undefined instruction */ if (m_pendingFiq && (pc&F_MASK)==0) { R15 = eARM_MODE_FIQ; /* Set FIQ mode so PC is saved to correct R14 bank */ SetRegister( 14, pc ); /* save PC */ R15 = (pc&PSR_MASK)|(pc&IRQ_MASK)|0x1c|eARM_MODE_FIQ|I_MASK|F_MASK; /* Mask both IRQ & FIRQ, set PC=0x1c */ m_pendingFiq=0; return; } if (m_pendingIrq && (pc&I_MASK)==0) { R15 = eARM_MODE_IRQ; /* Set IRQ mode so PC is saved to correct R14 bank */ SetRegister( 14, pc ); /* save PC */ R15 = (pc&PSR_MASK)|(pc&IRQ_MASK)|0x18|eARM_MODE_IRQ|I_MASK|(pc&F_MASK); /* Mask only IRQ, set PC=0x18 */ m_pendingIrq=0; return; } } void arm_cpu_device::execute_set_input(int irqline, int state) { switch (irqline) { case ARM_IRQ_LINE: /* IRQ */ if (state && (R15&0x3)!=eARM_MODE_IRQ) /* Don't allow nested IRQs */ m_pendingIrq=1; else m_pendingIrq=0; break; case ARM_FIRQ_LINE: /* FIRQ */ if (state && (R15&0x3)!=eARM_MODE_FIQ) /* Don't allow nested FIRQs */ m_pendingFiq=1; else m_pendingFiq=0; break; } arm_check_irq_state(); } void arm_cpu_device::device_start() { m_program = &space(AS_PROGRAM); m_direct = &m_program->direct(); save_item(NAME(m_sArmRegister)); save_item(NAME(m_coproRegister)); save_item(NAME(m_pendingIrq)); save_item(NAME(m_pendingFiq)); state_add( ARM32_PC, "PC", m_sArmRegister[15] ).mask(ADDRESS_MASK).formatstr("%08X"); state_add( ARM32_R0, "R0", m_sArmRegister[ 0] ).formatstr("%08X"); state_add( ARM32_R1, "R1", m_sArmRegister[ 1] ).formatstr("%08X"); state_add( ARM32_R2, "R2", m_sArmRegister[ 2] ).formatstr("%08X"); state_add( ARM32_R3, "R3", m_sArmRegister[ 3] ).formatstr("%08X"); state_add( ARM32_R4, "R4", m_sArmRegister[ 4] ).formatstr("%08X"); state_add( ARM32_R5, "R5", m_sArmRegister[ 5] ).formatstr("%08X"); state_add( ARM32_R6, "R6", m_sArmRegister[ 6] ).formatstr("%08X"); state_add( ARM32_R7, "R7", m_sArmRegister[ 7] ).formatstr("%08X"); state_add( ARM32_R8, "R8", m_sArmRegister[ 8] ).formatstr("%08X"); state_add( ARM32_R9, "R9", m_sArmRegister[ 9] ).formatstr("%08X"); state_add( ARM32_R10, "R10", m_sArmRegister[10] ).formatstr("%08X"); state_add( ARM32_R11, "R11", m_sArmRegister[11] ).formatstr("%08X"); state_add( ARM32_R12, "R12", m_sArmRegister[12] ).formatstr("%08X"); state_add( ARM32_R13, "R13", m_sArmRegister[13] ).formatstr("%08X"); state_add( ARM32_R14, "R14", m_sArmRegister[14] ).formatstr("%08X"); state_add( ARM32_R15, "R15", m_sArmRegister[15] ).formatstr("%08X"); state_add( ARM32_FR8, "FR8", m_sArmRegister[eR8_FIQ] ).formatstr("%08X"); state_add( ARM32_FR9, "FR9", m_sArmRegister[eR9_FIQ] ).formatstr("%08X"); state_add( ARM32_FR10, "FR10", m_sArmRegister[eR10_FIQ] ).formatstr("%08X"); state_add( ARM32_FR11, "FR11", m_sArmRegister[eR11_FIQ] ).formatstr("%08X"); state_add( ARM32_FR12, "FR12", m_sArmRegister[eR12_FIQ] ).formatstr("%08X"); state_add( ARM32_FR13, "FR13", m_sArmRegister[eR13_FIQ] ).formatstr("%08X"); state_add( ARM32_FR14, "FR14", m_sArmRegister[eR14_FIQ] ).formatstr("%08X"); state_add( ARM32_IR13, "IR13", m_sArmRegister[eR13_IRQ] ).formatstr("%08X"); state_add( ARM32_IR14, "IR14", m_sArmRegister[eR14_IRQ] ).formatstr("%08X"); state_add( ARM32_SR13, "SR13", m_sArmRegister[eR13_SVC] ).formatstr("%08X"); state_add( ARM32_SR14, "SR14", m_sArmRegister[eR14_SVC] ).formatstr("%08X"); state_add(STATE_GENPC, "GENPC", m_sArmRegister[15]).mask(ADDRESS_MASK).formatstr("%8s").noshow(); state_add(STATE_GENPCBASE, "CURPC", m_sArmRegister[15]).mask(ADDRESS_MASK).formatstr("%8s").noshow(); state_add(STATE_GENFLAGS, "GENFLAGS", m_sArmRegister[15]).formatstr("%11s").noshow(); m_icountptr = &m_icount; } void arm_cpu_device::state_string_export(const device_state_entry &entry, std::string &str) const { static const char *s[4] = { "USER", "FIRQ", "IRQ ", "SVC " }; switch (entry.index()) { case STATE_GENFLAGS: str = string_format("%c%c%c%c%c%c %s", (m_sArmRegister[15] & N_MASK) ? 'N' : '-', (m_sArmRegister[15] & Z_MASK) ? 'Z' : '-', (m_sArmRegister[15] & C_MASK) ? 'C' : '-', (m_sArmRegister[15] & V_MASK) ? 'V' : '-', (m_sArmRegister[15] & I_MASK) ? 'I' : '-', (m_sArmRegister[15] & F_MASK) ? 'F' : '-', s[m_sArmRegister[15] & 3]); break; } } /***************************************************************************/ void arm_cpu_device::HandleBranch( uint32_t insn ) { uint32_t off = (insn & INSN_BRANCH) << 2; /* Save PC into LR if this is a branch with link */ if (insn & INSN_BL) { SetRegister(14,R15 + 4); } /* Sign-extend the 24-bit offset in our calculations */ if (off & 0x2000000u) { R15 = ((R15 - (((~(off | 0xfc000000u)) + 1) - 8)) & ADDRESS_MASK) | (R15 & ~ADDRESS_MASK); } else { R15 = ((R15 + (off + 8)) & ADDRESS_MASK) | (R15 & ~ADDRESS_MASK); } m_icount -= 2 * S_CYCLE + N_CYCLE; } void arm_cpu_device::HandleMemSingle( uint32_t insn ) { uint32_t rn, rnv, off, rd; /* Fetch the offset */ if (insn & INSN_I) { off = decodeShift(insn, nullptr); } else { off = insn & INSN_SDT_IMM; } /* Calculate Rn, accounting for PC */ rn = (insn & INSN_RN) >> INSN_RN_SHIFT; // if (rn==0xf) logerror("%08x: Source R15\n",R15); if (insn & INSN_SDT_P) { /* Pre-indexed addressing */ if (insn & INSN_SDT_U) { if (rn != eR15) rnv = (GetRegister(rn) + off); else rnv = (R15 & ADDRESS_MASK) + off; } else { if (rn != eR15) rnv = (GetRegister(rn) - off); else rnv = (R15 & ADDRESS_MASK) - off; } if (insn & INSN_SDT_W) { SetRegister(rn,rnv); if (ARM_DEBUG_CORE && rn == eR15) logerror("writeback R15 %08x\n", R15); } else if (rn == eR15) { rnv = rnv + 8; } } else { /* Post-indexed addressing */ if (rn == eR15) { rnv = (R15 & ADDRESS_MASK) + 8; } else { rnv = GetRegister(rn); } } /* Do the transfer */ rd = (insn & INSN_RD) >> INSN_RD_SHIFT; if (insn & INSN_SDT_L) { /* Load */ m_icount -= S_CYCLE + I_CYCLE + N_CYCLE; if (insn & INSN_SDT_B) { if (ARM_DEBUG_CORE && rd == eR15) logerror("read byte R15 %08x\n", R15); SetRegister(rd,(uint32_t) cpu_read8(rnv) ); } else { if (rd == eR15) { R15 = (cpu_read32(rnv) & ADDRESS_MASK) | (R15 & PSR_MASK) | (R15 & IRQ_MASK) | (R15 & MODE_MASK); /* The docs are explicit in that the bottom bits should be masked off when writing to R15 in this way, however World Cup Volleyball 95 has an example of an unaligned jump (bottom bits = 2) where execution should definitely continue from the rounded up address. In other cases, 4 is subracted from R15 here to account for pipelining. */ if ((cpu_read32(rnv)&3)==0) R15 -= 4; m_icount -= S_CYCLE + N_CYCLE; } else { SetRegister(rd, cpu_read32(rnv)); } } } else { /* Store */ m_icount -= 2 * N_CYCLE; if (insn & INSN_SDT_B) { if (ARM_DEBUG_CORE && rd==eR15) logerror("Wrote R15 in byte mode\n"); cpu_write8(rnv, (uint8_t) GetRegister(rd) & 0xffu); } else { if (ARM_DEBUG_CORE && rd==eR15) logerror("Wrote R15 in 32bit mode\n"); cpu_write32(rnv, rd == eR15 ? R15 + 8 : GetRegister(rd)); } } /* Do post-indexing writeback */ if (!(insn & INSN_SDT_P)/* && (insn&INSN_SDT_W)*/) { if (insn & INSN_SDT_U) { /* Writeback is applied in pipeline, before value is read from mem, so writeback is effectively ignored */ if (rd==rn) { SetRegister(rn,GetRegister(rd)); } else { if ((insn&INSN_SDT_W)!=0) logerror("%08x: RegisterWritebackIncrement %d %d %d\n",R15,(insn & INSN_SDT_P)!=0,(insn&INSN_SDT_W)!=0,(insn & INSN_SDT_U)!=0); SetRegister(rn,(rnv + off)); } } else { /* Writeback is applied in pipeline, before value is read from mem, so writeback is effectively ignored */ if (rd==rn) { SetRegister(rn,GetRegister(rd)); } else { SetRegister(rn,(rnv - off)); if ((insn&INSN_SDT_W)!=0) logerror("%08x: RegisterWritebackDecrement %d %d %d\n",R15,(insn & INSN_SDT_P)!=0,(insn&INSN_SDT_W)!=0,(insn & INSN_SDT_U)!=0); } } } } /* HandleMemSingle */ #define IsNeg(i) ((i) >> 31) #define IsPos(i) ((~(i)) >> 31) /* Set NZCV flags for ADDS / SUBS */ #define HandleALUAddFlags(rd, rn, op2) \ if (insn & INSN_S) \ R15 = \ ((R15 &~ (N_MASK | Z_MASK | V_MASK | C_MASK)) \ | (((!SIGN_BITS_DIFFER(rn, op2)) && SIGN_BITS_DIFFER(rn, rd)) \ << V_BIT) \ | (((~(rn)) < (op2)) << C_BIT) \ | HandleALUNZFlags(rd)) \ + 4; \ else R15 += 4; #define HandleALUSubFlags(rd, rn, op2) \ if (insn & INSN_S) \ R15 = \ ((R15 &~ (N_MASK | Z_MASK | V_MASK | C_MASK)) \ | ((SIGN_BITS_DIFFER(rn, op2) && SIGN_BITS_DIFFER(rn, rd)) \ << V_BIT) \ | (((IsNeg(rn) & IsPos(op2)) | (IsNeg(rn) & IsPos(rd)) | (IsPos(op2) & IsPos(rd))) ? C_MASK : 0) \ | HandleALUNZFlags(rd)) \ + 4; \ else R15 += 4; /* Set NZC flags for logical operations. */ #define HandleALUNZFlags(rd) \ (((rd) & SIGN_BIT) | ((!(rd)) << Z_BIT)) #define HandleALULogicalFlags(rd, sc) \ if (insn & INSN_S) \ R15 = ((R15 &~ (N_MASK | Z_MASK | C_MASK)) \ | HandleALUNZFlags(rd) \ | (((sc) != 0) << C_BIT)) + 4; \ else R15 += 4; void arm_cpu_device::HandleALU( uint32_t insn ) { uint32_t op2, sc=0, rd, rn, opcode; uint32_t by, rdn; opcode = (insn & INSN_OPCODE) >> INSN_OPCODE_SHIFT; m_icount -= S_CYCLE; rd = 0; rn = 0; /* Construct Op2 */ if (insn & INSN_I) { /* Immediate constant */ by = (insn & INSN_OP2_ROTATE) >> INSN_OP2_ROTATE_SHIFT; if (by) { op2 = ROR(insn & INSN_OP2_IMM, by << 1); sc = op2 & SIGN_BIT; } else { op2 = insn & INSN_OP2; sc = R15 & C_MASK; } } else { op2 = decodeShift(insn, (insn & INSN_S) ? &sc : nullptr); if (!(insn & INSN_S)) sc=0; } /* Calculate Rn to account for pipelining */ if ((opcode & 0xd) != 0xd) /* No Rn in MOV */ { if ((rn = (insn & INSN_RN) >> INSN_RN_SHIFT) == eR15) { if (ARM_DEBUG_CORE) logerror("%08x: Pipelined R15 (Shift %d)\n",R15,(insn&INSN_I?8:insn&0x10u?12:12)); /* Docs strongly suggest the mode bits should be included here, but it breaks Captain America, as it starts doing unaligned reads */ rn=(R15+8)&ADDRESS_MASK; } else { rn = GetRegister(rn); } } /* Perform the operation */ switch ((insn & INSN_OPCODE) >> INSN_OPCODE_SHIFT) { /* Arithmetic operations */ case OPCODE_SBC: rd = (rn - op2 - (R15 & C_MASK ? 0 : 1)); HandleALUSubFlags(rd, rn, op2); break; case OPCODE_CMP: case OPCODE_SUB: rd = (rn - op2); HandleALUSubFlags(rd, rn, op2); break; case OPCODE_RSC: rd = (op2 - rn - (R15 & C_MASK ? 0 : 1)); HandleALUSubFlags(rd, op2, rn); break; case OPCODE_RSB: rd = (op2 - rn); HandleALUSubFlags(rd, op2, rn); break; case OPCODE_ADC: rd = (rn + op2 + ((R15 & C_MASK) >> C_BIT)); HandleALUAddFlags(rd, rn, op2); break; case OPCODE_CMN: case OPCODE_ADD: rd = (rn + op2); HandleALUAddFlags(rd, rn, op2); break; /* Logical operations */ case OPCODE_AND: case OPCODE_TST: rd = rn & op2; HandleALULogicalFlags(rd, sc); break; case OPCODE_BIC: rd = rn &~ op2; HandleALULogicalFlags(rd, sc); break; case OPCODE_TEQ: case OPCODE_EOR: rd = rn ^ op2; HandleALULogicalFlags(rd, sc); break; case OPCODE_ORR: rd = rn | op2; HandleALULogicalFlags(rd, sc); break; case OPCODE_MOV: rd = op2; HandleALULogicalFlags(rd, sc); break; case OPCODE_MVN: rd = (~op2); HandleALULogicalFlags(rd, sc); break; } /* Put the result in its register if not a test */ rdn = (insn & INSN_RD) >> INSN_RD_SHIFT; if ((opcode & 0xc) != 0x8) { if (rdn == eR15 && !(insn & INSN_S)) { /* Merge the old NZCV flags into the new PC value */ R15 = (rd & ADDRESS_MASK) | (R15 & PSR_MASK) | (R15 & IRQ_MASK) | (R15&MODE_MASK); m_icount -= S_CYCLE + N_CYCLE; } else { if (rdn==eR15) { /* S Flag is set - update PSR & mode if in non-user mode only */ if ((R15&MODE_MASK)!=0) { SetRegister(rdn,rd); } else { SetRegister(rdn,(rd&ADDRESS_MASK) | (rd&PSR_MASK) | (R15&IRQ_MASK) | (R15&MODE_MASK)); } m_icount -= S_CYCLE + N_CYCLE; } else { SetRegister(rdn,rd); } } /* TST & TEQ can affect R15 (the condition code register) with the S bit set */ } else if ((rdn==eR15) && (insn & INSN_S)) { // update only the flags if ((R15&MODE_MASK)!=0) { // combine the flags from rd with the address from R15 rd &= ~ADDRESS_MASK; rd |= (R15 & ADDRESS_MASK); SetRegister(rdn,rd); } else { // combine the flags from rd with the address from R15 rd &= ~ADDRESS_MASK; // clear address part of RD rd |= (R15 & ADDRESS_MASK); // RD = address part of R15 SetRegister(rdn,(rd&ADDRESS_MASK) | (rd&PSR_MASK) | (R15&IRQ_MASK) | (R15&MODE_MASK)); } m_icount -= S_CYCLE + N_CYCLE; } } void arm_cpu_device::HandleMul( uint32_t insn) { uint32_t r; m_icount -= S_CYCLE + I_CYCLE; /* should be: Range of Rs Number of cycles &0 -- &1 1S + 1I &2 -- &7 1S + 2I &8 -- &1F 1S + 3I &20 -- &7F 1S + 4I &80 -- &1FF 1S + 5I &200 -- &7FF 1S + 6I &800 -- &1FFF 1S + 7I &2000 -- &7FFF 1S + 8I &8000 -- &1FFFF 1S + 9I &20000 -- &7FFFF 1S + 10I &80000 -- &1FFFFF 1S + 11I &200000 -- &7FFFFF 1S + 12I &800000 -- &1FFFFFF 1S + 13I &2000000 -- &7FFFFFF 1S + 14I &8000000 -- &1FFFFFFF 1S + 15I &20000000 -- &FFFFFFFF 1S + 16I */ /* Do the basic multiply of Rm and Rs */ r = GetRegister( insn&INSN_MUL_RM ) * GetRegister( (insn&INSN_MUL_RS)>>INSN_MUL_RS_SHIFT ); if (ARM_DEBUG_CORE && ((insn&INSN_MUL_RM)==0xf || ((insn&INSN_MUL_RS)>>INSN_MUL_RS_SHIFT )==0xf || ((insn&INSN_MUL_RN)>>INSN_MUL_RN_SHIFT)==0xf) ) logerror("%08x: R15 used in mult\n",R15); /* Add on Rn if this is a MLA */ if (insn & INSN_MUL_A) { r += GetRegister((insn&INSN_MUL_RN)>>INSN_MUL_RN_SHIFT); } /* Write the result */ SetRegister((insn&INSN_MUL_RD)>>INSN_MUL_RD_SHIFT,r); /* Set N and Z if asked */ if( insn & INSN_S ) { R15 = (R15 &~ (N_MASK | Z_MASK)) | HandleALUNZFlags(r); } } int arm_cpu_device::loadInc(uint32_t pat, uint32_t rbv, uint32_t s) { int i,result; result = 0; for( i=0; i<16; i++ ) { if( (pat>>i)&1 ) { if (i==15) { if (s) /* Pull full contents from stack */ SetRegister( 15, cpu_read32(rbv+=4) ); else /* Pull only address, preserve mode & status flags */ SetRegister( 15, (R15&PSR_MASK) | (R15&IRQ_MASK) | (R15&MODE_MASK) | ((cpu_read32(rbv+=4))&ADDRESS_MASK) ); } else SetRegister( i, cpu_read32(rbv+=4) ); result++; } } return result; } int arm_cpu_device::loadDec(uint32_t pat, uint32_t rbv, uint32_t s, uint32_t* deferredR15, int* defer) { int i,result; result = 0; for( i=15; i>=0; i-- ) { if( (pat>>i)&1 ) { if (i==15) { *defer=1; if (s) /* Pull full contents from stack */ *deferredR15=cpu_read32(rbv-=4); else /* Pull only address, preserve mode & status flags */ *deferredR15=(R15&PSR_MASK) | (R15&IRQ_MASK) | (R15&MODE_MASK) | ((cpu_read32(rbv-=4))&ADDRESS_MASK); } else SetRegister( i, cpu_read32(rbv -=4) ); result++; } } return result; } int arm_cpu_device::storeInc(uint32_t pat, uint32_t rbv) { int i,result; result = 0; for( i=0; i<16; i++ ) { if( (pat>>i)&1 ) { if (ARM_DEBUG_CORE && i==15) /* R15 is plus 12 from address of STM */ logerror("%08x: StoreInc on R15\n",R15); cpu_write32( rbv += 4, GetRegister(i) ); result++; } } return result; } /* storeInc */ int arm_cpu_device::storeDec(uint32_t pat, uint32_t rbv) { int i,result; result = 0; for( i=15; i>=0; i-- ) { if( (pat>>i)&1 ) { if (ARM_DEBUG_CORE && i==15) /* R15 is plus 12 from address of STM */ logerror("%08x: StoreDec on R15\n",R15); cpu_write32( rbv -= 4, GetRegister(i) ); result++; } } return result; } /* storeDec */ void arm_cpu_device::HandleMemBlock( uint32_t insn ) { uint32_t rb = (insn & INSN_RN) >> INSN_RN_SHIFT; uint32_t rbp = GetRegister(rb); int result; if (ARM_DEBUG_CORE && insn & INSN_BDT_S) logerror("%08x: S Bit set in MEMBLOCK\n",R15); if (insn & INSN_BDT_L) { /* Loading */ if (insn & INSN_BDT_U) { int mode = MODE; /* Incrementing */ if (!(insn & INSN_BDT_P)) rbp = rbp + (- 4); // S Flag Set, but R15 not in list = Transfers to User Bank if ((insn & INSN_BDT_S) && !(insn & 0x8000)) { int curmode = MODE; R15 = R15 & ~MODE_MASK; result = loadInc( insn & 0xffff, rbp, insn&INSN_BDT_S ); R15 = R15 | curmode; } else result = loadInc( insn & 0xffff, rbp, insn&INSN_BDT_S ); if (insn & 0x8000) { R15-=4; m_icount -= S_CYCLE + N_CYCLE; } if (insn & INSN_BDT_W) { /* Arm docs notes: The base register can always be loaded without any problems. However, don't specify writeback if the base register is being loaded - you can't end up with both a written-back value and a loaded value in the base register! However - Fighter's History does exactly that at 0x121e4 (LDMUW [R13], { R13-R15 })! This emulator implementation skips applying writeback in this case, which is confirmed correct for this situation, but that is not necessarily true for all ARM hardware implementations (the results are officially undefined). */ if (ARM_DEBUG_CORE && rb==15) logerror("%08x: Illegal LDRM writeback to r15\n",R15); if ((insn&(1<> INSN_OP2_SHIFT_SHIFT; uint32_t rm = GetRegister( insn & INSN_OP2_RM ); uint32_t t = (insn & INSN_OP2_SHIFT_TYPE) >> INSN_OP2_SHIFT_TYPE_SHIFT; if ((insn & INSN_OP2_RM)==0xf) { /* If hardwired shift, then PC is 8 bytes ahead, else if register shift is used, then 12 bytes - TODO?? */ rm+=8; } /* All shift types ending in 1 are Rk, not #k */ if( t & 1 ) { // logerror("%08x: RegShift %02x %02x\n",R15, k>>1,GetRegister(k >> 1)); if (ARM_DEBUG_CORE && (insn&0x80)==0x80) logerror("%08x: RegShift ERROR (p36)\n",R15); // Only the least significant byte of the contents of Rs is used to determine the shift amount k = GetRegister(k >> 1) & 0xff; m_icount -= S_CYCLE; if( k == 0 ) /* Register shift by 0 is a no-op */ { // logerror("%08x: NO-OP Regshift\n",R15); if (pCarry) *pCarry = R15 & C_MASK; return rm; } } /* Decode the shift type and perform the shift */ switch (t >> 1) { case 0: /* LSL */ if (k >= 32) { if (pCarry) *pCarry = (k == 32) ? rm & 1 : 0; return 0; } else if (pCarry) { *pCarry = k ? (rm & (1 << (32 - k))) : (R15 & C_MASK); } return k ? LSL(rm, k) : rm; case 1: /* LSR */ if (k == 0 || k == 32) { if (pCarry) *pCarry = rm & SIGN_BIT; return 0; } else if (k > 32) { if (pCarry) *pCarry = 0; return 0; } else { if (pCarry) *pCarry = (rm & (1 << (k - 1))); return LSR(rm, k); } case 2: /* ASR */ if (k == 0 || k > 32) k = 32; if (pCarry) *pCarry = (rm & (1 << (k - 1))); if (k >= 32) return rm & SIGN_BIT ? 0xffffffffu : 0; else { if (rm & SIGN_BIT) return LSR(rm, k) | (0xffffffffu << (32 - k)); else return LSR(rm, k); } case 3: /* ROR and RRX */ if (k) { while (k > 32) k -= 32; if (pCarry) *pCarry = rm & (1 << (k - 1)); return ROR(rm, k); } else { if (pCarry) *pCarry = (rm & 1); return LSR(rm, 1) | ((R15 & C_MASK) << 2); } } logerror("%08x: Decodeshift error\n",R15); return 0; } /* decodeShift */ uint32_t arm_cpu_device::BCDToDecimal(uint32_t value) { uint32_t accumulator = 0; uint32_t multiplier = 1; int i; for(i = 0; i < 8; i++) { accumulator += (value & 0xF) * multiplier; multiplier *= 10; value >>= 4; } return accumulator; } uint32_t arm_cpu_device::DecimalToBCD(uint32_t value) { uint32_t accumulator = 0; uint32_t divisor = 10; int i; for(i = 0; i < 8; i++) { uint32_t temp; temp = value % divisor; value -= temp; temp /= divisor / 10; accumulator += temp << (i * 4); divisor *= 10; } return accumulator; } void arm_cpu_device::HandleCoProVL86C020( uint32_t insn ) { uint32_t rn=(insn>>12)&0xf; uint32_t crn=(insn>>16)&0xf; m_icount -= S_CYCLE; /* MRC - transfer copro register to main register */ if( (insn&0x0f100010)==0x0e100010 ) { if(crn == 0) // ID, read only { /* 0x41<<24 <- Designer code, Acorn Computer Ltd. 0x56<<16 <- Manufacturer code, VLSI Technology Inc. 0x03<<8 <- Part type, VLC86C020 0x00<<0 <- Revision number, 0 */ SetRegister(rn, 0x41560300); //machine().debug_break(); } else SetRegister(rn, m_coproRegister[crn]); } /* MCR - transfer main register to copro register */ else if( (insn&0x0f100010)==0x0e000010 ) { if(crn != 0) m_coproRegister[crn]=GetRegister(rn); //printf("%08x: VL86C020 copro instruction write %08x %d %d\n", R15 & 0x3ffffff, insn,rn,crn); } else { printf("%08x: Unimplemented VL86C020 copro instruction %08x %d %d\n", R15 & 0x3ffffff, insn,rn,crn); machine().debug_break(); } } void arm_cpu_device::HandleCoPro( uint32_t insn ) { uint32_t rn=(insn>>12)&0xf; uint32_t crn=(insn>>16)&0xf; m_icount -= S_CYCLE; /* MRC - transfer copro register to main register */ if( (insn&0x0f100010)==0x0e100010 ) { SetRegister(rn, m_coproRegister[crn]); if (ARM_DEBUG_COPRO) logerror("%08x: Copro read CR%d (%08x) to R%d\n", R15, crn, m_coproRegister[crn], rn); } /* MCR - transfer main register to copro register */ else if( (insn&0x0f100010)==0x0e000010 ) { m_coproRegister[crn]=GetRegister(rn); /* Data East 156 copro specific - trigger BCD operation */ if (crn==2) { if (m_coproRegister[crn]==0) { /* Unpack BCD */ int v0=BCDToDecimal(m_coproRegister[0]); int v1=BCDToDecimal(m_coproRegister[1]); /* Repack vcd */ m_coproRegister[5]=DecimalToBCD(v0+v1); if (ARM_DEBUG_COPRO) logerror("Cmd: Add 0 + 1, result in 5 (%08x + %08x == %08x)\n", v0, v1, m_coproRegister[5]); } else if (m_coproRegister[crn]==1) { /* Unpack BCD */ int v0=BCDToDecimal(m_coproRegister[0]); int v1=BCDToDecimal(m_coproRegister[1]); /* Repack vcd */ m_coproRegister[5]=DecimalToBCD(v0*v1); if (ARM_DEBUG_COPRO) logerror("Cmd: Multiply 0 * 1, result in 5 (%08x * %08x == %08x)\n", v0, v1, m_coproRegister[5]); } else if (m_coproRegister[crn]==3) { /* Unpack BCD */ int v0=BCDToDecimal(m_coproRegister[0]); int v1=BCDToDecimal(m_coproRegister[1]); /* Repack vcd */ m_coproRegister[5]=DecimalToBCD(v0-v1); if (ARM_DEBUG_COPRO) logerror("Cmd: Sub 0 - 1, result in 5 (%08x - %08x == %08x)\n", v0, v1, m_coproRegister[5]); } else { logerror("Unknown bcd copro command %08x\n", m_coproRegister[crn]); } } if (ARM_DEBUG_COPRO) logerror("%08x: Copro write R%d (%08x) to CR%d\n", R15, rn, GetRegister(rn), crn); } /* CDP - perform copro operation */ else if( (insn&0x0f000010)==0x0e000000 ) { /* Data East 156 copro specific divider - result in reg 3/4 */ if (m_coproRegister[1]) { m_coproRegister[3]=m_coproRegister[0] / m_coproRegister[1]; m_coproRegister[4]=m_coproRegister[0] % m_coproRegister[1]; } else { /* Unverified */ m_coproRegister[3]=0xffffffff; m_coproRegister[4]=0xffffffff; } if (ARM_DEBUG_COPRO) logerror("%08x: Copro cdp (%08x) (3==> %08x, 4==> %08x)\n", R15, insn, m_coproRegister[3], m_coproRegister[4]); } else { logerror("%08x: Unimplemented copro instruction %08x\n", R15, insn); } } offs_t arm_cpu_device::disasm_disassemble(char *buffer, offs_t pc, const uint8_t *oprom, const uint8_t *opram, uint32_t options) { extern CPU_DISASSEMBLE( arm ); return CPU_DISASSEMBLE_NAME(arm)(this, buffer, pc, oprom, opram, options); } offs_t arm_be_cpu_device::disasm_disassemble(char *buffer, offs_t pc, const uint8_t *oprom, const uint8_t *opram, uint32_t options) { extern CPU_DISASSEMBLE( arm_be ); return CPU_DISASSEMBLE_NAME(arm_be)(this, buffer, pc, oprom, opram, options); }