1/* Copyright (c) 2013-2014 Jeffrey Pfau
  2 *
  3 * This Source Code Form is subject to the terms of the Mozilla Public
  4 * License, v. 2.0. If a copy of the MPL was not distributed with this
  5 * file, You can obtain one at http://mozilla.org/MPL/2.0/. */
  6#ifndef ISA_INLINES_H
  7#define ISA_INLINES_H
  8
  9#include "macros.h"
 10
 11#include "arm.h"
 12
 13#define ARM_COND_EQ (cpu->cpsr.z)
 14#define ARM_COND_NE (!cpu->cpsr.z)
 15#define ARM_COND_CS (cpu->cpsr.c)
 16#define ARM_COND_CC (!cpu->cpsr.c)
 17#define ARM_COND_MI (cpu->cpsr.n)
 18#define ARM_COND_PL (!cpu->cpsr.n)
 19#define ARM_COND_VS (cpu->cpsr.v)
 20#define ARM_COND_VC (!cpu->cpsr.v)
 21#define ARM_COND_HI (cpu->cpsr.c && !cpu->cpsr.z)
 22#define ARM_COND_LS (!cpu->cpsr.c || cpu->cpsr.z)
 23#define ARM_COND_GE (!cpu->cpsr.n == !cpu->cpsr.v)
 24#define ARM_COND_LT (!cpu->cpsr.n != !cpu->cpsr.v)
 25#define ARM_COND_GT (!cpu->cpsr.z && !cpu->cpsr.n == !cpu->cpsr.v)
 26#define ARM_COND_LE (cpu->cpsr.z || !cpu->cpsr.n != !cpu->cpsr.v)
 27#define ARM_COND_AL 1
 28
 29#define ARM_SIGN(I) ((I) >> 31)
 30#define ARM_SXT_8(I) (((int8_t) (I) << 24) >> 24)
 31#define ARM_SXT_16(I) (((int16_t) (I) << 16) >> 16)
 32#define ARM_UXT_64(I) (uint64_t)(uint32_t) (I)
 33
 34#define ARM_CARRY_FROM(M, N, D) (((uint32_t) (M) >> 31) + ((uint32_t) (N) >> 31) > ((uint32_t) (D) >> 31))
 35#define ARM_BORROW_FROM(M, N, D) (((uint32_t) (M)) >= ((uint32_t) (N)))
 36#define ARM_BORROW_FROM_CARRY(M, N, D, C) (ARM_UXT_64(M) >= (ARM_UXT_64(N)) + (uint64_t) (C))
 37#define ARM_V_ADDITION(M, N, D) (!(ARM_SIGN((M) ^ (N))) && (ARM_SIGN((M) ^ (D))))
 38#define ARM_V_SUBTRACTION(M, N, D) ((ARM_SIGN((M) ^ (N))) && (ARM_SIGN((M) ^ (D))))
 39
 40#define ARM_WAIT_MUL(R, WAIT)                                             \
 41	{                                                                     \
 42		int32_t wait = WAIT;                                              \
 43		if ((R & 0xFFFFFF00) == 0xFFFFFF00 || !(R & 0xFFFFFF00)) {        \
 44			wait += 1;                                                    \
 45		} else if ((R & 0xFFFF0000) == 0xFFFF0000 || !(R & 0xFFFF0000)) { \
 46			wait += 2;                                                    \
 47		} else if ((R & 0xFF000000) == 0xFF000000 || !(R & 0xFF000000)) { \
 48			wait += 3;                                                    \
 49		} else {                                                          \
 50			wait += 4;                                                    \
 51		}                                                                 \
 52		currentCycles += cpu->memory.stall(cpu, wait);                    \
 53	}
 54
 55#define ARM_STUB cpu->irqh.hitStub(cpu, opcode)
 56#define ARM_ILL cpu->irqh.hitIllegal(cpu, opcode)
 57
 58static inline int32_t ARMWritePC(struct ARMCore* cpu) {
 59	uint32_t pc = cpu->gprs[ARM_PC] & -WORD_SIZE_ARM;
 60	cpu->memory.setActiveRegion(cpu, pc);
 61	LOAD_32(cpu->prefetch[0], pc & cpu->memory.activeMask, cpu->memory.activeRegion);
 62	pc += WORD_SIZE_ARM;
 63	LOAD_32(cpu->prefetch[1], pc & cpu->memory.activeMask, cpu->memory.activeRegion);
 64	cpu->gprs[ARM_PC] = pc;
 65	return 2 + cpu->memory.activeNonseqCycles32 + cpu->memory.activeSeqCycles32;
 66}
 67
 68static inline int32_t ThumbWritePC(struct ARMCore* cpu) {
 69	uint32_t pc = cpu->gprs[ARM_PC] & -WORD_SIZE_THUMB;
 70	cpu->memory.setActiveRegion(cpu, pc);
 71	LOAD_16(cpu->prefetch[0], pc & cpu->memory.activeMask, cpu->memory.activeRegion);
 72	pc += WORD_SIZE_THUMB;
 73	LOAD_16(cpu->prefetch[1], pc & cpu->memory.activeMask, cpu->memory.activeRegion);
 74	cpu->gprs[ARM_PC] = pc;
 75	return 2 + cpu->memory.activeNonseqCycles16 + cpu->memory.activeSeqCycles16;
 76}
 77
 78static inline int _ARMModeHasSPSR(enum PrivilegeMode mode) {
 79	return mode != MODE_SYSTEM && mode != MODE_USER;
 80}
 81
 82static inline void _ARMSetMode(struct ARMCore* cpu, enum ExecutionMode executionMode) {
 83	if (executionMode == cpu->executionMode) {
 84		return;
 85	}
 86
 87	cpu->executionMode = executionMode;
 88	switch (executionMode) {
 89	case MODE_ARM:
 90		cpu->cpsr.t = 0;
 91		break;
 92	case MODE_THUMB:
 93		cpu->cpsr.t = 1;
 94	}
 95	cpu->nextEvent = cpu->cycles;
 96}
 97
 98static inline void _ARMReadCPSR(struct ARMCore* cpu) {
 99	_ARMSetMode(cpu, cpu->cpsr.t);
100	ARMSetPrivilegeMode(cpu, cpu->cpsr.priv);
101	cpu->irqh.readCPSR(cpu);
102}
103
104static inline uint32_t _ARMInstructionLength(struct ARMCore* cpu) {
105	return cpu->cpsr.t == MODE_ARM ? WORD_SIZE_ARM : WORD_SIZE_THUMB;
106}
107
108static inline uint32_t _ARMPCAddress(struct ARMCore* cpu) {
109	return cpu->gprs[ARM_PC] - _ARMInstructionLength(cpu) * 2;
110}
111
112static inline bool ARMTestCondition(struct ARMCore* cpu, unsigned condition) {
113	switch (condition) {
114		case 0x0:
115			return ARM_COND_EQ;
116		case 0x1:
117			return ARM_COND_NE;
118		case 0x2:
119			return ARM_COND_CS;
120		case 0x3:
121			return ARM_COND_CC;
122		case 0x4:
123			return ARM_COND_MI;
124		case 0x5:
125			return ARM_COND_PL;
126		case 0x6:
127			return ARM_COND_VS;
128		case 0x7:
129			return ARM_COND_VC;
130		case 0x8:
131			return ARM_COND_HI;
132		case 0x9:
133			return ARM_COND_LS;
134		case 0xA:
135			return ARM_COND_GE;
136		case 0xB:
137			return ARM_COND_LT;
138		case 0xC:
139			return ARM_COND_GT;
140		case 0xD:
141			return ARM_COND_LE;
142		default:
143			return true;
144	}
145}
146
147static inline enum RegisterBank ARMSelectBank(enum PrivilegeMode mode) {
148	switch (mode) {
149	case MODE_USER:
150	case MODE_SYSTEM:
151		// No banked registers
152		return BANK_NONE;
153	case MODE_FIQ:
154		return BANK_FIQ;
155	case MODE_IRQ:
156		return BANK_IRQ;
157	case MODE_SUPERVISOR:
158		return BANK_SUPERVISOR;
159	case MODE_ABORT:
160		return BANK_ABORT;
161	case MODE_UNDEFINED:
162		return BANK_UNDEFINED;
163	default:
164		// This should be unreached
165		return BANK_NONE;
166	}
167}
168
169#endif