all repos — mgba @ 9c92a29b28d1f81224ba28d5fc83a9481eccd5eb

mGBA Game Boy Advance Emulator

src/arm/isa-arm.c (view raw)

  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#include "isa-arm.h"
  7
  8#include "arm.h"
  9#include "emitter-arm.h"
 10#include "isa-inlines.h"
 11
 12#define PSR_USER_MASK   0xF0000000
 13#define PSR_PRIV_MASK   0x000000CF
 14#define PSR_STATE_MASK  0x00000020
 15
 16// Addressing mode 1
 17static inline void _shiftLSL(struct ARMCore* cpu, uint32_t opcode) {
 18	int rm = opcode & 0x0000000F;
 19	int immediate = (opcode & 0x00000F80) >> 7;
 20	if (!immediate) {
 21		cpu->shifterOperand = cpu->gprs[rm];
 22		cpu->shifterCarryOut = cpu->cpsr.c;
 23	} else {
 24		cpu->shifterOperand = cpu->gprs[rm] << immediate;
 25		cpu->shifterCarryOut = (cpu->gprs[rm] >> (32 - immediate)) & 1;
 26	}
 27}
 28
 29static inline void _shiftLSLR(struct ARMCore* cpu, uint32_t opcode) {
 30	int rm = opcode & 0x0000000F;
 31	int rs = (opcode >> 8) & 0x0000000F;
 32	++cpu->cycles;
 33	int shift = cpu->gprs[rs];
 34	if (rs == ARM_PC) {
 35		shift += 4;
 36	}
 37	shift &= 0xFF;
 38	int32_t shiftVal = cpu->gprs[rm];
 39	if (rm == ARM_PC) {
 40		shiftVal += 4;
 41	}
 42	if (!shift) {
 43		cpu->shifterOperand = shiftVal;
 44		cpu->shifterCarryOut = cpu->cpsr.c;
 45	} else if (shift < 32) {
 46		cpu->shifterOperand = shiftVal << shift;
 47		cpu->shifterCarryOut = (shiftVal >> (32 - shift)) & 1;
 48	} else if (shift == 32) {
 49		cpu->shifterOperand = 0;
 50		cpu->shifterCarryOut = shiftVal & 1;
 51	} else {
 52		cpu->shifterOperand = 0;
 53		cpu->shifterCarryOut = 0;
 54	}
 55}
 56
 57static inline void _shiftLSR(struct ARMCore* cpu, uint32_t opcode) {
 58	int rm = opcode & 0x0000000F;
 59	int immediate = (opcode & 0x00000F80) >> 7;
 60	if (immediate) {
 61		cpu->shifterOperand = ((uint32_t) cpu->gprs[rm]) >> immediate;
 62		cpu->shifterCarryOut = (cpu->gprs[rm] >> (immediate - 1)) & 1;
 63	} else {
 64		cpu->shifterOperand = 0;
 65		cpu->shifterCarryOut = ARM_SIGN(cpu->gprs[rm]);
 66	}
 67}
 68
 69static inline void _shiftLSRR(struct ARMCore* cpu, uint32_t opcode) {
 70	int rm = opcode & 0x0000000F;
 71	int rs = (opcode >> 8) & 0x0000000F;
 72	++cpu->cycles;
 73	int shift = cpu->gprs[rs];
 74	if (rs == ARM_PC) {
 75		shift += 4;
 76	}
 77	shift &= 0xFF;
 78	uint32_t shiftVal = cpu->gprs[rm];
 79	if (rm == ARM_PC) {
 80		shiftVal += 4;
 81	}
 82	if (!shift) {
 83		cpu->shifterOperand = shiftVal;
 84		cpu->shifterCarryOut = cpu->cpsr.c;
 85	} else if (shift < 32) {
 86		cpu->shifterOperand = shiftVal >> shift;
 87		cpu->shifterCarryOut = (shiftVal >> (shift - 1)) & 1;
 88	} else if (shift == 32) {
 89		cpu->shifterOperand = 0;
 90		cpu->shifterCarryOut = shiftVal >> 31;
 91	} else {
 92		cpu->shifterOperand = 0;
 93		cpu->shifterCarryOut = 0;
 94	}
 95}
 96
 97static inline void _shiftASR(struct ARMCore* cpu, uint32_t opcode) {
 98	int rm = opcode & 0x0000000F;
 99	int immediate = (opcode & 0x00000F80) >> 7;
100	if (immediate) {
101		cpu->shifterOperand = cpu->gprs[rm] >> immediate;
102		cpu->shifterCarryOut = (cpu->gprs[rm] >> (immediate - 1)) & 1;
103	} else {
104		cpu->shifterCarryOut = ARM_SIGN(cpu->gprs[rm]);
105		cpu->shifterOperand = cpu->shifterCarryOut;
106	}
107}
108
109static inline void _shiftASRR(struct ARMCore* cpu, uint32_t opcode) {
110	int rm = opcode & 0x0000000F;
111	int rs = (opcode >> 8) & 0x0000000F;
112	++cpu->cycles;
113	int shift = cpu->gprs[rs];
114	if (rs == ARM_PC) {
115		shift += 4;
116	}
117	shift &= 0xFF;
118	int shiftVal =  cpu->gprs[rm];
119	if (rm == ARM_PC) {
120		shiftVal += 4;
121	}
122	if (!shift) {
123		cpu->shifterOperand = shiftVal;
124		cpu->shifterCarryOut = cpu->cpsr.c;
125	} else if (shift < 32) {
126		cpu->shifterOperand = shiftVal >> shift;
127		cpu->shifterCarryOut = (shiftVal >> (shift - 1)) & 1;
128	} else if (cpu->gprs[rm] >> 31) {
129		cpu->shifterOperand = 0xFFFFFFFF;
130		cpu->shifterCarryOut = 1;
131	} else {
132		cpu->shifterOperand = 0;
133		cpu->shifterCarryOut = 0;
134	}
135}
136
137static inline void _shiftROR(struct ARMCore* cpu, uint32_t opcode) {
138	int rm = opcode & 0x0000000F;
139	int immediate = (opcode & 0x00000F80) >> 7;
140	if (immediate) {
141		cpu->shifterOperand = ARM_ROR(cpu->gprs[rm], immediate);
142		cpu->shifterCarryOut = (cpu->gprs[rm] >> (immediate - 1)) & 1;
143	} else {
144		// RRX
145		cpu->shifterOperand = (cpu->cpsr.c << 31) | (((uint32_t) cpu->gprs[rm]) >> 1);
146		cpu->shifterCarryOut = cpu->gprs[rm] & 0x00000001;
147	}
148}
149
150static inline void _shiftRORR(struct ARMCore* cpu, uint32_t opcode) {
151	int rm = opcode & 0x0000000F;
152	int rs = (opcode >> 8) & 0x0000000F;
153	++cpu->cycles;
154	int shift = cpu->gprs[rs];
155	if (rs == ARM_PC) {
156		shift += 4;
157	}
158	shift &= 0xFF;
159	int shiftVal =  cpu->gprs[rm];
160	if (rm == ARM_PC) {
161		shiftVal += 4;
162	}
163	int rotate = shift & 0x1F;
164	if (!shift) {
165		cpu->shifterOperand = shiftVal;
166		cpu->shifterCarryOut = cpu->cpsr.c;
167	} else if (rotate) {
168		cpu->shifterOperand = ARM_ROR(shiftVal, rotate);
169		cpu->shifterCarryOut = (shiftVal >> (rotate - 1)) & 1;
170	} else {
171		cpu->shifterOperand = shiftVal;
172		cpu->shifterCarryOut = ARM_SIGN(shiftVal);
173	}
174}
175
176static inline void _immediate(struct ARMCore* cpu, uint32_t opcode) {
177	int rotate = (opcode & 0x00000F00) >> 7;
178	int immediate = opcode & 0x000000FF;
179	if (!rotate) {
180		cpu->shifterOperand = immediate;
181		cpu->shifterCarryOut = cpu->cpsr.c;
182	} else {
183		cpu->shifterOperand = ARM_ROR(immediate, rotate);
184		cpu->shifterCarryOut = ARM_SIGN(cpu->shifterOperand);
185	}
186}
187
188// Instruction definitions
189// Beware pre-processor antics
190
191#define NO_EXTEND64(V) (uint64_t)(uint32_t) (V)
192
193#define ARM_ADDITION_S(M, N, D) \
194	if (rd == ARM_PC && _ARMModeHasSPSR(cpu->cpsr.priv)) { \
195		cpu->cpsr = cpu->spsr; \
196		_ARMReadCPSR(cpu); \
197	} else { \
198		cpu->cpsr.n = ARM_SIGN(D); \
199		cpu->cpsr.z = !(D); \
200		cpu->cpsr.c = ARM_CARRY_FROM(M, N, D); \
201		cpu->cpsr.v = ARM_V_ADDITION(M, N, D); \
202	}
203
204#define ARM_SUBTRACTION_S(M, N, D) \
205	if (rd == ARM_PC && _ARMModeHasSPSR(cpu->cpsr.priv)) { \
206		cpu->cpsr = cpu->spsr; \
207		_ARMReadCPSR(cpu); \
208	} else { \
209		cpu->cpsr.n = ARM_SIGN(D); \
210		cpu->cpsr.z = !(D); \
211		cpu->cpsr.c = ARM_BORROW_FROM(M, N, D); \
212		cpu->cpsr.v = ARM_V_SUBTRACTION(M, N, D); \
213	}
214
215#define ARM_NEUTRAL_S(M, N, D) \
216	if (rd == ARM_PC && _ARMModeHasSPSR(cpu->cpsr.priv)) { \
217		cpu->cpsr = cpu->spsr; \
218		_ARMReadCPSR(cpu); \
219	} else { \
220		cpu->cpsr.n = ARM_SIGN(D); \
221		cpu->cpsr.z = !(D); \
222		cpu->cpsr.c = cpu->shifterCarryOut; \
223	}
224
225#define ARM_NEUTRAL_HI_S(DLO, DHI) \
226	cpu->cpsr.n = ARM_SIGN(DHI); \
227	cpu->cpsr.z = !((DHI) | (DLO));
228
229#define ADDR_MODE_2_I_TEST (opcode & 0x00000F80)
230#define ADDR_MODE_2_I ((opcode & 0x00000F80) >> 7)
231#define ADDR_MODE_2_ADDRESS (address)
232#define ADDR_MODE_2_RN (cpu->gprs[rn])
233#define ADDR_MODE_2_RM (cpu->gprs[rm])
234#define ADDR_MODE_2_IMMEDIATE (opcode & 0x00000FFF)
235#define ADDR_MODE_2_INDEX(U_OP, M) (cpu->gprs[rn] U_OP M)
236#define ADDR_MODE_2_WRITEBACK(ADDR) (cpu->gprs[rn] = ADDR)
237#define ADDR_MODE_2_LSL (cpu->gprs[rm] << ADDR_MODE_2_I)
238#define ADDR_MODE_2_LSR (ADDR_MODE_2_I_TEST ? ((uint32_t) cpu->gprs[rm]) >> ADDR_MODE_2_I : 0)
239#define ADDR_MODE_2_ASR (ADDR_MODE_2_I_TEST ? ((int32_t) cpu->gprs[rm]) >> ADDR_MODE_2_I : ((int32_t) cpu->gprs[rm]) >> 31)
240#define ADDR_MODE_2_ROR (ADDR_MODE_2_I_TEST ? ARM_ROR(cpu->gprs[rm], ADDR_MODE_2_I) : (cpu->cpsr.c << 31) | (((uint32_t) cpu->gprs[rm]) >> 1))
241
242#define ADDR_MODE_3_ADDRESS ADDR_MODE_2_ADDRESS
243#define ADDR_MODE_3_RN ADDR_MODE_2_RN
244#define ADDR_MODE_3_RM ADDR_MODE_2_RM
245#define ADDR_MODE_3_IMMEDIATE (((opcode & 0x00000F00) >> 4) | (opcode & 0x0000000F))
246#define ADDR_MODE_3_INDEX(U_OP, M) ADDR_MODE_2_INDEX(U_OP, M)
247#define ADDR_MODE_3_WRITEBACK(ADDR) ADDR_MODE_2_WRITEBACK(ADDR)
248
249#define ADDR_MODE_4_WRITEBACK cpu->gprs[rn] = address
250
251#define ARM_LOAD_POST_BODY \
252	++currentCycles; \
253	if (rd == ARM_PC) { \
254		ARM_WRITE_PC; \
255	}
256
257#define ARM_STORE_POST_BODY \
258	currentCycles += cpu->memory.activeNonseqCycles32 - cpu->memory.activeSeqCycles32;
259
260#define DEFINE_INSTRUCTION_ARM(NAME, BODY) \
261	static void _ARMInstruction ## NAME (struct ARMCore* cpu, uint32_t opcode) { \
262		int currentCycles = ARM_PREFETCH_CYCLES; \
263		BODY; \
264		cpu->cycles += currentCycles; \
265	}
266
267#define DEFINE_ALU_INSTRUCTION_EX_ARM(NAME, S_BODY, SHIFTER, BODY) \
268	DEFINE_INSTRUCTION_ARM(NAME, \
269		int rd = (opcode >> 12) & 0xF; \
270		int rn = (opcode >> 16) & 0xF; \
271		UNUSED(rn); \
272		SHIFTER(cpu, opcode); \
273		BODY; \
274		S_BODY; \
275		if (rd == ARM_PC) { \
276			if (cpu->executionMode == MODE_ARM) { \
277				ARM_WRITE_PC; \
278			} else { \
279				THUMB_WRITE_PC; \
280			} \
281		})
282
283#define DEFINE_ALU_INSTRUCTION_ARM(NAME, S_BODY, BODY) \
284	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _LSL, , _shiftLSL, BODY) \
285	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## S_LSL, S_BODY, _shiftLSL, BODY) \
286	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _LSLR, , _shiftLSLR, BODY) \
287	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## S_LSLR, S_BODY, _shiftLSLR, BODY) \
288	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _LSR, , _shiftLSR, BODY) \
289	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## S_LSR, S_BODY, _shiftLSR, BODY) \
290	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _LSRR, , _shiftLSRR, BODY) \
291	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## S_LSRR, S_BODY, _shiftLSRR, BODY) \
292	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _ASR, , _shiftASR, BODY) \
293	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## S_ASR, S_BODY, _shiftASR, BODY) \
294	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _ASRR, , _shiftASRR, BODY) \
295	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## S_ASRR, S_BODY, _shiftASRR, BODY) \
296	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _ROR, , _shiftROR, BODY) \
297	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## S_ROR, S_BODY, _shiftROR, BODY) \
298	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _RORR, , _shiftRORR, BODY) \
299	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## S_RORR, S_BODY, _shiftRORR, BODY) \
300	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## I, , _immediate, BODY) \
301	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## SI, S_BODY, _immediate, BODY)
302
303#define DEFINE_ALU_INSTRUCTION_S_ONLY_ARM(NAME, S_BODY, BODY) \
304	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _LSL, S_BODY, _shiftLSL, BODY) \
305	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _LSLR, S_BODY, _shiftLSLR, BODY) \
306	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _LSR, S_BODY, _shiftLSR, BODY) \
307	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _LSRR, S_BODY, _shiftLSRR, BODY) \
308	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _ASR, S_BODY, _shiftASR, BODY) \
309	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _ASRR, S_BODY, _shiftASRR, BODY) \
310	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _ROR, S_BODY, _shiftROR, BODY) \
311	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## _RORR, S_BODY, _shiftRORR, BODY) \
312	DEFINE_ALU_INSTRUCTION_EX_ARM(NAME ## I, S_BODY, _immediate, BODY)
313
314#define DEFINE_MULTIPLY_INSTRUCTION_EX_ARM(NAME, BODY, S_BODY) \
315	DEFINE_INSTRUCTION_ARM(NAME, \
316		int rd = (opcode >> 12) & 0xF; \
317		int rdHi = (opcode >> 16) & 0xF; \
318		int rs = (opcode >> 8) & 0xF; \
319		int rm = opcode & 0xF; \
320		UNUSED(rdHi); \
321		ARM_WAIT_MUL(cpu->gprs[rs]); \
322		BODY; \
323		S_BODY; \
324		if (rd == ARM_PC) { \
325			ARM_WRITE_PC; \
326		})
327
328#define DEFINE_MULTIPLY_INSTRUCTION_ARM(NAME, BODY, S_BODY) \
329	DEFINE_MULTIPLY_INSTRUCTION_EX_ARM(NAME, BODY, ) \
330	DEFINE_MULTIPLY_INSTRUCTION_EX_ARM(NAME ## S, BODY, S_BODY)
331
332#define DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME, ADDRESS, WRITEBACK, BODY) \
333	DEFINE_INSTRUCTION_ARM(NAME, \
334		uint32_t address; \
335		int rn = (opcode >> 16) & 0xF; \
336		int rd = (opcode >> 12) & 0xF; \
337		int rm = opcode & 0xF; \
338		UNUSED(rm); \
339		address = ADDRESS; \
340		WRITEBACK; \
341		BODY;)
342
343#define DEFINE_LOAD_STORE_INSTRUCTION_SHIFTER_ARM(NAME, SHIFTER, BODY) \
344	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME, ADDR_MODE_2_RN, ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_INDEX(-, SHIFTER)), BODY) \
345	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## U, ADDR_MODE_2_RN, ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_INDEX(+, SHIFTER)), BODY) \
346	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## P, ADDR_MODE_2_INDEX(-, SHIFTER), , BODY) \
347	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## PW, ADDR_MODE_2_INDEX(-, SHIFTER), ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_ADDRESS), BODY) \
348	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## PU, ADDR_MODE_2_INDEX(+, SHIFTER), , BODY) \
349	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## PUW, ADDR_MODE_2_INDEX(+, SHIFTER), ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_ADDRESS), BODY)
350
351#define DEFINE_LOAD_STORE_INSTRUCTION_ARM(NAME, BODY) \
352	DEFINE_LOAD_STORE_INSTRUCTION_SHIFTER_ARM(NAME ## _LSL_, ADDR_MODE_2_LSL, BODY) \
353	DEFINE_LOAD_STORE_INSTRUCTION_SHIFTER_ARM(NAME ## _LSR_, ADDR_MODE_2_LSR, BODY) \
354	DEFINE_LOAD_STORE_INSTRUCTION_SHIFTER_ARM(NAME ## _ASR_, ADDR_MODE_2_ASR, BODY) \
355	DEFINE_LOAD_STORE_INSTRUCTION_SHIFTER_ARM(NAME ## _ROR_, ADDR_MODE_2_ROR, BODY) \
356	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## I, ADDR_MODE_2_RN, ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_INDEX(-, ADDR_MODE_2_IMMEDIATE)), BODY) \
357	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IU, ADDR_MODE_2_RN, ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_INDEX(+, ADDR_MODE_2_IMMEDIATE)), BODY) \
358	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IP, ADDR_MODE_2_INDEX(-, ADDR_MODE_2_IMMEDIATE), , BODY) \
359	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IPW, ADDR_MODE_2_INDEX(-, ADDR_MODE_2_IMMEDIATE), ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_ADDRESS), BODY) \
360	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IPU, ADDR_MODE_2_INDEX(+, ADDR_MODE_2_IMMEDIATE), , BODY) \
361	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IPUW, ADDR_MODE_2_INDEX(+, ADDR_MODE_2_IMMEDIATE), ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_ADDRESS), BODY) \
362
363#define DEFINE_LOAD_STORE_MODE_3_INSTRUCTION_ARM(NAME, BODY) \
364	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME, ADDR_MODE_3_RN, ADDR_MODE_3_WRITEBACK(ADDR_MODE_3_INDEX(-, ADDR_MODE_3_RM)), BODY) \
365	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## U, ADDR_MODE_3_RN, ADDR_MODE_3_WRITEBACK(ADDR_MODE_3_INDEX(+, ADDR_MODE_3_RM)), BODY) \
366	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## P, ADDR_MODE_3_INDEX(-, ADDR_MODE_3_RM), , BODY) \
367	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## PW, ADDR_MODE_3_INDEX(-, ADDR_MODE_3_RM), ADDR_MODE_3_WRITEBACK(ADDR_MODE_3_ADDRESS), BODY) \
368	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## PU, ADDR_MODE_3_INDEX(+, ADDR_MODE_3_RM), , BODY) \
369	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## PUW, ADDR_MODE_3_INDEX(+, ADDR_MODE_3_RM), ADDR_MODE_3_WRITEBACK(ADDR_MODE_3_ADDRESS), BODY) \
370	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## I, ADDR_MODE_3_RN, ADDR_MODE_3_WRITEBACK(ADDR_MODE_3_INDEX(-, ADDR_MODE_3_IMMEDIATE)), BODY) \
371	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IU, ADDR_MODE_3_RN, ADDR_MODE_3_WRITEBACK(ADDR_MODE_3_INDEX(+, ADDR_MODE_3_IMMEDIATE)), BODY) \
372	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IP, ADDR_MODE_3_INDEX(-, ADDR_MODE_3_IMMEDIATE), , BODY) \
373	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IPW, ADDR_MODE_3_INDEX(-, ADDR_MODE_3_IMMEDIATE), ADDR_MODE_3_WRITEBACK(ADDR_MODE_3_ADDRESS), BODY) \
374	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IPU, ADDR_MODE_3_INDEX(+, ADDR_MODE_3_IMMEDIATE), , BODY) \
375	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IPUW, ADDR_MODE_3_INDEX(+, ADDR_MODE_3_IMMEDIATE), ADDR_MODE_3_WRITEBACK(ADDR_MODE_3_ADDRESS), BODY) \
376
377#define DEFINE_LOAD_STORE_T_INSTRUCTION_SHIFTER_ARM(NAME, SHIFTER, BODY) \
378	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME, SHIFTER, ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_INDEX(-, ADDR_MODE_2_RM)), BODY) \
379	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## U, SHIFTER, ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_INDEX(+, ADDR_MODE_2_RM)), BODY) \
380
381#define DEFINE_LOAD_STORE_T_INSTRUCTION_ARM(NAME, BODY) \
382	DEFINE_LOAD_STORE_T_INSTRUCTION_SHIFTER_ARM(NAME ## _LSL_, ADDR_MODE_2_LSL, BODY) \
383	DEFINE_LOAD_STORE_T_INSTRUCTION_SHIFTER_ARM(NAME ## _LSR_, ADDR_MODE_2_LSR, BODY) \
384	DEFINE_LOAD_STORE_T_INSTRUCTION_SHIFTER_ARM(NAME ## _ASR_, ADDR_MODE_2_ASR, BODY) \
385	DEFINE_LOAD_STORE_T_INSTRUCTION_SHIFTER_ARM(NAME ## _ROR_, ADDR_MODE_2_ROR, BODY) \
386	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## I, ADDR_MODE_2_RN, ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_INDEX(-, ADDR_MODE_2_IMMEDIATE)), BODY) \
387	DEFINE_LOAD_STORE_INSTRUCTION_EX_ARM(NAME ## IU, ADDR_MODE_2_RN, ADDR_MODE_2_WRITEBACK(ADDR_MODE_2_INDEX(+, ADDR_MODE_2_IMMEDIATE)), BODY) \
388
389#define ARM_MS_PRE \
390	enum PrivilegeMode privilegeMode = cpu->privilegeMode; \
391	ARMSetPrivilegeMode(cpu, MODE_SYSTEM);
392
393#define ARM_MS_POST ARMSetPrivilegeMode(cpu, privilegeMode);
394
395#define DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME, LS, WRITEBACK, S_PRE, S_POST, DIRECTION, POST_BODY) \
396	DEFINE_INSTRUCTION_ARM(NAME, \
397		int rn = (opcode >> 16) & 0xF; \
398		int rs = opcode & 0x0000FFFF; \
399		uint32_t address = cpu->gprs[rn]; \
400		S_PRE; \
401		address = cpu->memory. LS ## Multiple(cpu, address, rs, LSM_ ## DIRECTION, &currentCycles); \
402		S_POST; \
403		POST_BODY; \
404		WRITEBACK;)
405
406
407#define DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_ARM(NAME, LS, POST_BODY) \
408	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## DA,   LS,                      ,           ,            , DA, POST_BODY) \
409	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## DAW,  LS, ADDR_MODE_4_WRITEBACK,           ,            , DA, POST_BODY) \
410	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## DB,   LS,                      ,           ,            , DB, POST_BODY) \
411	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## DBW,  LS, ADDR_MODE_4_WRITEBACK,           ,            , DB, POST_BODY) \
412	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## IA,   LS,                      ,           ,            , IA, POST_BODY) \
413	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## IAW,  LS, ADDR_MODE_4_WRITEBACK,           ,            , IA, POST_BODY) \
414	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## IB,   LS,                      ,           ,            , IB, POST_BODY) \
415	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## IBW,  LS, ADDR_MODE_4_WRITEBACK,           ,            , IB, POST_BODY) \
416	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## SDA,  LS,                      , ARM_MS_PRE, ARM_MS_POST, DA, POST_BODY) \
417	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## SDAW, LS, ADDR_MODE_4_WRITEBACK, ARM_MS_PRE, ARM_MS_POST, DA, POST_BODY) \
418	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## SDB,  LS,                      , ARM_MS_PRE, ARM_MS_POST, DB, POST_BODY) \
419	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## SDBW, LS, ADDR_MODE_4_WRITEBACK, ARM_MS_PRE, ARM_MS_POST, DB, POST_BODY) \
420	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## SIA,  LS,                      , ARM_MS_PRE, ARM_MS_POST, IA, POST_BODY) \
421	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## SIAW, LS, ADDR_MODE_4_WRITEBACK, ARM_MS_PRE, ARM_MS_POST, IA, POST_BODY) \
422	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## SIB,  LS,                      , ARM_MS_PRE, ARM_MS_POST, IB, POST_BODY) \
423	DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_EX_ARM(NAME ## SIBW, LS, ADDR_MODE_4_WRITEBACK, ARM_MS_PRE, ARM_MS_POST, IB, POST_BODY)
424
425// Begin ALU definitions
426
427DEFINE_ALU_INSTRUCTION_ARM(ADD, ARM_ADDITION_S(n, cpu->shifterOperand, cpu->gprs[rd]),
428	int32_t n = cpu->gprs[rn];
429	cpu->gprs[rd] = n + cpu->shifterOperand;)
430
431DEFINE_ALU_INSTRUCTION_ARM(ADC, ARM_ADDITION_S(n, cpu->shifterOperand, cpu->gprs[rd]),
432	int32_t n = cpu->gprs[rn];
433	cpu->gprs[rd] = n + cpu->shifterOperand + cpu->cpsr.c;)
434
435DEFINE_ALU_INSTRUCTION_ARM(AND, ARM_NEUTRAL_S(cpu->gprs[rn], cpu->shifterOperand, cpu->gprs[rd]),
436	cpu->gprs[rd] = cpu->gprs[rn] & cpu->shifterOperand;)
437
438DEFINE_ALU_INSTRUCTION_ARM(BIC, ARM_NEUTRAL_S(cpu->gprs[rn], cpu->shifterOperand, cpu->gprs[rd]),
439	cpu->gprs[rd] = cpu->gprs[rn] & ~cpu->shifterOperand;)
440
441DEFINE_ALU_INSTRUCTION_S_ONLY_ARM(CMN, ARM_ADDITION_S(cpu->gprs[rn], cpu->shifterOperand, aluOut),
442	int32_t aluOut = cpu->gprs[rn] + cpu->shifterOperand;)
443
444DEFINE_ALU_INSTRUCTION_S_ONLY_ARM(CMP, ARM_SUBTRACTION_S(cpu->gprs[rn], cpu->shifterOperand, aluOut),
445	int32_t aluOut = cpu->gprs[rn] - cpu->shifterOperand;)
446
447DEFINE_ALU_INSTRUCTION_ARM(EOR, ARM_NEUTRAL_S(cpu->gprs[rn], cpu->shifterOperand, cpu->gprs[rd]),
448	cpu->gprs[rd] = cpu->gprs[rn] ^ cpu->shifterOperand;)
449
450DEFINE_ALU_INSTRUCTION_ARM(MOV, ARM_NEUTRAL_S(cpu->gprs[rn], cpu->shifterOperand, cpu->gprs[rd]),
451	cpu->gprs[rd] = cpu->shifterOperand;)
452
453DEFINE_ALU_INSTRUCTION_ARM(MVN, ARM_NEUTRAL_S(cpu->gprs[rn], cpu->shifterOperand, cpu->gprs[rd]),
454	cpu->gprs[rd] = ~cpu->shifterOperand;)
455
456DEFINE_ALU_INSTRUCTION_ARM(ORR, ARM_NEUTRAL_S(cpu->gprs[rn], cpu->shifterOperand, cpu->gprs[rd]),
457	cpu->gprs[rd] = cpu->gprs[rn] | cpu->shifterOperand;)
458
459DEFINE_ALU_INSTRUCTION_ARM(RSB, ARM_SUBTRACTION_S(cpu->shifterOperand, n, cpu->gprs[rd]),
460	int32_t n = cpu->gprs[rn];
461	cpu->gprs[rd] = cpu->shifterOperand - n;)
462
463DEFINE_ALU_INSTRUCTION_ARM(RSC, ARM_SUBTRACTION_S(cpu->shifterOperand, n, cpu->gprs[rd]),
464	int32_t n = cpu->gprs[rn] + !cpu->cpsr.c;
465	cpu->gprs[rd] = cpu->shifterOperand - n;)
466
467DEFINE_ALU_INSTRUCTION_ARM(SBC, ARM_SUBTRACTION_S(n, shifterOperand, cpu->gprs[rd]),
468	int32_t n = cpu->gprs[rn];
469	int32_t shifterOperand = cpu->shifterOperand + !cpu->cpsr.c;
470	cpu->gprs[rd] = n - shifterOperand;)
471
472DEFINE_ALU_INSTRUCTION_ARM(SUB, ARM_SUBTRACTION_S(n, cpu->shifterOperand, cpu->gprs[rd]),
473	int32_t n = cpu->gprs[rn];
474	cpu->gprs[rd] = n - cpu->shifterOperand;)
475
476DEFINE_ALU_INSTRUCTION_S_ONLY_ARM(TEQ, ARM_NEUTRAL_S(cpu->gprs[rn], cpu->shifterOperand, aluOut),
477	int32_t aluOut = cpu->gprs[rn] ^ cpu->shifterOperand;)
478
479DEFINE_ALU_INSTRUCTION_S_ONLY_ARM(TST, ARM_NEUTRAL_S(cpu->gprs[rn], cpu->shifterOperand, aluOut),
480	int32_t aluOut = cpu->gprs[rn] & cpu->shifterOperand;)
481
482// End ALU definitions
483
484// Begin multiply definitions
485
486DEFINE_MULTIPLY_INSTRUCTION_ARM(MLA, cpu->gprs[rdHi] = cpu->gprs[rm] * cpu->gprs[rs] + cpu->gprs[rd], ARM_NEUTRAL_S(, , cpu->gprs[rdHi]))
487DEFINE_MULTIPLY_INSTRUCTION_ARM(MUL, cpu->gprs[rdHi] = cpu->gprs[rm] * cpu->gprs[rs], ARM_NEUTRAL_S(cpu->gprs[rm], cpu->gprs[rs], cpu->gprs[rdHi]))
488
489DEFINE_MULTIPLY_INSTRUCTION_ARM(SMLAL,
490	int64_t d = ((int64_t) cpu->gprs[rm]) * ((int64_t) cpu->gprs[rs]);
491	int32_t dm = cpu->gprs[rd];
492	int32_t dn = d;
493	cpu->gprs[rd] = dm + dn;
494	cpu->gprs[rdHi] = cpu->gprs[rdHi] + (d >> 32) + ARM_CARRY_FROM(dm, dn, cpu->gprs[rd]);,
495	ARM_NEUTRAL_HI_S(cpu->gprs[rd], cpu->gprs[rdHi]))
496
497DEFINE_MULTIPLY_INSTRUCTION_ARM(SMULL,
498	int64_t d = ((int64_t) cpu->gprs[rm]) * ((int64_t) cpu->gprs[rs]);
499	cpu->gprs[rd] = d;
500	cpu->gprs[rdHi] = d >> 32;,
501	ARM_NEUTRAL_HI_S(cpu->gprs[rd], cpu->gprs[rdHi]))
502
503DEFINE_MULTIPLY_INSTRUCTION_ARM(UMLAL,
504	uint64_t d = NO_EXTEND64(cpu->gprs[rm]) * NO_EXTEND64(cpu->gprs[rs]);
505	int32_t dm = cpu->gprs[rd];
506	int32_t dn = d;
507	cpu->gprs[rd] = dm + dn;
508	cpu->gprs[rdHi] = cpu->gprs[rdHi] + (d >> 32) + ARM_CARRY_FROM(dm, dn, cpu->gprs[rd]);,
509	ARM_NEUTRAL_HI_S(cpu->gprs[rd], cpu->gprs[rdHi]))
510
511DEFINE_MULTIPLY_INSTRUCTION_ARM(UMULL,
512	uint64_t d = NO_EXTEND64(cpu->gprs[rm]) * NO_EXTEND64(cpu->gprs[rs]);
513	cpu->gprs[rd] = d;
514	cpu->gprs[rdHi] = d >> 32;,
515	ARM_NEUTRAL_HI_S(cpu->gprs[rd], cpu->gprs[rdHi]))
516
517// End multiply definitions
518
519// Begin load/store definitions
520
521DEFINE_LOAD_STORE_INSTRUCTION_ARM(LDR, cpu->gprs[rd] = cpu->memory.load32(cpu, address, &currentCycles); ARM_LOAD_POST_BODY;)
522DEFINE_LOAD_STORE_INSTRUCTION_ARM(LDRB, cpu->gprs[rd] = cpu->memory.loadU8(cpu, address, &currentCycles); ARM_LOAD_POST_BODY;)
523DEFINE_LOAD_STORE_MODE_3_INSTRUCTION_ARM(LDRH, cpu->gprs[rd] = cpu->memory.loadU16(cpu, address, &currentCycles); ARM_LOAD_POST_BODY;)
524DEFINE_LOAD_STORE_MODE_3_INSTRUCTION_ARM(LDRSB, cpu->gprs[rd] = cpu->memory.load8(cpu, address, &currentCycles); ARM_LOAD_POST_BODY;)
525DEFINE_LOAD_STORE_MODE_3_INSTRUCTION_ARM(LDRSH, cpu->gprs[rd] = cpu->memory.load16(cpu, address, &currentCycles); ARM_LOAD_POST_BODY;)
526DEFINE_LOAD_STORE_INSTRUCTION_ARM(STR, cpu->memory.store32(cpu, address, cpu->gprs[rd], &currentCycles); ARM_STORE_POST_BODY;)
527DEFINE_LOAD_STORE_INSTRUCTION_ARM(STRB, cpu->memory.store8(cpu, address, cpu->gprs[rd], &currentCycles); ARM_STORE_POST_BODY;)
528DEFINE_LOAD_STORE_MODE_3_INSTRUCTION_ARM(STRH, cpu->memory.store16(cpu, address, cpu->gprs[rd], &currentCycles); ARM_STORE_POST_BODY;)
529
530DEFINE_LOAD_STORE_T_INSTRUCTION_ARM(LDRBT,
531	enum PrivilegeMode priv = cpu->privilegeMode;
532	ARMSetPrivilegeMode(cpu, MODE_USER);
533	cpu->gprs[rd] = cpu->memory.loadU8(cpu, address, &currentCycles);
534	ARMSetPrivilegeMode(cpu, priv);
535	ARM_LOAD_POST_BODY;)
536
537DEFINE_LOAD_STORE_T_INSTRUCTION_ARM(LDRT,
538	enum PrivilegeMode priv = cpu->privilegeMode;
539	ARMSetPrivilegeMode(cpu, MODE_USER);
540	cpu->gprs[rd] = cpu->memory.load32(cpu, address, &currentCycles);
541	ARMSetPrivilegeMode(cpu, priv);
542	ARM_LOAD_POST_BODY;)
543
544DEFINE_LOAD_STORE_T_INSTRUCTION_ARM(STRBT,
545	enum PrivilegeMode priv = cpu->privilegeMode;
546	ARMSetPrivilegeMode(cpu, MODE_USER);
547	cpu->memory.store32(cpu, address, cpu->gprs[rd], &currentCycles);
548	ARMSetPrivilegeMode(cpu, priv);
549	ARM_STORE_POST_BODY;)
550
551DEFINE_LOAD_STORE_T_INSTRUCTION_ARM(STRT,
552	enum PrivilegeMode priv = cpu->privilegeMode;
553	ARMSetPrivilegeMode(cpu, MODE_USER);
554	cpu->memory.store8(cpu, address, cpu->gprs[rd], &currentCycles);
555	ARMSetPrivilegeMode(cpu, priv);
556	ARM_STORE_POST_BODY;)
557
558DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_ARM(LDM,
559	load,
560	++currentCycles;
561	if (rs & 0x8000) {
562		ARM_WRITE_PC;
563	})
564
565DEFINE_LOAD_STORE_MULTIPLE_INSTRUCTION_ARM(STM,
566	store,
567	currentCycles += cpu->memory.activeNonseqCycles32 - cpu->memory.activeSeqCycles32)
568
569DEFINE_INSTRUCTION_ARM(SWP,
570	int rm = opcode & 0xF;
571	int rd = (opcode >> 12) & 0xF;
572	int rn = (opcode >> 16) & 0xF;
573	int32_t d = cpu->memory.load32(cpu, cpu->gprs[rn], &currentCycles);
574	cpu->memory.store32(cpu, cpu->gprs[rn], cpu->gprs[rm], &currentCycles);
575	cpu->gprs[rd] = d;)
576
577DEFINE_INSTRUCTION_ARM(SWPB,
578	int rm = opcode & 0xF;
579	int rd = (opcode >> 12) & 0xF;
580	int rn = (opcode >> 16) & 0xF;
581	int32_t d = cpu->memory.loadU8(cpu, cpu->gprs[rn], &currentCycles);
582	cpu->memory.store8(cpu, cpu->gprs[rn], cpu->gprs[rm], &currentCycles);
583	cpu->gprs[rd] = d;)
584
585// End load/store definitions
586
587// Begin branch definitions
588
589DEFINE_INSTRUCTION_ARM(B,
590	int32_t offset = opcode << 8;
591	offset >>= 6;
592	cpu->gprs[ARM_PC] += offset;
593	ARM_WRITE_PC;)
594
595DEFINE_INSTRUCTION_ARM(BL,
596	int32_t immediate = (opcode & 0x00FFFFFF) << 8;
597	cpu->gprs[ARM_LR] = cpu->gprs[ARM_PC] - WORD_SIZE_ARM;
598	cpu->gprs[ARM_PC] += immediate >> 6;
599	ARM_WRITE_PC;)
600
601DEFINE_INSTRUCTION_ARM(BX,
602	int rm = opcode & 0x0000000F;
603	_ARMSetMode(cpu, cpu->gprs[rm] & 0x00000001);
604	cpu->gprs[ARM_PC] = cpu->gprs[rm] & 0xFFFFFFFE;
605	if (cpu->executionMode == MODE_THUMB) {
606		THUMB_WRITE_PC;
607	} else {
608		ARM_WRITE_PC;
609	})
610
611// End branch definitions
612
613// Begin coprocessor definitions
614
615DEFINE_INSTRUCTION_ARM(CDP, ARM_STUB)
616DEFINE_INSTRUCTION_ARM(LDC, ARM_STUB)
617DEFINE_INSTRUCTION_ARM(STC, ARM_STUB)
618DEFINE_INSTRUCTION_ARM(MCR, ARM_STUB)
619DEFINE_INSTRUCTION_ARM(MRC, ARM_STUB)
620
621// Begin miscellaneous definitions
622
623DEFINE_INSTRUCTION_ARM(BKPT, ARM_STUB) // Not strictly in ARMv4T, but here for convenience
624DEFINE_INSTRUCTION_ARM(ILL, ARM_ILL) // Illegal opcode
625
626DEFINE_INSTRUCTION_ARM(MSR,
627	int c = opcode & 0x00010000;
628	int f = opcode & 0x00080000;
629	int32_t operand = cpu->gprs[opcode & 0x0000000F];
630	int32_t mask = (c ? 0x000000FF : 0) | (f ? 0xFF000000 : 0);
631	if (mask & PSR_USER_MASK) {
632		cpu->cpsr.packed = (cpu->cpsr.packed & ~PSR_USER_MASK) | (operand & PSR_USER_MASK);
633	}
634	if (cpu->privilegeMode != MODE_USER && (mask & PSR_PRIV_MASK)) {
635		ARMSetPrivilegeMode(cpu, (enum PrivilegeMode) ((operand & 0x0000000F) | 0x00000010));
636		cpu->cpsr.packed = (cpu->cpsr.packed & ~PSR_PRIV_MASK) | (operand & PSR_PRIV_MASK);
637	}
638	_ARMReadCPSR(cpu);)
639
640DEFINE_INSTRUCTION_ARM(MSRR,
641	int c = opcode & 0x00010000;
642	int f = opcode & 0x00080000;
643	int32_t operand = cpu->gprs[opcode & 0x0000000F];
644	int32_t mask = (c ? 0x000000FF : 0) | (f ? 0xFF000000 : 0);
645	mask &= PSR_USER_MASK | PSR_PRIV_MASK | PSR_STATE_MASK;
646	cpu->spsr.packed = (cpu->spsr.packed & ~mask) | (operand & mask);)
647
648DEFINE_INSTRUCTION_ARM(MRS, \
649	int rd = (opcode >> 12) & 0xF; \
650	cpu->gprs[rd] = cpu->cpsr.packed;)
651
652DEFINE_INSTRUCTION_ARM(MRSR, \
653	int rd = (opcode >> 12) & 0xF; \
654	cpu->gprs[rd] = cpu->spsr.packed;)
655
656DEFINE_INSTRUCTION_ARM(MSRI,
657	int c = opcode & 0x00010000;
658	int f = opcode & 0x00080000;
659	int rotate = (opcode & 0x00000F00) >> 7;
660	int32_t operand = ARM_ROR(opcode & 0x000000FF, rotate);
661	int32_t mask = (c ? 0x000000FF : 0) | (f ? 0xFF000000 : 0);
662	if (mask & PSR_USER_MASK) {
663		cpu->cpsr.packed = (cpu->cpsr.packed & ~PSR_USER_MASK) | (operand & PSR_USER_MASK);
664	}
665	if (cpu->privilegeMode != MODE_USER && (mask & PSR_PRIV_MASK)) {
666		ARMSetPrivilegeMode(cpu, (enum PrivilegeMode) ((operand & 0x0000000F) | 0x00000010));
667		cpu->cpsr.packed = (cpu->cpsr.packed & ~PSR_PRIV_MASK) | (operand & PSR_PRIV_MASK);
668	}
669	_ARMReadCPSR(cpu);)
670
671DEFINE_INSTRUCTION_ARM(MSRRI,
672	int c = opcode & 0x00010000;
673	int f = opcode & 0x00080000;
674	int rotate = (opcode & 0x00000F00) >> 7;
675	int32_t operand = ARM_ROR(opcode & 0x000000FF, rotate);
676	int32_t mask = (c ? 0x000000FF : 0) | (f ? 0xFF000000 : 0);
677	mask &= PSR_USER_MASK | PSR_PRIV_MASK | PSR_STATE_MASK;
678	cpu->spsr.packed = (cpu->spsr.packed & ~mask) | (operand & mask);)
679
680DEFINE_INSTRUCTION_ARM(SWI, cpu->irqh.swi32(cpu, opcode & 0xFFFFFF))
681
682const ARMInstruction _armTable[0x1000] = {
683	DECLARE_ARM_EMITTER_BLOCK(_ARMInstruction)
684};