blob: 74e78bad151b9c05c6e890ad273f8bfb31d1afc6 [file] [log] [blame]
Greg Clayton64c84432011-01-21 22:02:52 +00001//===-- EmulateInstructionARM.cpp -------------------------------*- C++ -*-===//
2//
3// The LLVM Compiler Infrastructure
4//
5// This file is distributed under the University of Illinois Open Source
6// License. See LICENSE.TXT for details.
7//
8//===----------------------------------------------------------------------===//
9
10#include "EmulateInstructionARM.h"
Johnny Chen8584c922011-01-26 01:18:52 +000011#include "ARMDefines.h"
Johnny Chen4baf2e32011-01-24 18:24:53 +000012#include "ARMUtils.h"
Greg Clayton64c84432011-01-21 22:02:52 +000013
14using namespace lldb;
15using namespace lldb_private;
16
17// ARM constants used during decoding
18#define REG_RD 0
19#define LDM_REGLIST 1
20#define PC_REG 15
21#define PC_REGLIST_BIT 0x8000
22
Johnny Chen251af6a2011-01-21 22:47:25 +000023#define ARMv4 (1u << 0)
Greg Clayton64c84432011-01-21 22:02:52 +000024#define ARMv4T (1u << 1)
25#define ARMv5T (1u << 2)
26#define ARMv5TE (1u << 3)
27#define ARMv5TEJ (1u << 4)
Johnny Chen251af6a2011-01-21 22:47:25 +000028#define ARMv6 (1u << 5)
Greg Clayton64c84432011-01-21 22:02:52 +000029#define ARMv6K (1u << 6)
30#define ARMv6T2 (1u << 7)
Johnny Chen251af6a2011-01-21 22:47:25 +000031#define ARMv7 (1u << 8)
Johnny Chen60c0d622011-01-25 23:49:39 +000032#define ARMv8 (1u << 9)
Greg Clayton64c84432011-01-21 22:02:52 +000033#define ARMvAll (0xffffffffu)
34
Johnny Chen7dc60e12011-01-24 19:46:32 +000035typedef enum
Greg Clayton64c84432011-01-21 22:02:52 +000036{
37 eEncodingA1,
38 eEncodingA2,
39 eEncodingA3,
40 eEncodingA4,
41 eEncodingA5,
42 eEncodingT1,
43 eEncodingT2,
44 eEncodingT3,
45 eEncodingT4,
46 eEncodingT5,
47} ARMEncoding;
48
Johnny Chen7dc60e12011-01-24 19:46:32 +000049typedef enum
50{
51 eSize16,
52 eSize32
53} ARMInstrSize;
54
Johnny Chen4baf2e32011-01-24 18:24:53 +000055// Typedef for the callback function used during the emulation.
Johnny Chen3c75c762011-01-22 00:47:08 +000056// Pass along (ARMEncoding)encoding as the callback data.
57typedef bool (*EmulateCallback) (EmulateInstructionARM *emulator, ARMEncoding encoding);
58
Johnny Chen7dc60e12011-01-24 19:46:32 +000059typedef struct
Greg Clayton64c84432011-01-21 22:02:52 +000060{
61 uint32_t mask;
62 uint32_t value;
63 uint32_t variants;
64 ARMEncoding encoding;
Johnny Chen7dc60e12011-01-24 19:46:32 +000065 ARMInstrSize size;
Greg Clayton64c84432011-01-21 22:02:52 +000066 EmulateCallback callback;
Johnny Chen4bee8ce2011-01-22 00:59:07 +000067 const char *name;
Johnny Chen7dc60e12011-01-24 19:46:32 +000068} ARMOpcode;
Greg Clayton64c84432011-01-21 22:02:52 +000069
70static bool
Johnny Chence1ca772011-01-25 01:13:00 +000071emulate_push (EmulateInstructionARM *emulator, ARMEncoding encoding)
Greg Clayton64c84432011-01-21 22:02:52 +000072{
73#if 0
74 // ARM pseudo code...
75 if (ConditionPassed())
76 {
77 EncodingSpecificOperations();
78 NullCheckIfThumbEE(13);
79 address = SP - 4*BitCount(registers);
80
81 for (i = 0 to 14)
82 {
83 if (registers<i> == 1’)
84 {
85 if i == 13 && i != LowestSetBit(registers) // Only possible for encoding A1
86 MemA[address,4] = bits(32) UNKNOWN;
87 else
88 MemA[address,4] = R[i];
89 address = address + 4;
90 }
91 }
92
93 if (registers<15> == 1’) // Only possible for encoding A1 or A2
94 MemA[address,4] = PCStoreValue();
95
96 SP = SP - 4*BitCount(registers);
97 }
98#endif
99
100 bool success = false;
101 const uint32_t opcode = emulator->OpcodeAsUnsigned (&success);
102 if (!success)
103 return false;
104
105 if (emulator->ConditionPassed())
106 {
107 const uint32_t addr_byte_size = emulator->GetAddressByteSize();
108 const addr_t sp = emulator->ReadRegisterUnsigned (eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, 0, &success);
109 if (!success)
110 return false;
Johnny Chen3c75c762011-01-22 00:47:08 +0000111 uint32_t registers = 0;
Johnny Chen91d99862011-01-25 19:07:04 +0000112 uint32_t Rt; // the source register
Johnny Chen3c75c762011-01-22 00:47:08 +0000113 switch (encoding) {
Johnny Chenaedde1c2011-01-24 20:38:45 +0000114 case eEncodingT1:
Johnny Chen108d5aa2011-01-26 01:00:55 +0000115 registers = Bits32(opcode, 7, 0);
Johnny Chenaedde1c2011-01-24 20:38:45 +0000116 // The M bit represents LR.
Johnny Chen108d5aa2011-01-26 01:00:55 +0000117 if (Bits32(opcode, 8, 8))
Johnny Chenaedde1c2011-01-24 20:38:45 +0000118 registers |= 0x000eu;
119 // if BitCount(registers) < 1 then UNPREDICTABLE;
120 if (BitCount(registers) < 1)
121 return false;
122 break;
Johnny Chen7dc60e12011-01-24 19:46:32 +0000123 case eEncodingT2:
124 // Ignore bits 15 & 13.
Johnny Chen108d5aa2011-01-26 01:00:55 +0000125 registers = Bits32(opcode, 15, 0) & ~0xa000;
Johnny Chen7dc60e12011-01-24 19:46:32 +0000126 // if BitCount(registers) < 2 then UNPREDICTABLE;
127 if (BitCount(registers) < 2)
128 return false;
129 break;
130 case eEncodingT3:
Johnny Chen108d5aa2011-01-26 01:00:55 +0000131 Rt = Bits32(opcode, 15, 12);
Johnny Chen7dc60e12011-01-24 19:46:32 +0000132 // if BadReg(t) then UNPREDICTABLE;
Johnny Chen91d99862011-01-25 19:07:04 +0000133 if (BadReg(Rt))
Johnny Chen7dc60e12011-01-24 19:46:32 +0000134 return false;
Johnny Chen91d99862011-01-25 19:07:04 +0000135 registers = (1u << Rt);
Johnny Chen7dc60e12011-01-24 19:46:32 +0000136 break;
Johnny Chen3c75c762011-01-22 00:47:08 +0000137 case eEncodingA1:
Johnny Chen108d5aa2011-01-26 01:00:55 +0000138 registers = Bits32(opcode, 15, 0);
Johnny Chena33d4842011-01-24 22:25:48 +0000139 // Instead of return false, let's handle the following case as well,
140 // which amounts to pushing one reg onto the full descending stacks.
141 // if BitCount(register_list) < 2 then SEE STMDB / STMFD;
Johnny Chen3c75c762011-01-22 00:47:08 +0000142 break;
143 case eEncodingA2:
Johnny Chen108d5aa2011-01-26 01:00:55 +0000144 Rt = Bits32(opcode, 15, 12);
Johnny Chen7dc60e12011-01-24 19:46:32 +0000145 // if t == 13 then UNPREDICTABLE;
Johnny Chen91d99862011-01-25 19:07:04 +0000146 if (Rt == dwarf_sp)
Johnny Chen3c75c762011-01-22 00:47:08 +0000147 return false;
Johnny Chen91d99862011-01-25 19:07:04 +0000148 registers = (1u << Rt);
Johnny Chen3c75c762011-01-22 00:47:08 +0000149 break;
Johnny Chence1ca772011-01-25 01:13:00 +0000150 default:
151 return false;
Johnny Chen3c75c762011-01-22 00:47:08 +0000152 }
Johnny Chence1ca772011-01-25 01:13:00 +0000153 addr_t sp_offset = addr_byte_size * BitCount (registers);
Greg Clayton64c84432011-01-21 22:02:52 +0000154 addr_t addr = sp - sp_offset;
155 uint32_t i;
156
157 EmulateInstruction::Context context = { EmulateInstruction::eContextPushRegisterOnStack, eRegisterKindDWARF, 0, 0 };
158 for (i=0; i<15; ++i)
159 {
Johnny Chen108d5aa2011-01-26 01:00:55 +0000160 if (BitIsSet (registers, 1u << i))
Greg Clayton64c84432011-01-21 22:02:52 +0000161 {
162 context.arg1 = dwarf_r0 + i; // arg1 in the context is the DWARF register number
163 context.arg2 = addr - sp; // arg2 in the context is the stack pointer offset
164 uint32_t reg_value = emulator->ReadRegisterUnsigned(eRegisterKindDWARF, context.arg1, 0, &success);
165 if (!success)
166 return false;
167 if (!emulator->WriteMemoryUnsigned (context, addr, reg_value, addr_byte_size))
168 return false;
169 addr += addr_byte_size;
170 }
171 }
172
Johnny Chen108d5aa2011-01-26 01:00:55 +0000173 if (BitIsSet (registers, 1u << 15))
Greg Clayton64c84432011-01-21 22:02:52 +0000174 {
175 context.arg1 = dwarf_pc; // arg1 in the context is the DWARF register number
Johnny Chen3c75c762011-01-22 00:47:08 +0000176 context.arg2 = addr - sp; // arg2 in the context is the stack pointer offset
Greg Clayton64c84432011-01-21 22:02:52 +0000177 const uint32_t pc = emulator->ReadRegisterUnsigned(eRegisterKindGeneric, LLDB_REGNUM_GENERIC_PC, 0, &success);
178 if (!success)
179 return false;
180 if (!emulator->WriteMemoryUnsigned (context, addr, pc + 8, addr_byte_size))
181 return false;
182 }
183
184 context.type = EmulateInstruction::eContextAdjustStackPointer;
185 context.arg0 = eRegisterKindGeneric;
186 context.arg1 = LLDB_REGNUM_GENERIC_SP;
Johnny Chen5b442b72011-01-27 19:34:30 +0000187 context.arg2 = -sp_offset;
Greg Clayton64c84432011-01-21 22:02:52 +0000188
189 if (!emulator->WriteRegisterUnsigned (context, eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, sp - sp_offset))
190 return false;
191 }
192 return true;
193}
194
Johnny Chen5b442b72011-01-27 19:34:30 +0000195// Set r7 or ip to point to saved value residing within the stack.
Johnny Chenbcec3af2011-01-27 01:26:19 +0000196// ADD (SP plus immediate)
197static bool
198emulate_add_rd_sp_imm (EmulateInstructionARM *emulator, ARMEncoding encoding)
199{
200#if 0
201 // ARM pseudo code...
202 if (ConditionPassed())
203 {
204 EncodingSpecificOperations();
205 (result, carry, overflow) = AddWithCarry(SP, imm32, 0’);
206 if d == 15 then
207 ALUWritePC(result); // setflags is always FALSE here
208 else
209 R[d] = result;
210 if setflags then
211 APSR.N = result<31>;
212 APSR.Z = IsZeroBit(result);
213 APSR.C = carry;
214 APSR.V = overflow;
215 }
216#endif
217
218 bool success = false;
219 const uint32_t opcode = emulator->OpcodeAsUnsigned (&success);
220 if (!success)
221 return false;
222
223 if (emulator->ConditionPassed())
224 {
225 const addr_t sp = emulator->ReadRegisterUnsigned (eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, 0, &success);
226 if (!success)
227 return false;
228 uint32_t Rd; // the destination register
229 uint32_t imm32;
230 switch (encoding) {
231 case eEncodingT1:
232 Rd = 7;
233 imm32 = Bits32(opcode, 7, 0) << 2; // imm32 = ZeroExtend(imm8:'00', 32)
234 break;
235 case eEncodingA1:
236 Rd = Bits32(opcode, 15, 12);
237 imm32 = ARMExpandImm(opcode); // imm32 = ARMExpandImm(imm12)
238 break;
239 default:
240 return false;
241 }
242 addr_t sp_offset = imm32;
243 addr_t addr = sp + sp_offset; // a pointer to the stack area
244
245 EmulateInstruction::Context context = { EmulateInstruction::eContextRegisterPlusOffset,
246 eRegisterKindGeneric,
247 LLDB_REGNUM_GENERIC_SP,
248 sp_offset };
249
250 if (!emulator->WriteRegisterUnsigned (context, eRegisterKindDWARF, dwarf_r0 + Rd, addr))
251 return false;
252 }
253 return true;
254}
255
Johnny Chen5b442b72011-01-27 19:34:30 +0000256// An add operation to adjust the SP.
257// ADD (SP plus register)
258static bool
259emulate_add_sp_rm (EmulateInstructionARM *emulator, ARMEncoding encoding)
260{
261#if 0
262 // ARM pseudo code...
263 if (ConditionPassed())
264 {
265 EncodingSpecificOperations();
266 shifted = Shift(R[m], shift_t, shift_n, APSR.C);
267 (result, carry, overflow) = AddWithCarry(SP, shifted, 0’);
268 if d == 15 then
269 ALUWritePC(result); // setflags is always FALSE here
270 else
271 R[d] = result;
272 if setflags then
273 APSR.N = result<31>;
274 APSR.Z = IsZeroBit(result);
275 APSR.C = carry;
276 APSR.V = overflow;
277 }
278#endif
279
280 bool success = false;
281 const uint32_t opcode = emulator->OpcodeAsUnsigned (&success);
282 if (!success)
283 return false;
284
285 if (emulator->ConditionPassed())
286 {
287 const addr_t sp = emulator->ReadRegisterUnsigned (eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, 0, &success);
288 if (!success)
289 return false;
290 uint32_t Rm; // the second operand
291 switch (encoding) {
292 case eEncodingT2:
293 Rm = Bits32(opcode, 6, 3);
294 break;
295 default:
296 return false;
297 }
298 int32_t reg_value = emulator->ReadRegisterUnsigned(eRegisterKindDWARF, dwarf_r0 + Rm, 0, &success);
299 if (!success)
300 return false;
301
302 addr_t addr = (int32_t)sp + reg_value; // the adjusted stack pointer value
303
304 EmulateInstruction::Context context = { EmulateInstruction::eContextAdjustStackPointer,
305 eRegisterKindGeneric,
306 LLDB_REGNUM_GENERIC_SP,
307 reg_value };
308
309 if (!emulator->WriteRegisterUnsigned (context, eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, addr))
310 return false;
311 }
312 return true;
313}
314
Johnny Chen4c0e0bc2011-01-25 22:45:28 +0000315// A sub operation to adjust the SP -- allocate space for local storage.
316static bool
317emulate_sub_sp_imm (EmulateInstructionARM *emulator, ARMEncoding encoding)
318{
319#if 0
320 // ARM pseudo code...
321 if (ConditionPassed())
322 {
323 EncodingSpecificOperations();
324 (result, carry, overflow) = AddWithCarry(SP, NOT(imm32), 1’);
325 if d == 15 then // Can only occur for ARM encoding
Johnny Chen799dfd02011-01-26 23:14:33 +0000326 ALUWritePC(result); // setflags is always FALSE here
Johnny Chen4c0e0bc2011-01-25 22:45:28 +0000327 else
328 R[d] = result;
329 if setflags then
330 APSR.N = result<31>;
331 APSR.Z = IsZeroBit(result);
332 APSR.C = carry;
333 APSR.V = overflow;
334 }
335#endif
336
337 bool success = false;
338 const uint32_t opcode = emulator->OpcodeAsUnsigned (&success);
339 if (!success)
340 return false;
341
342 if (emulator->ConditionPassed())
343 {
344 const addr_t sp = emulator->ReadRegisterUnsigned (eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, 0, &success);
345 if (!success)
346 return false;
347 uint32_t imm32;
348 switch (encoding) {
Johnny Chene4455022011-01-26 00:08:59 +0000349 case eEncodingT1:
350 imm32 = ThumbImmScaled(opcode); // imm32 = ZeroExtend(imm7:'00', 32)
Johnny Chen60c0d622011-01-25 23:49:39 +0000351 case eEncodingT2:
352 imm32 = ThumbExpandImm(opcode); // imm32 = ThumbExpandImm(i:imm3:imm8)
353 break;
354 case eEncodingT3:
355 imm32 = ThumbImm12(opcode); // imm32 = ZeroExtend(i:imm3:imm8, 32)
356 break;
Johnny Chen4c0e0bc2011-01-25 22:45:28 +0000357 case eEncodingA1:
Johnny Chen60c0d622011-01-25 23:49:39 +0000358 imm32 = ARMExpandImm(opcode); // imm32 = ARMExpandImm(imm12)
Johnny Chen4c0e0bc2011-01-25 22:45:28 +0000359 break;
360 default:
361 return false;
362 }
363 addr_t sp_offset = imm32;
364 addr_t addr = sp - sp_offset; // the adjusted stack pointer value
365
366 EmulateInstruction::Context context = { EmulateInstruction::eContextAdjustStackPointer,
367 eRegisterKindGeneric,
368 LLDB_REGNUM_GENERIC_SP,
Johnny Chen5b442b72011-01-27 19:34:30 +0000369 -sp_offset };
Johnny Chen4c0e0bc2011-01-25 22:45:28 +0000370
371 if (!emulator->WriteRegisterUnsigned (context, eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, addr))
372 return false;
373 }
374 return true;
375}
376
377// A store operation to the stacks that also updates the SP.
Johnny Chence1ca772011-01-25 01:13:00 +0000378static bool
379emulate_str_rt_sp (EmulateInstructionARM *emulator, ARMEncoding encoding)
380{
381#if 0
382 // ARM pseudo code...
383 if (ConditionPassed())
384 {
385 EncodingSpecificOperations();
386 offset_addr = if add then (R[n] + imm32) else (R[n] - imm32);
387 address = if index then offset_addr else R[n];
388 MemU[address,4] = if t == 15 then PCStoreValue() else R[t];
389 if wback then R[n] = offset_addr;
390 }
391#endif
392
393 bool success = false;
394 const uint32_t opcode = emulator->OpcodeAsUnsigned (&success);
395 if (!success)
396 return false;
397
398 if (emulator->ConditionPassed())
399 {
400 const uint32_t addr_byte_size = emulator->GetAddressByteSize();
401 const addr_t sp = emulator->ReadRegisterUnsigned (eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, 0, &success);
402 if (!success)
403 return false;
Johnny Chen91d99862011-01-25 19:07:04 +0000404 uint32_t Rt; // the source register
Johnny Chence1ca772011-01-25 01:13:00 +0000405 uint32_t imm12;
406 switch (encoding) {
407 case eEncodingA1:
Johnny Chen108d5aa2011-01-26 01:00:55 +0000408 Rt = Bits32(opcode, 15, 12);
409 imm12 = Bits32(opcode, 11, 0);
Johnny Chence1ca772011-01-25 01:13:00 +0000410 break;
411 default:
412 return false;
413 }
414 addr_t sp_offset = imm12;
415 addr_t addr = sp - sp_offset;
416
417 EmulateInstruction::Context context = { EmulateInstruction::eContextPushRegisterOnStack, eRegisterKindDWARF, 0, 0 };
Johnny Chen91d99862011-01-25 19:07:04 +0000418 if (Rt != 15)
Johnny Chence1ca772011-01-25 01:13:00 +0000419 {
Johnny Chen91d99862011-01-25 19:07:04 +0000420 context.arg1 = dwarf_r0 + Rt; // arg1 in the context is the DWARF register number
421 context.arg2 = addr - sp; // arg2 in the context is the stack pointer offset
Johnny Chence1ca772011-01-25 01:13:00 +0000422 uint32_t reg_value = emulator->ReadRegisterUnsigned(eRegisterKindDWARF, context.arg1, 0, &success);
423 if (!success)
424 return false;
425 if (!emulator->WriteMemoryUnsigned (context, addr, reg_value, addr_byte_size))
426 return false;
427 }
428 else
429 {
430 context.arg1 = dwarf_pc; // arg1 in the context is the DWARF register number
431 context.arg2 = addr - sp; // arg2 in the context is the stack pointer offset
432 const uint32_t pc = emulator->ReadRegisterUnsigned(eRegisterKindGeneric, LLDB_REGNUM_GENERIC_PC, 0, &success);
433 if (!success)
434 return false;
435 if (!emulator->WriteMemoryUnsigned (context, addr, pc + 8, addr_byte_size))
436 return false;
437 }
438
439 context.type = EmulateInstruction::eContextAdjustStackPointer;
440 context.arg0 = eRegisterKindGeneric;
441 context.arg1 = LLDB_REGNUM_GENERIC_SP;
Johnny Chen5b442b72011-01-27 19:34:30 +0000442 context.arg2 = -sp_offset;
Johnny Chence1ca772011-01-25 01:13:00 +0000443
444 if (!emulator->WriteRegisterUnsigned (context, eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, sp - sp_offset))
445 return false;
446 }
447 return true;
448}
449
Johnny Chen799dfd02011-01-26 23:14:33 +0000450static bool
451emulate_vpush (EmulateInstructionARM *emulator, ARMEncoding encoding)
452{
453#if 0
454 // ARM pseudo code...
455 if (ConditionPassed())
456 {
457 EncodingSpecificOperations(); CheckVFPEnabled(TRUE); NullCheckIfThumbEE(13);
458 address = SP - imm32;
459 SP = SP - imm32;
460 if single_regs then
461 for r = 0 to regs-1
462 MemA[address,4] = S[d+r]; address = address+4;
463 else
464 for r = 0 to regs-1
465 // Store as two word-aligned words in the correct order for current endianness.
466 MemA[address,4] = if BigEndian() then D[d+r]<63:32> else D[d+r]<31:0>;
467 MemA[address+4,4] = if BigEndian() then D[d+r]<31:0> else D[d+r]<63:32>;
468 address = address+8;
469 }
470#endif
471
472 bool success = false;
473 const uint32_t opcode = emulator->OpcodeAsUnsigned (&success);
474 if (!success)
475 return false;
476
477 if (emulator->ConditionPassed())
478 {
479 const uint32_t addr_byte_size = emulator->GetAddressByteSize();
480 const addr_t sp = emulator->ReadRegisterUnsigned (eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, 0, &success);
481 if (!success)
482 return false;
483 bool single_regs;
484 uint32_t d; // UInt(Vd:D) starting register
485 uint32_t imm32; // stack offset
486 uint32_t regs; // number of registers
487 switch (encoding) {
488 case eEncodingT1:
489 case eEncodingA1:
490 single_regs = false;
491 d = Bits32(opcode, 15, 12) << 1 | Bits32(opcode, 22, 22);
492 imm32 = Bits32(opcode, 7, 0) * addr_byte_size;
493 // If UInt(imm8) is odd, see "FSTMX".
494 regs = Bits32(opcode, 7, 0) / 2;
495 // if regs == 0 || regs > 16 || (d+regs) > 32 then UNPREDICTABLE;
496 if (regs == 0 || regs > 16 || (d + regs) > 32)
497 return false;
498 break;
499 case eEncodingT2:
500 case eEncodingA2:
501 single_regs = true;
502 d = Bits32(opcode, 15, 12) << 1 | Bits32(opcode, 22, 22);
503 imm32 = Bits32(opcode, 7, 0) * addr_byte_size;
504 regs = Bits32(opcode, 7, 0);
505 // if regs == 0 || regs > 16 || (d+regs) > 32 then UNPREDICTABLE;
506 if (regs == 0 || regs > 16 || (d + regs) > 32)
507 return false;
508 break;
509 default:
510 return false;
511 }
512 uint32_t start_reg = single_regs ? dwarf_s0 : dwarf_d0;
513 uint32_t reg_byte_size = single_regs ? addr_byte_size : addr_byte_size * 2;
514 addr_t sp_offset = imm32;
515 addr_t addr = sp - sp_offset;
516 uint32_t i;
517
518 EmulateInstruction::Context context = { EmulateInstruction::eContextPushRegisterOnStack, eRegisterKindDWARF, 0, 0 };
519 for (i=d; i<regs; ++i)
520 {
521 context.arg1 = start_reg + i; // arg1 in the context is the DWARF register number
522 context.arg2 = addr - sp; // arg2 in the context is the stack pointer offset
523 // uint64_t to accommodate 64-bit registers.
524 uint64_t reg_value = emulator->ReadRegisterUnsigned(eRegisterKindDWARF, context.arg1, 0, &success);
525 if (!success)
526 return false;
527 if (!emulator->WriteMemoryUnsigned (context, addr, reg_value, reg_byte_size))
528 return false;
529 addr += reg_byte_size;
530 }
531
532 context.type = EmulateInstruction::eContextAdjustStackPointer;
533 context.arg0 = eRegisterKindGeneric;
534 context.arg1 = LLDB_REGNUM_GENERIC_SP;
Johnny Chen5b442b72011-01-27 19:34:30 +0000535 context.arg2 = -sp_offset;
Johnny Chen799dfd02011-01-26 23:14:33 +0000536
537 if (!emulator->WriteRegisterUnsigned (context, eRegisterKindGeneric, LLDB_REGNUM_GENERIC_SP, sp - sp_offset))
538 return false;
539 }
540 return true;
541}
542
Greg Clayton64c84432011-01-21 22:02:52 +0000543static ARMOpcode g_arm_opcodes[] =
544{
Johnny Chene4455022011-01-26 00:08:59 +0000545 // push register(s)
Johnny Chenbcec3af2011-01-27 01:26:19 +0000546 { 0x0fff0000, 0x092d0000, ARMvAll, eEncodingA1, eSize32, emulate_push, "push <registers>" },
547 { 0x0fff0fff, 0x052d0004, ARMvAll, eEncodingA2, eSize32, emulate_push, "push <register>" },
548
Johnny Chen5b442b72011-01-27 19:34:30 +0000549 // set r7 to point to a stack offset
Johnny Chenbcec3af2011-01-27 01:26:19 +0000550 { 0x0ffff000, 0x028d7000, ARMvAll, eEncodingA1, eSize32, emulate_add_rd_sp_imm, "add r7, sp, #<const>" },
Johnny Chen5b442b72011-01-27 19:34:30 +0000551 // set ip to point to a stack offset
Johnny Chenbcec3af2011-01-27 01:26:19 +0000552 { 0x0ffff000, 0x028dc000, ARMvAll, eEncodingA1, eSize32, emulate_add_rd_sp_imm, "add ip, sp, #<const>" },
Johnny Chen4c0e0bc2011-01-25 22:45:28 +0000553
554 // adjust the stack pointer
Johnny Chenbcec3af2011-01-27 01:26:19 +0000555 { 0x0ffff000, 0x024dd000, ARMvAll, eEncodingA1, eSize32, emulate_sub_sp_imm, "sub sp, sp, #<const>"},
Johnny Chence1ca772011-01-25 01:13:00 +0000556
557 // if Rn == '1101' && imm12 == '000000000100' then SEE PUSH;
Johnny Chenbcec3af2011-01-27 01:26:19 +0000558 { 0x0fff0000, 0x052d0000, ARMvAll, eEncodingA1, eSize32, emulate_str_rt_sp, "str Rt, [sp, #-<imm12>]!" },
Johnny Chen799dfd02011-01-26 23:14:33 +0000559
560 // vector push consecutive extension register(s)
Johnny Chenbcec3af2011-01-27 01:26:19 +0000561 { 0x0fbf0f00, 0x0d2d0b00, ARMv6T2|ARMv7, eEncodingA1, eSize32, emulate_vpush, "vpush.64 <list>"},
562 { 0x0fbf0f00, 0x0d2d0a00, ARMv6T2|ARMv7, eEncodingA2, eSize32, emulate_vpush, "vpush.32 <list>"}
Greg Clayton64c84432011-01-21 22:02:52 +0000563};
564
Johnny Chen347320d2011-01-24 23:40:59 +0000565static ARMOpcode g_thumb_opcodes[] =
566{
Johnny Chene4455022011-01-26 00:08:59 +0000567 // push register(s)
Johnny Chenbcec3af2011-01-27 01:26:19 +0000568 { 0xfffffe00, 0x0000b400, ARMvAll, eEncodingT1, eSize16, emulate_push, "push <registers>" },
569 { 0xffff0000, 0xe92d0000, ARMv6T2|ARMv7, eEncodingT2, eSize32, emulate_push, "push.w <registers>" },
570 { 0xffff0fff, 0xf84d0d04, ARMv6T2|ARMv7, eEncodingT3, eSize32, emulate_push, "push.w <register>" },
571
Johnny Chen5b442b72011-01-27 19:34:30 +0000572 // set r7 to point to a stack offset
Johnny Chenbcec3af2011-01-27 01:26:19 +0000573 { 0xffffff00, 0x000af00, ARMvAll, eEncodingT1, eSize16, emulate_add_rd_sp_imm, "add r7, sp, #<imm>" },
Johnny Chen60c0d622011-01-25 23:49:39 +0000574
575 // adjust the stack pointer
Johnny Chen5b442b72011-01-27 19:34:30 +0000576 { 0xffffff87, 0x00004485, ARMvAll, eEncodingT2, eSize16, emulate_add_sp_rm, "add sp, <Rm>"},
577 { 0xffffff80, 0x0000b080, ARMvAll, eEncodingT1, eSize16, emulate_sub_sp_imm, "add sp, sp, #<imm>"},
578 { 0xfbef8f00, 0xf1ad0d00, ARMv6T2|ARMv7, eEncodingT2, eSize32, emulate_sub_sp_imm, "sub.w sp, sp, #<const>"},
Johnny Chenbcec3af2011-01-27 01:26:19 +0000579 { 0xfbff8f00, 0xf2ad0d00, ARMv6T2|ARMv7, eEncodingT3, eSize32, emulate_sub_sp_imm, "subw sp, sp, #<imm12>"},
Johnny Chen799dfd02011-01-26 23:14:33 +0000580
581 // vector push consecutive extension register(s)
Johnny Chenbcec3af2011-01-27 01:26:19 +0000582 { 0xffbf0f00, 0xed2d0b00, ARMv6T2|ARMv7, eEncodingT1, eSize32, emulate_vpush, "vpush.64 <list>"},
583 { 0xffbf0f00, 0xed2d0a00, ARMv6T2|ARMv7, eEncodingT2, eSize32, emulate_vpush, "vpush.32 <list>"}
Johnny Chen347320d2011-01-24 23:40:59 +0000584};
585
Greg Clayton64c84432011-01-21 22:02:52 +0000586static const size_t k_num_arm_opcodes = sizeof(g_arm_opcodes)/sizeof(ARMOpcode);
Johnny Chen347320d2011-01-24 23:40:59 +0000587static const size_t k_num_thumb_opcodes = sizeof(g_thumb_opcodes)/sizeof(ARMOpcode);
Greg Clayton64c84432011-01-21 22:02:52 +0000588
589bool
590EmulateInstructionARM::ReadInstruction ()
591{
592 bool success = false;
593 m_inst_cpsr = ReadRegisterUnsigned (eRegisterKindGeneric, LLDB_REGNUM_GENERIC_FLAGS, 0, &success);
594 if (success)
595 {
596 addr_t pc = ReadRegisterUnsigned (eRegisterKindGeneric, LLDB_REGNUM_GENERIC_PC, LLDB_INVALID_ADDRESS, &success);
597 if (success)
598 {
599 Context read_inst_context = {eContextReadOpcode, 0, 0};
600 if (m_inst_cpsr & MASK_CPSR_T)
601 {
602 m_inst_mode = eModeThumb;
603 uint32_t thumb_opcode = ReadMemoryUnsigned(read_inst_context, pc, 2, 0, &success);
604
605 if (success)
606 {
607 if ((m_inst.opcode.inst16 & 0xe000) != 0xe000 || ((m_inst.opcode.inst16 & 0x1800u) == 0))
608 {
609 m_inst.opcode_type = eOpcode16;
610 m_inst.opcode.inst16 = thumb_opcode;
611 }
612 else
613 {
614 m_inst.opcode_type = eOpcode32;
615 m_inst.opcode.inst32 = (thumb_opcode << 16) | ReadMemoryUnsigned(read_inst_context, pc + 2, 2, 0, &success);
616 }
617 }
618 }
619 else
620 {
621 m_inst_mode = eModeARM;
622 m_inst.opcode_type = eOpcode32;
623 m_inst.opcode.inst32 = ReadMemoryUnsigned(read_inst_context, pc, 4, 0, &success);
624 }
625 }
626 }
627 if (!success)
628 {
629 m_inst_mode = eModeInvalid;
630 m_inst_pc = LLDB_INVALID_ADDRESS;
631 }
632 return success;
633}
634
635uint32_t
636EmulateInstructionARM::CurrentCond ()
637{
638 switch (m_inst_mode)
639 {
640 default:
641 case eModeInvalid:
642 break;
643
644 case eModeARM:
645 return UnsignedBits(m_inst.opcode.inst32, 31, 28);
646
647 case eModeThumb:
648 return 0x0000000Eu; // Return always for now, we need to handl IT instructions later
649 }
650 return UINT32_MAX; // Return invalid value
651}
652bool
653EmulateInstructionARM::ConditionPassed ()
654{
655 if (m_inst_cpsr == 0)
656 return false;
657
658 const uint32_t cond = CurrentCond ();
659
660 if (cond == UINT32_MAX)
661 return false;
662
663 bool result = false;
664 switch (UnsignedBits(cond, 3, 1))
665 {
666 case 0: result = (m_inst_cpsr & MASK_CPSR_Z) != 0; break;
667 case 1: result = (m_inst_cpsr & MASK_CPSR_C) != 0; break;
668 case 2: result = (m_inst_cpsr & MASK_CPSR_N) != 0; break;
669 case 3: result = (m_inst_cpsr & MASK_CPSR_V) != 0; break;
670 case 4: result = ((m_inst_cpsr & MASK_CPSR_C) != 0) && ((m_inst_cpsr & MASK_CPSR_Z) == 0); break;
671 case 5:
672 {
673 bool n = (m_inst_cpsr & MASK_CPSR_N);
674 bool v = (m_inst_cpsr & MASK_CPSR_V);
675 result = n == v;
676 }
677 break;
678 case 6:
679 {
680 bool n = (m_inst_cpsr & MASK_CPSR_N);
681 bool v = (m_inst_cpsr & MASK_CPSR_V);
682 result = n == v && ((m_inst_cpsr & MASK_CPSR_Z) == 0);
683 }
684 break;
685 case 7:
686 result = true;
687 break;
688 }
689
690 if (cond & 1)
691 result = !result;
692 return result;
693}
694
695
696bool
697EmulateInstructionARM::EvaluateInstruction ()
698{
699 return false;
700}