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 (ARMPSRIsZ(cpu->cpsr))
 14#define ARM_COND_NE (!ARMPSRIsZ(cpu->cpsr))
 15#define ARM_COND_CS (ARMPSRIsC(cpu->cpsr))
 16#define ARM_COND_CC (!ARMPSRIsC(cpu->cpsr))
 17#define ARM_COND_MI (ARMPSRIsN(cpu->cpsr))
 18#define ARM_COND_PL (!ARMPSRIsN(cpu->cpsr))
 19#define ARM_COND_VS (ARMPSRIsV(cpu->cpsr))
 20#define ARM_COND_VC (!ARMPSRIsV(cpu->cpsr))
 21#define ARM_COND_HI (ARMPSRIsC(cpu->cpsr) && !ARMPSRIsZ(cpu->cpsr))
 22#define ARM_COND_LS (!ARMPSRIsC(cpu->cpsr) || ARMPSRIsZ(cpu->cpsr))
 23#define ARM_COND_GE (!ARMPSRIsN(cpu->cpsr) == !ARMPSRIsV(cpu->cpsr))
 24#define ARM_COND_LT (!ARMPSRIsN(cpu->cpsr) != !ARMPSRIsV(cpu->cpsr))
 25#define ARM_COND_GT (!ARMPSRIsZ(cpu->cpsr) && !ARMPSRIsN(cpu->cpsr) == !ARMPSRIsV(cpu->cpsr))
 26#define ARM_COND_LE (ARMPSRIsZ(cpu->cpsr) || !ARMPSRIsN(cpu->cpsr) != !ARMPSRIsV(cpu->cpsr))
 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) (UINT_MAX - (uint32_t) (M) < (uint32_t) (N))
 35#define ARM_CARRY_FROM_CARRY(M, N, D, C) (((uint32_t) (M) >> 31) + ((uint32_t) (N) >> 31) > ((uint32_t) (D) >> 31))
 36#define ARM_BORROW_FROM(M, N, D) (((uint32_t) (M)) >= ((uint32_t) (N)))
 37#define ARM_BORROW_FROM_CARRY(M, N, D, C) (ARM_UXT_64(M) >= (ARM_UXT_64(N)) + (uint64_t) (C))
 38#define ARM_V_ADDITION(M, N, D) (!(ARM_SIGN((M) ^ (N))) && (ARM_SIGN((M) ^ (D))) && (ARM_SIGN((N) ^ (D))))
 39#define ARM_V_SUBTRACTION(M, N, D) ((ARM_SIGN((M) ^ (N))) && (ARM_SIGN((M) ^ (D))))
 40
 41#define ARM_WAIT_MUL(R)                                                   \
 42	{                                                                     \
 43		int32_t wait;                                                     \
 44		if ((R & 0xFFFFFF00) == 0xFFFFFF00 || !(R & 0xFFFFFF00)) {        \
 45			wait = 1;                                                     \
 46		} else if ((R & 0xFFFF0000) == 0xFFFF0000 || !(R & 0xFFFF0000)) { \
 47			wait = 2;                                                     \
 48		} else if ((R & 0xFF000000) == 0xFF000000 || !(R & 0xFF000000)) { \
 49			wait = 3;                                                     \
 50		} else {                                                          \
 51			wait = 4;                                                     \
 52		}                                                                 \
 53		currentCycles += cpu->memory.stall(cpu, wait);                    \
 54	}
 55
 56#define ARM_STUB cpu->irqh.hitStub(cpu, opcode)
 57#define ARM_ILL cpu->irqh.hitIllegal(cpu, opcode)
 58
 59#define ARM_WRITE_PC                                                                                 \
 60	cpu->gprs[ARM_PC] = (cpu->gprs[ARM_PC] & -WORD_SIZE_ARM);                                        \
 61	cpu->memory.setActiveRegion(cpu, cpu->gprs[ARM_PC]);                                             \
 62	LOAD_32(cpu->prefetch[0], cpu->gprs[ARM_PC] & cpu->memory.activeMask, cpu->memory.activeRegion); \
 63	cpu->gprs[ARM_PC] += WORD_SIZE_ARM;                                                              \
 64	LOAD_32(cpu->prefetch[1], cpu->gprs[ARM_PC] & cpu->memory.activeMask, cpu->memory.activeRegion); \
 65	currentCycles += 2 + cpu->memory.activeNonseqCycles32 + cpu->memory.activeSeqCycles32;
 66
 67#define THUMB_WRITE_PC                                                                               \
 68	cpu->gprs[ARM_PC] = (cpu->gprs[ARM_PC] & -WORD_SIZE_THUMB);                                      \
 69	cpu->memory.setActiveRegion(cpu, cpu->gprs[ARM_PC]);                                             \
 70	LOAD_16(cpu->prefetch[0], cpu->gprs[ARM_PC] & cpu->memory.activeMask, cpu->memory.activeRegion); \
 71	cpu->gprs[ARM_PC] += WORD_SIZE_THUMB;                                                            \
 72	LOAD_16(cpu->prefetch[1], cpu->gprs[ARM_PC] & cpu->memory.activeMask, cpu->memory.activeRegion); \
 73	currentCycles += 2 + cpu->memory.activeNonseqCycles16 + cpu->memory.activeSeqCycles16;
 74
 75static inline int _ARMModeHasSPSR(enum PrivilegeMode mode) {
 76	return mode != MODE_SYSTEM && mode != MODE_USER;
 77}
 78
 79static inline void _ARMSetMode(struct ARMCore* cpu, enum ExecutionMode executionMode) {
 80	if (executionMode == cpu->executionMode) {
 81		return;
 82	}
 83
 84	cpu->executionMode = executionMode;
 85	switch (executionMode) {
 86	case MODE_ARM:
 87		cpu->cpsr = ARMPSRClearT(cpu->cpsr);
 88		break;
 89	case MODE_THUMB:
 90		cpu->cpsr = ARMPSRFillT(cpu->cpsr);
 91	}
 92	cpu->nextEvent = cpu->cycles;
 93}
 94
 95static inline void _ARMReadCPSR(struct ARMCore* cpu) {
 96	_ARMSetMode(cpu, ARMPSRGetT(cpu->cpsr));
 97	ARMSetPrivilegeMode(cpu, ARMPSRGetPriv(cpu->cpsr));
 98	cpu->irqh.readCPSR(cpu);
 99}
100
101static inline uint32_t _ARMPCAddress(struct ARMCore* cpu) {
102	int instructionLength;
103	if (ARMPSRIsT(cpu->cpsr)) {
104		instructionLength = WORD_SIZE_ARM;
105	} else {
106		instructionLength = WORD_SIZE_THUMB;
107	}
108	return cpu->gprs[ARM_PC] - instructionLength * 2;
109}
110
111#endif