Shorten long lines in linux-aarch64-low.c
[deliverable/binutils-gdb.git] / gdb / gdbserver / linux-aarch64-low.c
CommitLineData
176eb98c
MS
1/* GNU/Linux/AArch64 specific low level interface, for the remote server for
2 GDB.
3
32d0add0 4 Copyright (C) 2009-2015 Free Software Foundation, Inc.
176eb98c
MS
5 Contributed by ARM Ltd.
6
7 This file is part of GDB.
8
9 This program is free software; you can redistribute it and/or modify
10 it under the terms of the GNU General Public License as published by
11 the Free Software Foundation; either version 3 of the License, or
12 (at your option) any later version.
13
14 This program is distributed in the hope that it will be useful,
15 but WITHOUT ANY WARRANTY; without even the implied warranty of
16 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 GNU General Public License for more details.
18
19 You should have received a copy of the GNU General Public License
20 along with this program. If not, see <http://www.gnu.org/licenses/>. */
21
22#include "server.h"
23#include "linux-low.h"
db3cb7cb 24#include "nat/aarch64-linux.h"
554717a3 25#include "nat/aarch64-linux-hw-point.h"
bb903df0 26#include "arch/aarch64-insn.h"
3b53ae99 27#include "linux-aarch32-low.h"
176eb98c 28#include "elf/common.h"
afbe19f8
PL
29#include "ax.h"
30#include "tracepoint.h"
176eb98c
MS
31
32#include <signal.h>
33#include <sys/user.h>
5826e159 34#include "nat/gdb_ptrace.h"
e9dae05e 35#include <asm/ptrace.h>
bb903df0
PL
36#include <inttypes.h>
37#include <endian.h>
38#include <sys/uio.h>
176eb98c
MS
39
40#include "gdb_proc_service.h"
41
42/* Defined in auto-generated files. */
43void init_registers_aarch64 (void);
3aee8918 44extern const struct target_desc *tdesc_aarch64;
176eb98c 45
176eb98c
MS
46#ifdef HAVE_SYS_REG_H
47#include <sys/reg.h>
48#endif
49
50#define AARCH64_X_REGS_NUM 31
51#define AARCH64_V_REGS_NUM 32
52#define AARCH64_X0_REGNO 0
53#define AARCH64_SP_REGNO 31
54#define AARCH64_PC_REGNO 32
55#define AARCH64_CPSR_REGNO 33
56#define AARCH64_V0_REGNO 34
bf330350
CU
57#define AARCH64_FPSR_REGNO (AARCH64_V0_REGNO + AARCH64_V_REGS_NUM)
58#define AARCH64_FPCR_REGNO (AARCH64_V0_REGNO + AARCH64_V_REGS_NUM + 1)
176eb98c 59
bf330350 60#define AARCH64_NUM_REGS (AARCH64_V0_REGNO + AARCH64_V_REGS_NUM + 2)
176eb98c 61
176eb98c
MS
62/* Per-process arch-specific data we want to keep. */
63
64struct arch_process_info
65{
66 /* Hardware breakpoint/watchpoint data.
67 The reason for them to be per-process rather than per-thread is
68 due to the lack of information in the gdbserver environment;
69 gdbserver is not told that whether a requested hardware
70 breakpoint/watchpoint is thread specific or not, so it has to set
71 each hw bp/wp for every thread in the current process. The
72 higher level bp/wp management in gdb will resume a thread if a hw
73 bp/wp trap is not expected for it. Since the hw bp/wp setting is
74 same for each thread, it is reasonable for the data to live here.
75 */
76 struct aarch64_debug_reg_state debug_reg_state;
77};
78
3b53ae99
YQ
79/* Return true if the size of register 0 is 8 byte. */
80
81static int
82is_64bit_tdesc (void)
83{
84 struct regcache *regcache = get_thread_regcache (current_thread, 0);
85
86 return register_size (regcache->tdesc, 0) == 8;
87}
88
421530db
PL
89/* Implementation of linux_target_ops method "cannot_store_register". */
90
176eb98c
MS
91static int
92aarch64_cannot_store_register (int regno)
93{
94 return regno >= AARCH64_NUM_REGS;
95}
96
421530db
PL
97/* Implementation of linux_target_ops method "cannot_fetch_register". */
98
176eb98c
MS
99static int
100aarch64_cannot_fetch_register (int regno)
101{
102 return regno >= AARCH64_NUM_REGS;
103}
104
105static void
106aarch64_fill_gregset (struct regcache *regcache, void *buf)
107{
108 struct user_pt_regs *regset = buf;
109 int i;
110
111 for (i = 0; i < AARCH64_X_REGS_NUM; i++)
112 collect_register (regcache, AARCH64_X0_REGNO + i, &regset->regs[i]);
113 collect_register (regcache, AARCH64_SP_REGNO, &regset->sp);
114 collect_register (regcache, AARCH64_PC_REGNO, &regset->pc);
115 collect_register (regcache, AARCH64_CPSR_REGNO, &regset->pstate);
116}
117
118static void
119aarch64_store_gregset (struct regcache *regcache, const void *buf)
120{
121 const struct user_pt_regs *regset = buf;
122 int i;
123
124 for (i = 0; i < AARCH64_X_REGS_NUM; i++)
125 supply_register (regcache, AARCH64_X0_REGNO + i, &regset->regs[i]);
126 supply_register (regcache, AARCH64_SP_REGNO, &regset->sp);
127 supply_register (regcache, AARCH64_PC_REGNO, &regset->pc);
128 supply_register (regcache, AARCH64_CPSR_REGNO, &regset->pstate);
129}
130
131static void
132aarch64_fill_fpregset (struct regcache *regcache, void *buf)
133{
134 struct user_fpsimd_state *regset = buf;
135 int i;
136
137 for (i = 0; i < AARCH64_V_REGS_NUM; i++)
138 collect_register (regcache, AARCH64_V0_REGNO + i, &regset->vregs[i]);
bf330350
CU
139 collect_register (regcache, AARCH64_FPSR_REGNO, &regset->fpsr);
140 collect_register (regcache, AARCH64_FPCR_REGNO, &regset->fpcr);
176eb98c
MS
141}
142
143static void
144aarch64_store_fpregset (struct regcache *regcache, const void *buf)
145{
146 const struct user_fpsimd_state *regset = buf;
147 int i;
148
149 for (i = 0; i < AARCH64_V_REGS_NUM; i++)
150 supply_register (regcache, AARCH64_V0_REGNO + i, &regset->vregs[i]);
bf330350
CU
151 supply_register (regcache, AARCH64_FPSR_REGNO, &regset->fpsr);
152 supply_register (regcache, AARCH64_FPCR_REGNO, &regset->fpcr);
176eb98c
MS
153}
154
176eb98c
MS
155/* Enable miscellaneous debugging output. The name is historical - it
156 was originally used to debug LinuxThreads support. */
157extern int debug_threads;
158
421530db
PL
159/* Implementation of linux_target_ops method "get_pc". */
160
176eb98c
MS
161static CORE_ADDR
162aarch64_get_pc (struct regcache *regcache)
163{
8a7e4587
YQ
164 if (register_size (regcache->tdesc, 0) == 8)
165 {
166 unsigned long pc;
167
168 collect_register_by_name (regcache, "pc", &pc);
169 if (debug_threads)
170 debug_printf ("stop pc is %08lx\n", pc);
171 return pc;
172 }
173 else
174 {
175 unsigned int pc;
176
177 collect_register_by_name (regcache, "pc", &pc);
178 if (debug_threads)
179 debug_printf ("stop pc is %04x\n", pc);
180 return pc;
181 }
176eb98c
MS
182}
183
421530db
PL
184/* Implementation of linux_target_ops method "set_pc". */
185
176eb98c
MS
186static void
187aarch64_set_pc (struct regcache *regcache, CORE_ADDR pc)
188{
8a7e4587
YQ
189 if (register_size (regcache->tdesc, 0) == 8)
190 {
191 unsigned long newpc = pc;
192 supply_register_by_name (regcache, "pc", &newpc);
193 }
194 else
195 {
196 unsigned int newpc = pc;
197 supply_register_by_name (regcache, "pc", &newpc);
198 }
176eb98c
MS
199}
200
176eb98c
MS
201#define aarch64_breakpoint_len 4
202
37d66942
PL
203/* AArch64 BRK software debug mode instruction.
204 This instruction needs to match gdb/aarch64-tdep.c
205 (aarch64_default_breakpoint). */
206static const gdb_byte aarch64_breakpoint[] = {0x00, 0x00, 0x20, 0xd4};
176eb98c 207
421530db
PL
208/* Implementation of linux_target_ops method "breakpoint_at". */
209
176eb98c
MS
210static int
211aarch64_breakpoint_at (CORE_ADDR where)
212{
37d66942 213 gdb_byte insn[aarch64_breakpoint_len];
176eb98c 214
37d66942
PL
215 (*the_target->read_memory) (where, (unsigned char *) &insn,
216 aarch64_breakpoint_len);
217 if (memcmp (insn, aarch64_breakpoint, aarch64_breakpoint_len) == 0)
176eb98c
MS
218 return 1;
219
220 return 0;
221}
222
176eb98c
MS
223static void
224aarch64_init_debug_reg_state (struct aarch64_debug_reg_state *state)
225{
226 int i;
227
228 for (i = 0; i < AARCH64_HBP_MAX_NUM; ++i)
229 {
230 state->dr_addr_bp[i] = 0;
231 state->dr_ctrl_bp[i] = 0;
232 state->dr_ref_count_bp[i] = 0;
233 }
234
235 for (i = 0; i < AARCH64_HWP_MAX_NUM; ++i)
236 {
237 state->dr_addr_wp[i] = 0;
238 state->dr_ctrl_wp[i] = 0;
239 state->dr_ref_count_wp[i] = 0;
240 }
241}
242
176eb98c
MS
243/* Return the pointer to the debug register state structure in the
244 current process' arch-specific data area. */
245
db3cb7cb 246struct aarch64_debug_reg_state *
88e2cf7e 247aarch64_get_debug_reg_state (pid_t pid)
176eb98c 248{
88e2cf7e 249 struct process_info *proc = find_process_pid (pid);
176eb98c 250
fe978cb0 251 return &proc->priv->arch_private->debug_reg_state;
176eb98c
MS
252}
253
421530db
PL
254/* Implementation of linux_target_ops method "supports_z_point_type". */
255
4ff0d3d8
PA
256static int
257aarch64_supports_z_point_type (char z_type)
258{
259 switch (z_type)
260 {
96c97461 261 case Z_PACKET_SW_BP:
6085d6f6
YQ
262 {
263 if (!extended_protocol && is_64bit_tdesc ())
264 {
265 /* Only enable Z0 packet in non-multi-arch debugging. If
266 extended protocol is used, don't enable Z0 packet because
267 GDBserver may attach to 32-bit process. */
268 return 1;
269 }
270 else
271 {
272 /* Disable Z0 packet so that GDBserver doesn't have to handle
273 different breakpoint instructions (aarch64, arm, thumb etc)
274 in multi-arch debugging. */
275 return 0;
276 }
277 }
4ff0d3d8
PA
278 case Z_PACKET_HW_BP:
279 case Z_PACKET_WRITE_WP:
280 case Z_PACKET_READ_WP:
281 case Z_PACKET_ACCESS_WP:
282 return 1;
283 default:
4ff0d3d8
PA
284 return 0;
285 }
286}
287
421530db 288/* Implementation of linux_target_ops method "insert_point".
176eb98c 289
421530db
PL
290 It actually only records the info of the to-be-inserted bp/wp;
291 the actual insertion will happen when threads are resumed. */
176eb98c
MS
292
293static int
802e8e6d
PA
294aarch64_insert_point (enum raw_bkpt_type type, CORE_ADDR addr,
295 int len, struct raw_breakpoint *bp)
176eb98c
MS
296{
297 int ret;
4ff0d3d8 298 enum target_hw_bp_type targ_type;
88e2cf7e
YQ
299 struct aarch64_debug_reg_state *state
300 = aarch64_get_debug_reg_state (pid_of (current_thread));
4ff0d3d8 301
c5e92cca 302 if (show_debug_regs)
176eb98c
MS
303 fprintf (stderr, "insert_point on entry (addr=0x%08lx, len=%d)\n",
304 (unsigned long) addr, len);
305
802e8e6d
PA
306 /* Determine the type from the raw breakpoint type. */
307 targ_type = raw_bkpt_type_to_target_hw_bp_type (type);
176eb98c
MS
308
309 if (targ_type != hw_execute)
39edd165
YQ
310 {
311 if (aarch64_linux_region_ok_for_watchpoint (addr, len))
312 ret = aarch64_handle_watchpoint (targ_type, addr, len,
313 1 /* is_insert */, state);
314 else
315 ret = -1;
316 }
176eb98c
MS
317 else
318 ret =
c67ca4de
YQ
319 aarch64_handle_breakpoint (targ_type, addr, len, 1 /* is_insert */,
320 state);
176eb98c 321
60a191ed 322 if (show_debug_regs)
88e2cf7e
YQ
323 aarch64_show_debug_reg_state (state, "insert_point", addr, len,
324 targ_type);
176eb98c
MS
325
326 return ret;
327}
328
421530db 329/* Implementation of linux_target_ops method "remove_point".
176eb98c 330
421530db
PL
331 It actually only records the info of the to-be-removed bp/wp,
332 the actual removal will be done when threads are resumed. */
176eb98c
MS
333
334static int
802e8e6d
PA
335aarch64_remove_point (enum raw_bkpt_type type, CORE_ADDR addr,
336 int len, struct raw_breakpoint *bp)
176eb98c
MS
337{
338 int ret;
4ff0d3d8 339 enum target_hw_bp_type targ_type;
88e2cf7e
YQ
340 struct aarch64_debug_reg_state *state
341 = aarch64_get_debug_reg_state (pid_of (current_thread));
4ff0d3d8 342
c5e92cca 343 if (show_debug_regs)
176eb98c
MS
344 fprintf (stderr, "remove_point on entry (addr=0x%08lx, len=%d)\n",
345 (unsigned long) addr, len);
346
802e8e6d
PA
347 /* Determine the type from the raw breakpoint type. */
348 targ_type = raw_bkpt_type_to_target_hw_bp_type (type);
176eb98c
MS
349
350 /* Set up state pointers. */
351 if (targ_type != hw_execute)
352 ret =
c67ca4de
YQ
353 aarch64_handle_watchpoint (targ_type, addr, len, 0 /* is_insert */,
354 state);
176eb98c
MS
355 else
356 ret =
c67ca4de
YQ
357 aarch64_handle_breakpoint (targ_type, addr, len, 0 /* is_insert */,
358 state);
176eb98c 359
60a191ed 360 if (show_debug_regs)
88e2cf7e
YQ
361 aarch64_show_debug_reg_state (state, "remove_point", addr, len,
362 targ_type);
176eb98c
MS
363
364 return ret;
365}
366
421530db 367/* Implementation of linux_target_ops method "stopped_data_address". */
176eb98c
MS
368
369static CORE_ADDR
370aarch64_stopped_data_address (void)
371{
372 siginfo_t siginfo;
373 int pid, i;
374 struct aarch64_debug_reg_state *state;
375
0bfdf32f 376 pid = lwpid_of (current_thread);
176eb98c
MS
377
378 /* Get the siginfo. */
379 if (ptrace (PTRACE_GETSIGINFO, pid, NULL, &siginfo) != 0)
380 return (CORE_ADDR) 0;
381
382 /* Need to be a hardware breakpoint/watchpoint trap. */
383 if (siginfo.si_signo != SIGTRAP
384 || (siginfo.si_code & 0xffff) != 0x0004 /* TRAP_HWBKPT */)
385 return (CORE_ADDR) 0;
386
387 /* Check if the address matches any watched address. */
88e2cf7e 388 state = aarch64_get_debug_reg_state (pid_of (current_thread));
176eb98c
MS
389 for (i = aarch64_num_wp_regs - 1; i >= 0; --i)
390 {
391 const unsigned int len = aarch64_watchpoint_length (state->dr_ctrl_wp[i]);
392 const CORE_ADDR addr_trap = (CORE_ADDR) siginfo.si_addr;
393 const CORE_ADDR addr_watch = state->dr_addr_wp[i];
394 if (state->dr_ref_count_wp[i]
395 && DR_CONTROL_ENABLED (state->dr_ctrl_wp[i])
396 && addr_trap >= addr_watch
397 && addr_trap < addr_watch + len)
398 return addr_trap;
399 }
400
401 return (CORE_ADDR) 0;
402}
403
421530db 404/* Implementation of linux_target_ops method "stopped_by_watchpoint". */
176eb98c
MS
405
406static int
407aarch64_stopped_by_watchpoint (void)
408{
409 if (aarch64_stopped_data_address () != 0)
410 return 1;
411 else
412 return 0;
413}
414
415/* Fetch the thread-local storage pointer for libthread_db. */
416
417ps_err_e
55fac6e0 418ps_get_thread_area (const struct ps_prochandle *ph,
176eb98c
MS
419 lwpid_t lwpid, int idx, void **base)
420{
a0cc84cd
YQ
421 return aarch64_ps_get_thread_area (ph, lwpid, idx, base,
422 is_64bit_tdesc ());
176eb98c
MS
423}
424
ade90bde
YQ
425/* Implementation of linux_target_ops method "siginfo_fixup". */
426
427static int
428aarch64_linux_siginfo_fixup (siginfo_t *native, void *inf, int direction)
429{
430 /* Is the inferior 32-bit? If so, then fixup the siginfo object. */
431 if (!is_64bit_tdesc ())
432 {
433 if (direction == 0)
434 aarch64_compat_siginfo_from_siginfo ((struct compat_siginfo *) inf,
435 native);
436 else
437 aarch64_siginfo_from_compat_siginfo (native,
438 (struct compat_siginfo *) inf);
439
440 return 1;
441 }
442
443 return 0;
444}
445
421530db 446/* Implementation of linux_target_ops method "linux_new_process". */
176eb98c
MS
447
448static struct arch_process_info *
449aarch64_linux_new_process (void)
450{
8d749320 451 struct arch_process_info *info = XCNEW (struct arch_process_info);
176eb98c
MS
452
453 aarch64_init_debug_reg_state (&info->debug_reg_state);
454
455 return info;
456}
457
421530db
PL
458/* Implementation of linux_target_ops method "linux_new_fork". */
459
3a8a0396
DB
460static void
461aarch64_linux_new_fork (struct process_info *parent,
462 struct process_info *child)
463{
464 /* These are allocated by linux_add_process. */
61a7418c
DB
465 gdb_assert (parent->priv != NULL
466 && parent->priv->arch_private != NULL);
467 gdb_assert (child->priv != NULL
468 && child->priv->arch_private != NULL);
3a8a0396
DB
469
470 /* Linux kernel before 2.6.33 commit
471 72f674d203cd230426437cdcf7dd6f681dad8b0d
472 will inherit hardware debug registers from parent
473 on fork/vfork/clone. Newer Linux kernels create such tasks with
474 zeroed debug registers.
475
476 GDB core assumes the child inherits the watchpoints/hw
477 breakpoints of the parent, and will remove them all from the
478 forked off process. Copy the debug registers mirrors into the
479 new process so that all breakpoints and watchpoints can be
480 removed together. The debug registers mirror will become zeroed
481 in the end before detaching the forked off process, thus making
482 this compatible with older Linux kernels too. */
483
61a7418c 484 *child->priv->arch_private = *parent->priv->arch_private;
3a8a0396
DB
485}
486
3b53ae99
YQ
487/* Return the right target description according to the ELF file of
488 current thread. */
489
490static const struct target_desc *
491aarch64_linux_read_description (void)
492{
493 unsigned int machine;
494 int is_elf64;
495 int tid;
496
497 tid = lwpid_of (current_thread);
498
499 is_elf64 = linux_pid_exe_is_elf_64_file (tid, &machine);
500
501 if (is_elf64)
502 return tdesc_aarch64;
503 else
504 return tdesc_arm_with_neon;
505}
506
421530db
PL
507/* Implementation of linux_target_ops method "arch_setup". */
508
176eb98c
MS
509static void
510aarch64_arch_setup (void)
511{
3b53ae99 512 current_process ()->tdesc = aarch64_linux_read_description ();
176eb98c 513
af1b22f3 514 aarch64_linux_get_debug_reg_capacity (lwpid_of (current_thread));
176eb98c
MS
515}
516
3aee8918 517static struct regset_info aarch64_regsets[] =
176eb98c
MS
518{
519 { PTRACE_GETREGSET, PTRACE_SETREGSET, NT_PRSTATUS,
520 sizeof (struct user_pt_regs), GENERAL_REGS,
521 aarch64_fill_gregset, aarch64_store_gregset },
522 { PTRACE_GETREGSET, PTRACE_SETREGSET, NT_FPREGSET,
523 sizeof (struct user_fpsimd_state), FP_REGS,
524 aarch64_fill_fpregset, aarch64_store_fpregset
525 },
526 { 0, 0, 0, -1, -1, NULL, NULL }
527};
528
3aee8918
PA
529static struct regsets_info aarch64_regsets_info =
530 {
531 aarch64_regsets, /* regsets */
532 0, /* num_regsets */
533 NULL, /* disabled_regsets */
534 };
535
3b53ae99 536static struct regs_info regs_info_aarch64 =
3aee8918
PA
537 {
538 NULL, /* regset_bitmap */
c2d65f38 539 NULL, /* usrregs */
3aee8918
PA
540 &aarch64_regsets_info,
541 };
542
421530db
PL
543/* Implementation of linux_target_ops method "regs_info". */
544
3aee8918
PA
545static const struct regs_info *
546aarch64_regs_info (void)
547{
3b53ae99
YQ
548 if (is_64bit_tdesc ())
549 return &regs_info_aarch64;
550 else
551 return &regs_info_aarch32;
3aee8918
PA
552}
553
7671bf47
PL
554/* Implementation of linux_target_ops method "supports_tracepoints". */
555
556static int
557aarch64_supports_tracepoints (void)
558{
524b57e6
YQ
559 if (current_thread == NULL)
560 return 1;
561 else
562 {
563 /* We don't support tracepoints on aarch32 now. */
564 return is_64bit_tdesc ();
565 }
7671bf47
PL
566}
567
bb903df0
PL
568/* Implementation of linux_target_ops method "get_thread_area". */
569
570static int
571aarch64_get_thread_area (int lwpid, CORE_ADDR *addrp)
572{
573 struct iovec iovec;
574 uint64_t reg;
575
576 iovec.iov_base = &reg;
577 iovec.iov_len = sizeof (reg);
578
579 if (ptrace (PTRACE_GETREGSET, lwpid, NT_ARM_TLS, &iovec) != 0)
580 return -1;
581
582 *addrp = reg;
583
584 return 0;
585}
586
587/* Extract a signed value from a bit field within an instruction
588 encoding.
589
590 INSN is the instruction opcode.
591
592 WIDTH specifies the width of the bit field to extract (in bits).
593
594 OFFSET specifies the least significant bit of the field where bits
595 are numbered zero counting from least to most significant. */
596
597static int32_t
598extract_signed_bitfield (uint32_t insn, unsigned width, unsigned offset)
599{
600 unsigned shift_l = sizeof (int32_t) * 8 - (offset + width);
601 unsigned shift_r = sizeof (int32_t) * 8 - width;
602
603 return ((int32_t) insn << shift_l) >> shift_r;
604}
605
606/* Decode an opcode if it represents an LDR or LDRSW instruction taking a
607 literal offset from the current PC.
608
609 ADDR specifies the address of the opcode.
610 INSN specifies the opcode to test.
611 IS_W is set if the instruction is LDRSW.
612 IS64 receives size field from the decoded instruction.
613 RT receives the 'rt' field from the decoded instruction.
614 OFFSET receives the 'imm' field from the decoded instruction.
615
616 Return 1 if the opcodes matches and is decoded, otherwise 0. */
617
618int
619aarch64_decode_ldr_literal (CORE_ADDR addr, uint32_t insn, int *is_w,
620 int *is64, unsigned *rt, int32_t *offset)
621{
622 /* LDR 0T01 1000 iiii iiii iiii iiii iiir rrrr */
623 /* LDRSW 1001 1000 iiii iiii iiii iiii iiir rrrr */
624 if ((insn & 0x3f000000) == 0x18000000)
625 {
626 *is_w = (insn >> 31) & 0x1;
627
628 if (*is_w)
629 {
630 /* LDRSW always takes a 64-bit destination registers. */
631 *is64 = 1;
632 }
633 else
634 *is64 = (insn >> 30) & 0x1;
635
636 *rt = (insn >> 0) & 0x1f;
637 *offset = extract_signed_bitfield (insn, 19, 5) << 2;
638
639 if (aarch64_debug)
640 debug_printf ("decode: %s 0x%x %s %s%u, #?\n",
641 core_addr_to_string_nz (addr), insn,
642 *is_w ? "ldrsw" : "ldr",
643 *is64 ? "x" : "w", *rt);
644
645 return 1;
646 }
647
648 return 0;
649}
650
651/* List of opcodes that we need for building the jump pad and relocating
652 an instruction. */
653
654enum aarch64_opcodes
655{
656 /* B 0001 01ii iiii iiii iiii iiii iiii iiii */
657 /* BL 1001 01ii iiii iiii iiii iiii iiii iiii */
658 /* B.COND 0101 0100 iiii iiii iiii iiii iii0 cccc */
659 /* CBZ s011 0100 iiii iiii iiii iiii iiir rrrr */
660 /* CBNZ s011 0101 iiii iiii iiii iiii iiir rrrr */
661 /* TBZ b011 0110 bbbb biii iiii iiii iiir rrrr */
662 /* TBNZ b011 0111 bbbb biii iiii iiii iiir rrrr */
663 B = 0x14000000,
664 BL = 0x80000000 | B,
665 BCOND = 0x40000000 | B,
666 CBZ = 0x20000000 | B,
667 CBNZ = 0x21000000 | B,
668 TBZ = 0x36000000 | B,
669 TBNZ = 0x37000000 | B,
670 /* BLR 1101 0110 0011 1111 0000 00rr rrr0 0000 */
671 BLR = 0xd63f0000,
afbe19f8
PL
672 /* RET 1101 0110 0101 1111 0000 00rr rrr0 0000 */
673 RET = 0xd65f0000,
bb903df0
PL
674 /* STP s010 100o o0ii iiii irrr rrrr rrrr rrrr */
675 /* LDP s010 100o o1ii iiii irrr rrrr rrrr rrrr */
676 /* STP (SIMD&VFP) ss10 110o o0ii iiii irrr rrrr rrrr rrrr */
677 /* LDP (SIMD&VFP) ss10 110o o1ii iiii irrr rrrr rrrr rrrr */
678 STP = 0x28000000,
679 LDP = 0x28400000,
680 STP_SIMD_VFP = 0x04000000 | STP,
681 LDP_SIMD_VFP = 0x04000000 | LDP,
682 /* STR ss11 100o 00xi iiii iiii xxrr rrrr rrrr */
683 /* LDR ss11 100o 01xi iiii iiii xxrr rrrr rrrr */
684 /* LDRSW 1011 100o 10xi iiii iiii xxrr rrrr rrrr */
685 STR = 0x38000000,
686 LDR = 0x00400000 | STR,
687 LDRSW = 0x80800000 | STR,
688 /* LDAXR ss00 1000 0101 1111 1111 11rr rrrr rrrr */
689 LDAXR = 0x085ffc00,
690 /* STXR ss00 1000 000r rrrr 0111 11rr rrrr rrrr */
691 STXR = 0x08007c00,
692 /* STLR ss00 1000 1001 1111 1111 11rr rrrr rrrr */
693 STLR = 0x089ffc00,
694 /* MOV s101 0010 1xxi iiii iiii iiii iiir rrrr */
695 /* MOVK s111 0010 1xxi iiii iiii iiii iiir rrrr */
696 MOV = 0x52800000,
697 MOVK = 0x20000000 | MOV,
698 /* ADD s00o ooo1 xxxx xxxx xxxx xxxx xxxx xxxx */
699 /* SUB s10o ooo1 xxxx xxxx xxxx xxxx xxxx xxxx */
700 /* SUBS s11o ooo1 xxxx xxxx xxxx xxxx xxxx xxxx */
701 ADD = 0x01000000,
702 SUB = 0x40000000 | ADD,
afbe19f8
PL
703 SUBS = 0x20000000 | SUB,
704 /* AND s000 1010 xx0x xxxx xxxx xxxx xxxx xxxx */
705 /* ORR s010 1010 xx0x xxxx xxxx xxxx xxxx xxxx */
706 /* ORN s010 1010 xx1x xxxx xxxx xxxx xxxx xxxx */
707 /* EOR s100 1010 xx0x xxxx xxxx xxxx xxxx xxxx */
708 AND = 0x0a000000,
709 ORR = 0x20000000 | AND,
710 ORN = 0x00200000 | ORR,
711 EOR = 0x40000000 | AND,
712 /* LSLV s001 1010 110r rrrr 0010 00rr rrrr rrrr */
713 /* LSRV s001 1010 110r rrrr 0010 01rr rrrr rrrr */
714 /* ASRV s001 1010 110r rrrr 0010 10rr rrrr rrrr */
715 LSLV = 0x1ac02000,
716 LSRV = 0x00000400 | LSLV,
717 ASRV = 0x00000800 | LSLV,
718 /* SBFM s001 0011 0nii iiii iiii iirr rrrr rrrr */
719 SBFM = 0x13000000,
720 /* UBFM s101 0011 0nii iiii iiii iirr rrrr rrrr */
721 UBFM = 0x40000000 | SBFM,
722 /* CSINC s001 1010 100r rrrr cccc 01rr rrrr rrrr */
723 CSINC = 0x9a800400,
724 /* MUL s001 1011 000r rrrr 0111 11rr rrrr rrrr */
725 MUL = 0x1b007c00,
bb903df0
PL
726 /* MSR (register) 1101 0101 0001 oooo oooo oooo ooor rrrr */
727 /* MRS 1101 0101 0011 oooo oooo oooo ooor rrrr */
728 MSR = 0xd5100000,
729 MRS = 0x00200000 | MSR,
730 /* HINT 1101 0101 0000 0011 0010 oooo ooo1 1111 */
731 HINT = 0xd503201f,
732 SEVL = (5 << 5) | HINT,
733 WFE = (2 << 5) | HINT,
afbe19f8
PL
734 NOP = (0 << 5) | HINT,
735};
736
737/* List of condition codes that we need. */
738
739enum aarch64_condition_codes
740{
741 EQ = 0x0,
742 NE = 0x1,
743 LO = 0x3,
744 GE = 0xa,
745 LT = 0xb,
746 GT = 0xc,
747 LE = 0xd,
bb903df0
PL
748};
749
750/* Representation of a general purpose register of the form xN or wN.
751
752 This type is used by emitting functions that take registers as operands. */
753
754struct aarch64_register
755{
756 unsigned num;
757 int is64;
758};
759
760/* Representation of an operand. At this time, it only supports register
761 and immediate types. */
762
763struct aarch64_operand
764{
765 /* Type of the operand. */
766 enum
767 {
768 OPERAND_IMMEDIATE,
769 OPERAND_REGISTER,
770 } type;
771 /* Value of the operand according to the type. */
772 union
773 {
774 uint32_t imm;
775 struct aarch64_register reg;
776 };
777};
778
779/* List of registers that we are currently using, we can add more here as
780 we need to use them. */
781
782/* General purpose scratch registers (64 bit). */
783static const struct aarch64_register x0 = { 0, 1 };
784static const struct aarch64_register x1 = { 1, 1 };
785static const struct aarch64_register x2 = { 2, 1 };
786static const struct aarch64_register x3 = { 3, 1 };
787static const struct aarch64_register x4 = { 4, 1 };
788
789/* General purpose scratch registers (32 bit). */
afbe19f8 790static const struct aarch64_register w0 = { 0, 0 };
bb903df0
PL
791static const struct aarch64_register w2 = { 2, 0 };
792
793/* Intra-procedure scratch registers. */
794static const struct aarch64_register ip0 = { 16, 1 };
795
796/* Special purpose registers. */
afbe19f8
PL
797static const struct aarch64_register fp = { 29, 1 };
798static const struct aarch64_register lr = { 30, 1 };
bb903df0
PL
799static const struct aarch64_register sp = { 31, 1 };
800static const struct aarch64_register xzr = { 31, 1 };
801
802/* Dynamically allocate a new register. If we know the register
803 statically, we should make it a global as above instead of using this
804 helper function. */
805
806static struct aarch64_register
807aarch64_register (unsigned num, int is64)
808{
809 return (struct aarch64_register) { num, is64 };
810}
811
812/* Helper function to create a register operand, for instructions with
813 different types of operands.
814
815 For example:
816 p += emit_mov (p, x0, register_operand (x1)); */
817
818static struct aarch64_operand
819register_operand (struct aarch64_register reg)
820{
821 struct aarch64_operand operand;
822
823 operand.type = OPERAND_REGISTER;
824 operand.reg = reg;
825
826 return operand;
827}
828
829/* Helper function to create an immediate operand, for instructions with
830 different types of operands.
831
832 For example:
833 p += emit_mov (p, x0, immediate_operand (12)); */
834
835static struct aarch64_operand
836immediate_operand (uint32_t imm)
837{
838 struct aarch64_operand operand;
839
840 operand.type = OPERAND_IMMEDIATE;
841 operand.imm = imm;
842
843 return operand;
844}
845
846/* Representation of a memory operand, used for load and store
847 instructions.
848
849 The types correspond to the following variants:
850
afbe19f8
PL
851 MEMORY_OPERAND_OFFSET: LDR rt, [rn, #offset]
852 MEMORY_OPERAND_PREINDEX: LDR rt, [rn, #index]!
853 MEMORY_OPERAND_POSTINDEX: LDR rt, [rn], #index */
bb903df0
PL
854
855struct aarch64_memory_operand
856{
857 /* Type of the operand. */
858 enum
859 {
860 MEMORY_OPERAND_OFFSET,
861 MEMORY_OPERAND_PREINDEX,
afbe19f8 862 MEMORY_OPERAND_POSTINDEX,
bb903df0
PL
863 } type;
864 /* Index from the base register. */
865 int32_t index;
866};
867
868/* Helper function to create an offset memory operand.
869
870 For example:
871 p += emit_ldr (p, x0, sp, offset_memory_operand (16)); */
872
873static struct aarch64_memory_operand
874offset_memory_operand (int32_t offset)
875{
876 return (struct aarch64_memory_operand) { MEMORY_OPERAND_OFFSET, offset };
877}
878
879/* Helper function to create a pre-index memory operand.
880
881 For example:
882 p += emit_ldr (p, x0, sp, preindex_memory_operand (16)); */
883
884static struct aarch64_memory_operand
885preindex_memory_operand (int32_t index)
886{
887 return (struct aarch64_memory_operand) { MEMORY_OPERAND_PREINDEX, index };
888}
889
afbe19f8
PL
890/* Helper function to create a post-index memory operand.
891
892 For example:
893 p += emit_ldr (p, x0, sp, postindex_memory_operand (16)); */
894
895static struct aarch64_memory_operand
896postindex_memory_operand (int32_t index)
897{
898 return (struct aarch64_memory_operand) { MEMORY_OPERAND_POSTINDEX, index };
899}
900
bb903df0
PL
901/* System control registers. These special registers can be written and
902 read with the MRS and MSR instructions.
903
904 - NZCV: Condition flags. GDB refers to this register under the CPSR
905 name.
906 - FPSR: Floating-point status register.
907 - FPCR: Floating-point control registers.
908 - TPIDR_EL0: Software thread ID register. */
909
910enum aarch64_system_control_registers
911{
912 /* op0 op1 crn crm op2 */
913 NZCV = (0x1 << 14) | (0x3 << 11) | (0x4 << 7) | (0x2 << 3) | 0x0,
914 FPSR = (0x1 << 14) | (0x3 << 11) | (0x4 << 7) | (0x4 << 3) | 0x1,
915 FPCR = (0x1 << 14) | (0x3 << 11) | (0x4 << 7) | (0x4 << 3) | 0x0,
916 TPIDR_EL0 = (0x1 << 14) | (0x3 << 11) | (0xd << 7) | (0x0 << 3) | 0x2
917};
918
919/* Helper macro to mask and shift a value into a bitfield. */
920
921#define ENCODE(val, size, offset) \
922 ((uint32_t) ((val & ((1ULL << size) - 1)) << offset))
923
924/* Write a 32-bit unsigned integer INSN info *BUF. Return the number of
925 instructions written (aka. 1). */
926
927static int
928emit_insn (uint32_t *buf, uint32_t insn)
929{
930 *buf = insn;
931 return 1;
932}
933
934/* Write a B or BL instruction into *BUF.
935
936 B #offset
937 BL #offset
938
939 IS_BL specifies if the link register should be updated.
940 OFFSET is the immediate offset from the current PC. It is
941 byte-addressed but should be 4 bytes aligned. It has a limited range of
942 +/- 128MB (26 bits << 2). */
943
944static int
945emit_b (uint32_t *buf, int is_bl, int32_t offset)
946{
947 uint32_t imm26 = ENCODE (offset >> 2, 26, 0);
948
949 if (is_bl)
950 return emit_insn (buf, BL | imm26);
951 else
952 return emit_insn (buf, B | imm26);
953}
954
955/* Write a BCOND instruction into *BUF.
956
957 B.COND #offset
958
959 COND specifies the condition field.
960 OFFSET is the immediate offset from the current PC. It is
961 byte-addressed but should be 4 bytes aligned. It has a limited range of
962 +/- 1MB (19 bits << 2). */
963
964static int
965emit_bcond (uint32_t *buf, unsigned cond, int32_t offset)
966{
967 return emit_insn (buf, BCOND | ENCODE (offset >> 2, 19, 5)
968 | ENCODE (cond, 4, 0));
969}
970
971/* Write a CBZ or CBNZ instruction into *BUF.
972
973 CBZ rt, #offset
974 CBNZ rt, #offset
975
976 IS_CBNZ distinguishes between CBZ and CBNZ instructions.
977 RN is the register to test.
978 OFFSET is the immediate offset from the current PC. It is
979 byte-addressed but should be 4 bytes aligned. It has a limited range of
980 +/- 1MB (19 bits << 2). */
981
982static int
983emit_cb (uint32_t *buf, int is_cbnz, struct aarch64_register rt,
984 int32_t offset)
985{
986 uint32_t imm19 = ENCODE (offset >> 2, 19, 5);
987 uint32_t sf = ENCODE (rt.is64, 1, 31);
988
989 if (is_cbnz)
990 return emit_insn (buf, CBNZ | sf | imm19 | ENCODE (rt.num, 5, 0));
991 else
992 return emit_insn (buf, CBZ | sf | imm19 | ENCODE (rt.num, 5, 0));
993}
994
995/* Write a TBZ or TBNZ instruction into *BUF.
996
997 TBZ rt, #bit, #offset
998 TBNZ rt, #bit, #offset
999
1000 IS_TBNZ distinguishes between TBZ and TBNZ instructions.
1001 RT is the register to test.
1002 BIT is the index of the bit to test in register RT.
1003 OFFSET is the immediate offset from the current PC. It is
1004 byte-addressed but should be 4 bytes aligned. It has a limited range of
1005 +/- 32KB (14 bits << 2). */
1006
1007static int
1008emit_tb (uint32_t *buf, int is_tbnz, unsigned bit,
1009 struct aarch64_register rt, int32_t offset)
1010{
1011 uint32_t imm14 = ENCODE (offset >> 2, 14, 5);
1012 uint32_t b40 = ENCODE (bit, 5, 19);
1013 uint32_t b5 = ENCODE (bit >> 5, 1, 31);
1014
1015 if (is_tbnz)
1016 return emit_insn (buf, TBNZ | b5 | b40 | imm14 | ENCODE (rt.num, 5, 0));
1017 else
1018 return emit_insn (buf, TBZ | b5 | b40 | imm14 | ENCODE (rt.num, 5, 0));
1019}
1020
1021/* Write a BLR instruction into *BUF.
1022
1023 BLR rn
1024
1025 RN is the register to branch to. */
1026
1027static int
1028emit_blr (uint32_t *buf, struct aarch64_register rn)
1029{
1030 return emit_insn (buf, BLR | ENCODE (rn.num, 5, 5));
1031}
1032
afbe19f8 1033/* Write a RET instruction into *BUF.
bb903df0 1034
afbe19f8 1035 RET xn
bb903df0 1036
afbe19f8 1037 RN is the register to branch to. */
bb903df0
PL
1038
1039static int
afbe19f8
PL
1040emit_ret (uint32_t *buf, struct aarch64_register rn)
1041{
1042 return emit_insn (buf, RET | ENCODE (rn.num, 5, 5));
1043}
1044
1045static int
1046emit_load_store_pair (uint32_t *buf, enum aarch64_opcodes opcode,
1047 struct aarch64_register rt,
1048 struct aarch64_register rt2,
1049 struct aarch64_register rn,
1050 struct aarch64_memory_operand operand)
bb903df0
PL
1051{
1052 uint32_t opc;
1053 uint32_t pre_index;
1054 uint32_t write_back;
1055
1056 if (rt.is64)
1057 opc = ENCODE (2, 2, 30);
1058 else
1059 opc = ENCODE (0, 2, 30);
1060
1061 switch (operand.type)
1062 {
1063 case MEMORY_OPERAND_OFFSET:
1064 {
1065 pre_index = ENCODE (1, 1, 24);
1066 write_back = ENCODE (0, 1, 23);
1067 break;
1068 }
afbe19f8
PL
1069 case MEMORY_OPERAND_POSTINDEX:
1070 {
1071 pre_index = ENCODE (0, 1, 24);
1072 write_back = ENCODE (1, 1, 23);
1073 break;
1074 }
bb903df0
PL
1075 case MEMORY_OPERAND_PREINDEX:
1076 {
1077 pre_index = ENCODE (1, 1, 24);
1078 write_back = ENCODE (1, 1, 23);
1079 break;
1080 }
1081 default:
1082 return 0;
1083 }
1084
afbe19f8 1085 return emit_insn (buf, opcode | opc | pre_index | write_back
7781c06f
YQ
1086 | ENCODE (operand.index >> 3, 7, 15)
1087 | ENCODE (rt2.num, 5, 10)
bb903df0
PL
1088 | ENCODE (rn.num, 5, 5) | ENCODE (rt.num, 5, 0));
1089}
1090
afbe19f8
PL
1091/* Write a STP instruction into *BUF.
1092
1093 STP rt, rt2, [rn, #offset]
1094 STP rt, rt2, [rn, #index]!
1095 STP rt, rt2, [rn], #index
1096
1097 RT and RT2 are the registers to store.
1098 RN is the base address register.
1099 OFFSET is the immediate to add to the base address. It is limited to a
1100 -512 .. 504 range (7 bits << 3). */
1101
1102static int
1103emit_stp (uint32_t *buf, struct aarch64_register rt,
1104 struct aarch64_register rt2, struct aarch64_register rn,
1105 struct aarch64_memory_operand operand)
1106{
1107 return emit_load_store_pair (buf, STP, rt, rt2, rn, operand);
1108}
1109
1110/* Write a LDP instruction into *BUF.
1111
1112 LDP rt, rt2, [rn, #offset]
1113 LDP rt, rt2, [rn, #index]!
1114 LDP rt, rt2, [rn], #index
1115
1116 RT and RT2 are the registers to store.
1117 RN is the base address register.
1118 OFFSET is the immediate to add to the base address. It is limited to a
1119 -512 .. 504 range (7 bits << 3). */
1120
1121static int
1122emit_ldp (uint32_t *buf, struct aarch64_register rt,
1123 struct aarch64_register rt2, struct aarch64_register rn,
1124 struct aarch64_memory_operand operand)
1125{
1126 return emit_load_store_pair (buf, LDP, rt, rt2, rn, operand);
1127}
1128
bb903df0
PL
1129/* Write a LDP (SIMD&VFP) instruction using Q registers into *BUF.
1130
1131 LDP qt, qt2, [rn, #offset]
1132
1133 RT and RT2 are the Q registers to store.
1134 RN is the base address register.
1135 OFFSET is the immediate to add to the base address. It is limited to
1136 -1024 .. 1008 range (7 bits << 4). */
1137
1138static int
1139emit_ldp_q_offset (uint32_t *buf, unsigned rt, unsigned rt2,
1140 struct aarch64_register rn, int32_t offset)
1141{
1142 uint32_t opc = ENCODE (2, 2, 30);
1143 uint32_t pre_index = ENCODE (1, 1, 24);
1144
1145 return emit_insn (buf, LDP_SIMD_VFP | opc | pre_index
1146 | ENCODE (offset >> 4, 7, 15) | ENCODE (rt2, 5, 10)
1147 | ENCODE (rn.num, 5, 5) | ENCODE (rt, 5, 0));
1148}
1149
1150/* Write a STP (SIMD&VFP) instruction using Q registers into *BUF.
1151
1152 STP qt, qt2, [rn, #offset]
1153
1154 RT and RT2 are the Q registers to store.
1155 RN is the base address register.
1156 OFFSET is the immediate to add to the base address. It is limited to
1157 -1024 .. 1008 range (7 bits << 4). */
1158
1159static int
1160emit_stp_q_offset (uint32_t *buf, unsigned rt, unsigned rt2,
1161 struct aarch64_register rn, int32_t offset)
1162{
1163 uint32_t opc = ENCODE (2, 2, 30);
1164 uint32_t pre_index = ENCODE (1, 1, 24);
1165
1166 return emit_insn (buf, STP_SIMD_VFP | opc | pre_index
1167 | ENCODE (offset >> 4, 7, 15) | ENCODE (rt2, 5, 10)
1168 | ENCODE (rn.num, 5, 5) | ENCODE (rt, 5, 0));
1169}
1170
1171/* Helper function emitting a load or store instruction. */
1172
1173static int
1174emit_load_store (uint32_t *buf, uint32_t size, enum aarch64_opcodes opcode,
1175 struct aarch64_register rt, struct aarch64_register rn,
1176 struct aarch64_memory_operand operand)
1177{
1178 uint32_t op;
1179
1180 switch (operand.type)
1181 {
1182 case MEMORY_OPERAND_OFFSET:
1183 {
1184 op = ENCODE (1, 1, 24);
1185
1186 return emit_insn (buf, opcode | ENCODE (size, 2, 30) | op
1187 | ENCODE (operand.index >> 3, 12, 10)
1188 | ENCODE (rn.num, 5, 5) | ENCODE (rt.num, 5, 0));
1189 }
afbe19f8
PL
1190 case MEMORY_OPERAND_POSTINDEX:
1191 {
1192 uint32_t post_index = ENCODE (1, 2, 10);
1193
1194 op = ENCODE (0, 1, 24);
1195
1196 return emit_insn (buf, opcode | ENCODE (size, 2, 30) | op
1197 | post_index | ENCODE (operand.index, 9, 12)
1198 | ENCODE (rn.num, 5, 5) | ENCODE (rt.num, 5, 0));
1199 }
bb903df0
PL
1200 case MEMORY_OPERAND_PREINDEX:
1201 {
1202 uint32_t pre_index = ENCODE (3, 2, 10);
1203
1204 op = ENCODE (0, 1, 24);
1205
1206 return emit_insn (buf, opcode | ENCODE (size, 2, 30) | op
1207 | pre_index | ENCODE (operand.index, 9, 12)
1208 | ENCODE (rn.num, 5, 5) | ENCODE (rt.num, 5, 0));
1209 }
1210 default:
1211 return 0;
1212 }
1213}
1214
1215/* Write a LDR instruction into *BUF.
1216
1217 LDR rt, [rn, #offset]
1218 LDR rt, [rn, #index]!
afbe19f8 1219 LDR rt, [rn], #index
bb903df0
PL
1220
1221 RT is the register to store.
1222 RN is the base address register.
1223 OFFSET is the immediate to add to the base address. It is limited to
1224 0 .. 32760 range (12 bits << 3). */
1225
1226static int
1227emit_ldr (uint32_t *buf, struct aarch64_register rt,
1228 struct aarch64_register rn, struct aarch64_memory_operand operand)
1229{
1230 return emit_load_store (buf, rt.is64 ? 3 : 2, LDR, rt, rn, operand);
1231}
1232
afbe19f8
PL
1233/* Write a LDRH instruction into *BUF.
1234
1235 LDRH wt, [xn, #offset]
1236 LDRH wt, [xn, #index]!
1237 LDRH wt, [xn], #index
1238
1239 RT is the register to store.
1240 RN is the base address register.
1241 OFFSET is the immediate to add to the base address. It is limited to
1242 0 .. 32760 range (12 bits << 3). */
1243
1244static int
1245emit_ldrh (uint32_t *buf, struct aarch64_register rt,
1246 struct aarch64_register rn,
1247 struct aarch64_memory_operand operand)
1248{
1249 return emit_load_store (buf, 1, LDR, rt, rn, operand);
1250}
1251
1252/* Write a LDRB instruction into *BUF.
1253
1254 LDRB wt, [xn, #offset]
1255 LDRB wt, [xn, #index]!
1256 LDRB wt, [xn], #index
1257
1258 RT is the register to store.
1259 RN is the base address register.
1260 OFFSET is the immediate to add to the base address. It is limited to
1261 0 .. 32760 range (12 bits << 3). */
1262
1263static int
1264emit_ldrb (uint32_t *buf, struct aarch64_register rt,
1265 struct aarch64_register rn,
1266 struct aarch64_memory_operand operand)
1267{
1268 return emit_load_store (buf, 0, LDR, rt, rn, operand);
1269}
1270
bb903df0
PL
1271/* Write a LDRSW instruction into *BUF. The register size is 64-bit.
1272
1273 LDRSW xt, [rn, #offset]
1274 LDRSW xt, [rn, #index]!
afbe19f8 1275 LDRSW xt, [rn], #index
bb903df0
PL
1276
1277 RT is the register to store.
1278 RN is the base address register.
1279 OFFSET is the immediate to add to the base address. It is limited to
1280 0 .. 16380 range (12 bits << 2). */
1281
1282static int
1283emit_ldrsw (uint32_t *buf, struct aarch64_register rt,
1284 struct aarch64_register rn,
1285 struct aarch64_memory_operand operand)
1286{
1287 return emit_load_store (buf, 3, LDRSW, rt, rn, operand);
1288}
1289
1290/* Write a STR instruction into *BUF.
1291
1292 STR rt, [rn, #offset]
1293 STR rt, [rn, #index]!
afbe19f8 1294 STR rt, [rn], #index
bb903df0
PL
1295
1296 RT is the register to store.
1297 RN is the base address register.
1298 OFFSET is the immediate to add to the base address. It is limited to
1299 0 .. 32760 range (12 bits << 3). */
1300
1301static int
1302emit_str (uint32_t *buf, struct aarch64_register rt,
1303 struct aarch64_register rn,
1304 struct aarch64_memory_operand operand)
1305{
1306 return emit_load_store (buf, rt.is64 ? 3 : 2, STR, rt, rn, operand);
1307}
1308
1309/* Helper function emitting an exclusive load or store instruction. */
1310
1311static int
1312emit_load_store_exclusive (uint32_t *buf, uint32_t size,
1313 enum aarch64_opcodes opcode,
1314 struct aarch64_register rs,
1315 struct aarch64_register rt,
1316 struct aarch64_register rt2,
1317 struct aarch64_register rn)
1318{
1319 return emit_insn (buf, opcode | ENCODE (size, 2, 30)
1320 | ENCODE (rs.num, 5, 16) | ENCODE (rt2.num, 5, 10)
1321 | ENCODE (rn.num, 5, 5) | ENCODE (rt.num, 5, 0));
1322}
1323
1324/* Write a LAXR instruction into *BUF.
1325
1326 LDAXR rt, [xn]
1327
1328 RT is the destination register.
1329 RN is the base address register. */
1330
1331static int
1332emit_ldaxr (uint32_t *buf, struct aarch64_register rt,
1333 struct aarch64_register rn)
1334{
1335 return emit_load_store_exclusive (buf, rt.is64 ? 3 : 2, LDAXR, xzr, rt,
1336 xzr, rn);
1337}
1338
1339/* Write a STXR instruction into *BUF.
1340
1341 STXR ws, rt, [xn]
1342
1343 RS is the result register, it indicates if the store succeeded or not.
1344 RT is the destination register.
1345 RN is the base address register. */
1346
1347static int
1348emit_stxr (uint32_t *buf, struct aarch64_register rs,
1349 struct aarch64_register rt, struct aarch64_register rn)
1350{
1351 return emit_load_store_exclusive (buf, rt.is64 ? 3 : 2, STXR, rs, rt,
1352 xzr, rn);
1353}
1354
1355/* Write a STLR instruction into *BUF.
1356
1357 STLR rt, [xn]
1358
1359 RT is the register to store.
1360 RN is the base address register. */
1361
1362static int
1363emit_stlr (uint32_t *buf, struct aarch64_register rt,
1364 struct aarch64_register rn)
1365{
1366 return emit_load_store_exclusive (buf, rt.is64 ? 3 : 2, STLR, xzr, rt,
1367 xzr, rn);
1368}
1369
1370/* Helper function for data processing instructions with register sources. */
1371
1372static int
1373emit_data_processing_reg (uint32_t *buf, enum aarch64_opcodes opcode,
1374 struct aarch64_register rd,
1375 struct aarch64_register rn,
1376 struct aarch64_register rm)
1377{
1378 uint32_t size = ENCODE (rd.is64, 1, 31);
1379
1380 return emit_insn (buf, opcode | size | ENCODE (rm.num, 5, 16)
1381 | ENCODE (rn.num, 5, 5) | ENCODE (rd.num, 5, 0));
1382}
1383
1384/* Helper function for data processing instructions taking either a register
1385 or an immediate. */
1386
1387static int
1388emit_data_processing (uint32_t *buf, enum aarch64_opcodes opcode,
1389 struct aarch64_register rd,
1390 struct aarch64_register rn,
1391 struct aarch64_operand operand)
1392{
1393 uint32_t size = ENCODE (rd.is64, 1, 31);
1394 /* The opcode is different for register and immediate source operands. */
1395 uint32_t operand_opcode;
1396
1397 if (operand.type == OPERAND_IMMEDIATE)
1398 {
1399 /* xxx1 000x xxxx xxxx xxxx xxxx xxxx xxxx */
1400 operand_opcode = ENCODE (8, 4, 25);
1401
1402 return emit_insn (buf, opcode | operand_opcode | size
1403 | ENCODE (operand.imm, 12, 10)
1404 | ENCODE (rn.num, 5, 5) | ENCODE (rd.num, 5, 0));
1405 }
1406 else
1407 {
1408 /* xxx0 101x xxxx xxxx xxxx xxxx xxxx xxxx */
1409 operand_opcode = ENCODE (5, 4, 25);
1410
1411 return emit_data_processing_reg (buf, opcode | operand_opcode, rd,
1412 rn, operand.reg);
1413 }
1414}
1415
1416/* Write an ADD instruction into *BUF.
1417
1418 ADD rd, rn, #imm
1419 ADD rd, rn, rm
1420
1421 This function handles both an immediate and register add.
1422
1423 RD is the destination register.
1424 RN is the input register.
1425 OPERAND is the source operand, either of type OPERAND_IMMEDIATE or
1426 OPERAND_REGISTER. */
1427
1428static int
1429emit_add (uint32_t *buf, struct aarch64_register rd,
1430 struct aarch64_register rn, struct aarch64_operand operand)
1431{
1432 return emit_data_processing (buf, ADD, rd, rn, operand);
1433}
1434
1435/* Write a SUB instruction into *BUF.
1436
1437 SUB rd, rn, #imm
1438 SUB rd, rn, rm
1439
1440 This function handles both an immediate and register sub.
1441
1442 RD is the destination register.
1443 RN is the input register.
1444 IMM is the immediate to substract to RN. */
1445
1446static int
1447emit_sub (uint32_t *buf, struct aarch64_register rd,
1448 struct aarch64_register rn, struct aarch64_operand operand)
1449{
1450 return emit_data_processing (buf, SUB, rd, rn, operand);
1451}
1452
1453/* Write a MOV instruction into *BUF.
1454
1455 MOV rd, #imm
1456 MOV rd, rm
1457
1458 This function handles both a wide immediate move and a register move,
1459 with the condition that the source register is not xzr. xzr and the
1460 stack pointer share the same encoding and this function only supports
1461 the stack pointer.
1462
1463 RD is the destination register.
1464 OPERAND is the source operand, either of type OPERAND_IMMEDIATE or
1465 OPERAND_REGISTER. */
1466
1467static int
1468emit_mov (uint32_t *buf, struct aarch64_register rd,
1469 struct aarch64_operand operand)
1470{
1471 if (operand.type == OPERAND_IMMEDIATE)
1472 {
1473 uint32_t size = ENCODE (rd.is64, 1, 31);
1474 /* Do not shift the immediate. */
1475 uint32_t shift = ENCODE (0, 2, 21);
1476
1477 return emit_insn (buf, MOV | size | shift
1478 | ENCODE (operand.imm, 16, 5)
1479 | ENCODE (rd.num, 5, 0));
1480 }
1481 else
1482 return emit_add (buf, rd, operand.reg, immediate_operand (0));
1483}
1484
1485/* Write a MOVK instruction into *BUF.
1486
1487 MOVK rd, #imm, lsl #shift
1488
1489 RD is the destination register.
1490 IMM is the immediate.
1491 SHIFT is the logical shift left to apply to IMM. */
1492
1493static int
7781c06f
YQ
1494emit_movk (uint32_t *buf, struct aarch64_register rd, uint32_t imm,
1495 unsigned shift)
bb903df0
PL
1496{
1497 uint32_t size = ENCODE (rd.is64, 1, 31);
1498
1499 return emit_insn (buf, MOVK | size | ENCODE (shift, 2, 21) |
1500 ENCODE (imm, 16, 5) | ENCODE (rd.num, 5, 0));
1501}
1502
1503/* Write instructions into *BUF in order to move ADDR into a register.
1504 ADDR can be a 64-bit value.
1505
1506 This function will emit a series of MOV and MOVK instructions, such as:
1507
1508 MOV xd, #(addr)
1509 MOVK xd, #(addr >> 16), lsl #16
1510 MOVK xd, #(addr >> 32), lsl #32
1511 MOVK xd, #(addr >> 48), lsl #48 */
1512
1513static int
1514emit_mov_addr (uint32_t *buf, struct aarch64_register rd, CORE_ADDR addr)
1515{
1516 uint32_t *p = buf;
1517
1518 /* The MOV (wide immediate) instruction clears to top bits of the
1519 register. */
1520 p += emit_mov (p, rd, immediate_operand (addr & 0xffff));
1521
1522 if ((addr >> 16) != 0)
1523 p += emit_movk (p, rd, (addr >> 16) & 0xffff, 1);
1524 else
1525 return p - buf;
1526
1527 if ((addr >> 32) != 0)
1528 p += emit_movk (p, rd, (addr >> 32) & 0xffff, 2);
1529 else
1530 return p - buf;
1531
1532 if ((addr >> 48) != 0)
1533 p += emit_movk (p, rd, (addr >> 48) & 0xffff, 3);
1534
1535 return p - buf;
1536}
1537
afbe19f8
PL
1538/* Write a SUBS instruction into *BUF.
1539
1540 SUBS rd, rn, rm
1541
1542 This instruction update the condition flags.
1543
1544 RD is the destination register.
1545 RN and RM are the source registers. */
1546
1547static int
1548emit_subs (uint32_t *buf, struct aarch64_register rd,
1549 struct aarch64_register rn, struct aarch64_operand operand)
1550{
1551 return emit_data_processing (buf, SUBS, rd, rn, operand);
1552}
1553
1554/* Write a CMP instruction into *BUF.
1555
1556 CMP rn, rm
1557
1558 This instruction is an alias of SUBS xzr, rn, rm.
1559
1560 RN and RM are the registers to compare. */
1561
1562static int
1563emit_cmp (uint32_t *buf, struct aarch64_register rn,
1564 struct aarch64_operand operand)
1565{
1566 return emit_subs (buf, xzr, rn, operand);
1567}
1568
1569/* Write a AND instruction into *BUF.
1570
1571 AND rd, rn, rm
1572
1573 RD is the destination register.
1574 RN and RM are the source registers. */
1575
1576static int
1577emit_and (uint32_t *buf, struct aarch64_register rd,
1578 struct aarch64_register rn, struct aarch64_register rm)
1579{
1580 return emit_data_processing_reg (buf, AND, rd, rn, rm);
1581}
1582
1583/* Write a ORR instruction into *BUF.
1584
1585 ORR rd, rn, rm
1586
1587 RD is the destination register.
1588 RN and RM are the source registers. */
1589
1590static int
1591emit_orr (uint32_t *buf, struct aarch64_register rd,
1592 struct aarch64_register rn, struct aarch64_register rm)
1593{
1594 return emit_data_processing_reg (buf, ORR, rd, rn, rm);
1595}
1596
1597/* Write a ORN instruction into *BUF.
1598
1599 ORN rd, rn, rm
1600
1601 RD is the destination register.
1602 RN and RM are the source registers. */
1603
1604static int
1605emit_orn (uint32_t *buf, struct aarch64_register rd,
1606 struct aarch64_register rn, struct aarch64_register rm)
1607{
1608 return emit_data_processing_reg (buf, ORN, rd, rn, rm);
1609}
1610
1611/* Write a EOR instruction into *BUF.
1612
1613 EOR rd, rn, rm
1614
1615 RD is the destination register.
1616 RN and RM are the source registers. */
1617
1618static int
1619emit_eor (uint32_t *buf, struct aarch64_register rd,
1620 struct aarch64_register rn, struct aarch64_register rm)
1621{
1622 return emit_data_processing_reg (buf, EOR, rd, rn, rm);
1623}
1624
1625/* Write a MVN instruction into *BUF.
1626
1627 MVN rd, rm
1628
1629 This is an alias for ORN rd, xzr, rm.
1630
1631 RD is the destination register.
1632 RM is the source register. */
1633
1634static int
1635emit_mvn (uint32_t *buf, struct aarch64_register rd,
1636 struct aarch64_register rm)
1637{
1638 return emit_orn (buf, rd, xzr, rm);
1639}
1640
1641/* Write a LSLV instruction into *BUF.
1642
1643 LSLV rd, rn, rm
1644
1645 RD is the destination register.
1646 RN and RM are the source registers. */
1647
1648static int
1649emit_lslv (uint32_t *buf, struct aarch64_register rd,
1650 struct aarch64_register rn, struct aarch64_register rm)
1651{
1652 return emit_data_processing_reg (buf, LSLV, rd, rn, rm);
1653}
1654
1655/* Write a LSRV instruction into *BUF.
1656
1657 LSRV rd, rn, rm
1658
1659 RD is the destination register.
1660 RN and RM are the source registers. */
1661
1662static int
1663emit_lsrv (uint32_t *buf, struct aarch64_register rd,
1664 struct aarch64_register rn, struct aarch64_register rm)
1665{
1666 return emit_data_processing_reg (buf, LSRV, rd, rn, rm);
1667}
1668
1669/* Write a ASRV instruction into *BUF.
1670
1671 ASRV rd, rn, rm
1672
1673 RD is the destination register.
1674 RN and RM are the source registers. */
1675
1676static int
1677emit_asrv (uint32_t *buf, struct aarch64_register rd,
1678 struct aarch64_register rn, struct aarch64_register rm)
1679{
1680 return emit_data_processing_reg (buf, ASRV, rd, rn, rm);
1681}
1682
1683/* Write a MUL instruction into *BUF.
1684
1685 MUL rd, rn, rm
1686
1687 RD is the destination register.
1688 RN and RM are the source registers. */
1689
1690static int
1691emit_mul (uint32_t *buf, struct aarch64_register rd,
1692 struct aarch64_register rn, struct aarch64_register rm)
1693{
1694 return emit_data_processing_reg (buf, MUL, rd, rn, rm);
1695}
1696
bb903df0
PL
1697/* Write a MRS instruction into *BUF. The register size is 64-bit.
1698
1699 MRS xt, system_reg
1700
1701 RT is the destination register.
1702 SYSTEM_REG is special purpose register to read. */
1703
1704static int
1705emit_mrs (uint32_t *buf, struct aarch64_register rt,
1706 enum aarch64_system_control_registers system_reg)
1707{
1708 return emit_insn (buf, MRS | ENCODE (system_reg, 15, 5)
1709 | ENCODE (rt.num, 5, 0));
1710}
1711
1712/* Write a MSR instruction into *BUF. The register size is 64-bit.
1713
1714 MSR system_reg, xt
1715
1716 SYSTEM_REG is special purpose register to write.
1717 RT is the input register. */
1718
1719static int
1720emit_msr (uint32_t *buf, enum aarch64_system_control_registers system_reg,
1721 struct aarch64_register rt)
1722{
1723 return emit_insn (buf, MSR | ENCODE (system_reg, 15, 5)
1724 | ENCODE (rt.num, 5, 0));
1725}
1726
1727/* Write a SEVL instruction into *BUF.
1728
1729 This is a hint instruction telling the hardware to trigger an event. */
1730
1731static int
1732emit_sevl (uint32_t *buf)
1733{
1734 return emit_insn (buf, SEVL);
1735}
1736
1737/* Write a WFE instruction into *BUF.
1738
1739 This is a hint instruction telling the hardware to wait for an event. */
1740
1741static int
1742emit_wfe (uint32_t *buf)
1743{
1744 return emit_insn (buf, WFE);
1745}
1746
afbe19f8
PL
1747/* Write a SBFM instruction into *BUF.
1748
1749 SBFM rd, rn, #immr, #imms
1750
1751 This instruction moves the bits from #immr to #imms into the
1752 destination, sign extending the result.
1753
1754 RD is the destination register.
1755 RN is the source register.
1756 IMMR is the bit number to start at (least significant bit).
1757 IMMS is the bit number to stop at (most significant bit). */
1758
1759static int
1760emit_sbfm (uint32_t *buf, struct aarch64_register rd,
1761 struct aarch64_register rn, uint32_t immr, uint32_t imms)
1762{
1763 uint32_t size = ENCODE (rd.is64, 1, 31);
1764 uint32_t n = ENCODE (rd.is64, 1, 22);
1765
1766 return emit_insn (buf, SBFM | size | n | ENCODE (immr, 6, 16)
1767 | ENCODE (imms, 6, 10) | ENCODE (rn.num, 5, 5)
1768 | ENCODE (rd.num, 5, 0));
1769}
1770
1771/* Write a SBFX instruction into *BUF.
1772
1773 SBFX rd, rn, #lsb, #width
1774
1775 This instruction moves #width bits from #lsb into the destination, sign
1776 extending the result. This is an alias for:
1777
1778 SBFM rd, rn, #lsb, #(lsb + width - 1)
1779
1780 RD is the destination register.
1781 RN is the source register.
1782 LSB is the bit number to start at (least significant bit).
1783 WIDTH is the number of bits to move. */
1784
1785static int
1786emit_sbfx (uint32_t *buf, struct aarch64_register rd,
1787 struct aarch64_register rn, uint32_t lsb, uint32_t width)
1788{
1789 return emit_sbfm (buf, rd, rn, lsb, lsb + width - 1);
1790}
1791
1792/* Write a UBFM instruction into *BUF.
1793
1794 UBFM rd, rn, #immr, #imms
1795
1796 This instruction moves the bits from #immr to #imms into the
1797 destination, extending the result with zeros.
1798
1799 RD is the destination register.
1800 RN is the source register.
1801 IMMR is the bit number to start at (least significant bit).
1802 IMMS is the bit number to stop at (most significant bit). */
1803
1804static int
1805emit_ubfm (uint32_t *buf, struct aarch64_register rd,
1806 struct aarch64_register rn, uint32_t immr, uint32_t imms)
1807{
1808 uint32_t size = ENCODE (rd.is64, 1, 31);
1809 uint32_t n = ENCODE (rd.is64, 1, 22);
1810
1811 return emit_insn (buf, UBFM | size | n | ENCODE (immr, 6, 16)
1812 | ENCODE (imms, 6, 10) | ENCODE (rn.num, 5, 5)
1813 | ENCODE (rd.num, 5, 0));
1814}
1815
1816/* Write a UBFX instruction into *BUF.
1817
1818 UBFX rd, rn, #lsb, #width
1819
1820 This instruction moves #width bits from #lsb into the destination,
1821 extending the result with zeros. This is an alias for:
1822
1823 UBFM rd, rn, #lsb, #(lsb + width - 1)
1824
1825 RD is the destination register.
1826 RN is the source register.
1827 LSB is the bit number to start at (least significant bit).
1828 WIDTH is the number of bits to move. */
1829
1830static int
1831emit_ubfx (uint32_t *buf, struct aarch64_register rd,
1832 struct aarch64_register rn, uint32_t lsb, uint32_t width)
1833{
1834 return emit_ubfm (buf, rd, rn, lsb, lsb + width - 1);
1835}
1836
1837/* Write a CSINC instruction into *BUF.
1838
1839 CSINC rd, rn, rm, cond
1840
1841 This instruction conditionally increments rn or rm and places the result
1842 in rd. rn is chosen is the condition is true.
1843
1844 RD is the destination register.
1845 RN and RM are the source registers.
1846 COND is the encoded condition. */
1847
1848static int
1849emit_csinc (uint32_t *buf, struct aarch64_register rd,
1850 struct aarch64_register rn, struct aarch64_register rm,
1851 unsigned cond)
1852{
1853 uint32_t size = ENCODE (rd.is64, 1, 31);
1854
1855 return emit_insn (buf, CSINC | size | ENCODE (rm.num, 5, 16)
1856 | ENCODE (cond, 4, 12) | ENCODE (rn.num, 5, 5)
1857 | ENCODE (rd.num, 5, 0));
1858}
1859
1860/* Write a CSET instruction into *BUF.
1861
1862 CSET rd, cond
1863
1864 This instruction conditionally write 1 or 0 in the destination register.
1865 1 is written if the condition is true. This is an alias for:
1866
1867 CSINC rd, xzr, xzr, !cond
1868
1869 Note that the condition needs to be inverted.
1870
1871 RD is the destination register.
1872 RN and RM are the source registers.
1873 COND is the encoded condition. */
1874
1875static int
1876emit_cset (uint32_t *buf, struct aarch64_register rd, unsigned cond)
1877{
1878 /* The least significant bit of the condition needs toggling in order to
1879 invert it. */
1880 return emit_csinc (buf, rd, xzr, xzr, cond ^ 0x1);
1881}
1882
1883/* Write a NOP instruction into *BUF. */
1884
1885static int
1886emit_nop (uint32_t *buf)
1887{
1888 return emit_insn (buf, NOP);
1889}
1890
bb903df0
PL
1891/* Write LEN instructions from BUF into the inferior memory at *TO.
1892
1893 Note instructions are always little endian on AArch64, unlike data. */
1894
1895static void
1896append_insns (CORE_ADDR *to, size_t len, const uint32_t *buf)
1897{
1898 size_t byte_len = len * sizeof (uint32_t);
1899#if (__BYTE_ORDER == __BIG_ENDIAN)
1900 uint32_t *le_buf = xmalloc (byte_len);
1901 size_t i;
1902
1903 for (i = 0; i < len; i++)
1904 le_buf[i] = htole32 (buf[i]);
1905
1906 write_inferior_memory (*to, (const unsigned char *) le_buf, byte_len);
1907
1908 xfree (le_buf);
1909#else
1910 write_inferior_memory (*to, (const unsigned char *) buf, byte_len);
1911#endif
1912
1913 *to += byte_len;
1914}
1915
1916/* Helper function. Return 1 if VAL can be encoded in BITS bits. */
1917
1918static int
1919can_encode_int32 (int32_t val, unsigned bits)
1920{
1921 /* This must be an arithemic shift. */
1922 int32_t rest = val >> bits;
1923
1924 return rest == 0 || rest == -1;
1925}
1926
1927/* Relocate an instruction from OLDLOC to *TO. This function will also
1928 increment TO by the number of bytes the new instruction(s) take(s).
1929
1930 PC relative instructions need to be handled specifically:
1931
1932 - B/BL
1933 - B.COND
1934 - CBZ/CBNZ
1935 - TBZ/TBNZ
1936 - ADR/ADRP
1937 - LDR/LDRSW (literal) */
1938
1939static void
1940aarch64_relocate_instruction (CORE_ADDR *to, CORE_ADDR oldloc)
1941{
1942 uint32_t buf[32];
1943 uint32_t *p = buf;
1944 uint32_t insn;
1945
1946 int is_bl;
1947 int is64;
1948 int is_sw;
1949 int is_cbnz;
1950 int is_tbnz;
1951 int is_adrp;
1952 unsigned rn;
1953 unsigned rt;
1954 unsigned rd;
1955 unsigned cond;
1956 unsigned bit;
1957 int32_t offset;
1958
1959 target_read_uint32 (oldloc, &insn);
1960
1961 if (aarch64_decode_b (oldloc, insn, &is_bl, &offset))
1962 {
1963 offset = (oldloc - *to + offset);
1964
1965 if (can_encode_int32 (offset, 28))
1966 p += emit_b (p, is_bl, offset);
1967 else
1968 return;
1969 }
1970 else if (aarch64_decode_bcond (oldloc, insn, &cond, &offset))
1971 {
1972 offset = (oldloc - *to + offset);
1973
1974 if (can_encode_int32 (offset, 21))
1975 p += emit_bcond (p, cond, offset);
1976 else if (can_encode_int32 (offset, 28))
1977 {
1978 /* The offset is out of range for a conditional branch
1979 instruction but not for a unconditional branch. We can use
1980 the following instructions instead:
1981
1982 B.COND TAKEN ; If cond is true, then jump to TAKEN.
1983 B NOT_TAKEN ; Else jump over TAKEN and continue.
1984 TAKEN:
1985 B #(offset - 8)
1986 NOT_TAKEN:
1987
1988 */
1989
1990 p += emit_bcond (p, cond, 8);
1991 p += emit_b (p, 0, 8);
1992 p += emit_b (p, 0, offset - 8);
1993 }
1994 else
1995 return;
1996 }
1997 else if (aarch64_decode_cb (oldloc, insn, &is64, &is_cbnz, &rn, &offset))
1998 {
1999 offset = (oldloc - *to + offset);
2000
2001 if (can_encode_int32 (offset, 21))
2002 p += emit_cb (p, is_cbnz, aarch64_register (rn, is64), offset);
2003 else if (can_encode_int32 (offset, 28))
2004 {
2005 /* The offset is out of range for a compare and branch
2006 instruction but not for a unconditional branch. We can use
2007 the following instructions instead:
2008
2009 CBZ xn, TAKEN ; xn == 0, then jump to TAKEN.
2010 B NOT_TAKEN ; Else jump over TAKEN and continue.
2011 TAKEN:
2012 B #(offset - 8)
2013 NOT_TAKEN:
2014
2015 */
2016 p += emit_cb (p, is_cbnz, aarch64_register (rn, is64), 8);
2017 p += emit_b (p, 0, 8);
2018 p += emit_b (p, 0, offset - 8);
2019 }
2020 else
2021 return;
2022 }
2023 else if (aarch64_decode_tb (oldloc, insn, &is_tbnz, &bit, &rt, &offset))
2024 {
2025 offset = (oldloc - *to + offset);
2026
2027 if (can_encode_int32 (offset, 16))
2028 p += emit_tb (p, is_tbnz, bit, aarch64_register (rt, 1), offset);
2029 else if (can_encode_int32 (offset, 28))
2030 {
2031 /* The offset is out of range for a test bit and branch
2032 instruction but not for a unconditional branch. We can use
2033 the following instructions instead:
2034
2035 TBZ xn, #bit, TAKEN ; xn[bit] == 0, then jump to TAKEN.
2036 B NOT_TAKEN ; Else jump over TAKEN and continue.
2037 TAKEN:
2038 B #(offset - 8)
2039 NOT_TAKEN:
2040
2041 */
2042 p += emit_tb (p, is_tbnz, bit, aarch64_register (rt, 1), 8);
2043 p += emit_b (p, 0, 8);
2044 p += emit_b (p, 0, offset - 8);
2045 }
2046 else
2047 return;
2048 }
2049 else if (aarch64_decode_adr (oldloc, insn, &is_adrp, &rd, &offset))
2050 {
2051
2052 /* We know exactly the address the ADR{P,} instruction will compute.
2053 We can just write it to the destination register. */
2054 CORE_ADDR address = oldloc + offset;
2055
2056 if (is_adrp)
2057 {
2058 /* Clear the lower 12 bits of the offset to get the 4K page. */
2059 p += emit_mov_addr (p, aarch64_register (rd, 1),
2060 address & ~0xfff);
2061 }
2062 else
2063 p += emit_mov_addr (p, aarch64_register (rd, 1), address);
2064 }
2065 else if (aarch64_decode_ldr_literal (oldloc, insn, &is_sw, &is64, &rt,
2066 &offset))
2067 {
2068 /* We know exactly what address to load from, and what register we
2069 can use:
2070
2071 MOV xd, #(oldloc + offset)
2072 MOVK xd, #((oldloc + offset) >> 16), lsl #16
2073 ...
2074
2075 LDR xd, [xd] ; or LDRSW xd, [xd]
2076
2077 */
2078 CORE_ADDR address = oldloc + offset;
2079
2080 p += emit_mov_addr (p, aarch64_register (rt, 1), address);
2081
2082 if (is_sw)
2083 p += emit_ldrsw (p, aarch64_register (rt, 1),
2084 aarch64_register (rt, 1),
2085 offset_memory_operand (0));
2086 else
2087 p += emit_ldr (p, aarch64_register (rt, is64),
2088 aarch64_register (rt, 1),
2089 offset_memory_operand (0));
2090 }
2091 else
2092 {
2093 /* The instruction is not PC relative. Just re-emit it at the new
2094 location. */
2095 p += emit_insn (p, insn);
2096 }
2097
2098 append_insns (to, p - buf, buf);
2099}
2100
2101/* Implementation of linux_target_ops method
2102 "install_fast_tracepoint_jump_pad". */
2103
2104static int
2105aarch64_install_fast_tracepoint_jump_pad (CORE_ADDR tpoint,
2106 CORE_ADDR tpaddr,
2107 CORE_ADDR collector,
2108 CORE_ADDR lockaddr,
2109 ULONGEST orig_size,
2110 CORE_ADDR *jump_entry,
2111 CORE_ADDR *trampoline,
2112 ULONGEST *trampoline_size,
2113 unsigned char *jjump_pad_insn,
2114 ULONGEST *jjump_pad_insn_size,
2115 CORE_ADDR *adjusted_insn_addr,
2116 CORE_ADDR *adjusted_insn_addr_end,
2117 char *err)
2118{
2119 uint32_t buf[256];
2120 uint32_t *p = buf;
2121 int32_t offset;
2122 int i;
2123 CORE_ADDR buildaddr = *jump_entry;
2124
2125 /* We need to save the current state on the stack both to restore it
2126 later and to collect register values when the tracepoint is hit.
2127
2128 The saved registers are pushed in a layout that needs to be in sync
2129 with aarch64_ft_collect_regmap (see linux-aarch64-ipa.c). Later on
2130 the supply_fast_tracepoint_registers function will fill in the
2131 register cache from a pointer to saved registers on the stack we build
2132 here.
2133
2134 For simplicity, we set the size of each cell on the stack to 16 bytes.
2135 This way one cell can hold any register type, from system registers
2136 to the 128 bit SIMD&FP registers. Furthermore, the stack pointer
2137 has to be 16 bytes aligned anyway.
2138
2139 Note that the CPSR register does not exist on AArch64. Instead we
2140 can access system bits describing the process state with the
2141 MRS/MSR instructions, namely the condition flags. We save them as
2142 if they are part of a CPSR register because that's how GDB
2143 interprets these system bits. At the moment, only the condition
2144 flags are saved in CPSR (NZCV).
2145
2146 Stack layout, each cell is 16 bytes (descending):
2147
2148 High *-------- SIMD&FP registers from 31 down to 0. --------*
2149 | q31 |
2150 . .
2151 . . 32 cells
2152 . .
2153 | q0 |
2154 *---- General purpose registers from 30 down to 0. ----*
2155 | x30 |
2156 . .
2157 . . 31 cells
2158 . .
2159 | x0 |
2160 *------------- Special purpose registers. -------------*
2161 | SP |
2162 | PC |
2163 | CPSR (NZCV) | 5 cells
2164 | FPSR |
2165 | FPCR | <- SP + 16
2166 *------------- collecting_t object --------------------*
2167 | TPIDR_EL0 | struct tracepoint * |
2168 Low *------------------------------------------------------*
2169
2170 After this stack is set up, we issue a call to the collector, passing
2171 it the saved registers at (SP + 16). */
2172
2173 /* Push SIMD&FP registers on the stack:
2174
2175 SUB sp, sp, #(32 * 16)
2176
2177 STP q30, q31, [sp, #(30 * 16)]
2178 ...
2179 STP q0, q1, [sp]
2180
2181 */
2182 p += emit_sub (p, sp, sp, immediate_operand (32 * 16));
2183 for (i = 30; i >= 0; i -= 2)
2184 p += emit_stp_q_offset (p, i, i + 1, sp, i * 16);
2185
2186 /* Push general puspose registers on the stack. Note that we do not need
2187 to push x31 as it represents the xzr register and not the stack
2188 pointer in a STR instruction.
2189
2190 SUB sp, sp, #(31 * 16)
2191
2192 STR x30, [sp, #(30 * 16)]
2193 ...
2194 STR x0, [sp]
2195
2196 */
2197 p += emit_sub (p, sp, sp, immediate_operand (31 * 16));
2198 for (i = 30; i >= 0; i -= 1)
2199 p += emit_str (p, aarch64_register (i, 1), sp,
2200 offset_memory_operand (i * 16));
2201
2202 /* Make space for 5 more cells.
2203
2204 SUB sp, sp, #(5 * 16)
2205
2206 */
2207 p += emit_sub (p, sp, sp, immediate_operand (5 * 16));
2208
2209
2210 /* Save SP:
2211
2212 ADD x4, sp, #((32 + 31 + 5) * 16)
2213 STR x4, [sp, #(4 * 16)]
2214
2215 */
2216 p += emit_add (p, x4, sp, immediate_operand ((32 + 31 + 5) * 16));
2217 p += emit_str (p, x4, sp, offset_memory_operand (4 * 16));
2218
2219 /* Save PC (tracepoint address):
2220
2221 MOV x3, #(tpaddr)
2222 ...
2223
2224 STR x3, [sp, #(3 * 16)]
2225
2226 */
2227
2228 p += emit_mov_addr (p, x3, tpaddr);
2229 p += emit_str (p, x3, sp, offset_memory_operand (3 * 16));
2230
2231 /* Save CPSR (NZCV), FPSR and FPCR:
2232
2233 MRS x2, nzcv
2234 MRS x1, fpsr
2235 MRS x0, fpcr
2236
2237 STR x2, [sp, #(2 * 16)]
2238 STR x1, [sp, #(1 * 16)]
2239 STR x0, [sp, #(0 * 16)]
2240
2241 */
2242 p += emit_mrs (p, x2, NZCV);
2243 p += emit_mrs (p, x1, FPSR);
2244 p += emit_mrs (p, x0, FPCR);
2245 p += emit_str (p, x2, sp, offset_memory_operand (2 * 16));
2246 p += emit_str (p, x1, sp, offset_memory_operand (1 * 16));
2247 p += emit_str (p, x0, sp, offset_memory_operand (0 * 16));
2248
2249 /* Push the collecting_t object. It consist of the address of the
2250 tracepoint and an ID for the current thread. We get the latter by
2251 reading the tpidr_el0 system register. It corresponds to the
2252 NT_ARM_TLS register accessible with ptrace.
2253
2254 MOV x0, #(tpoint)
2255 ...
2256
2257 MRS x1, tpidr_el0
2258
2259 STP x0, x1, [sp, #-16]!
2260
2261 */
2262
2263 p += emit_mov_addr (p, x0, tpoint);
2264 p += emit_mrs (p, x1, TPIDR_EL0);
2265 p += emit_stp (p, x0, x1, sp, preindex_memory_operand (-16));
2266
2267 /* Spin-lock:
2268
2269 The shared memory for the lock is at lockaddr. It will hold zero
2270 if no-one is holding the lock, otherwise it contains the address of
2271 the collecting_t object on the stack of the thread which acquired it.
2272
2273 At this stage, the stack pointer points to this thread's collecting_t
2274 object.
2275
2276 We use the following registers:
2277 - x0: Address of the lock.
2278 - x1: Pointer to collecting_t object.
2279 - x2: Scratch register.
2280
2281 MOV x0, #(lockaddr)
2282 ...
2283 MOV x1, sp
2284
2285 ; Trigger an event local to this core. So the following WFE
2286 ; instruction is ignored.
2287 SEVL
2288 again:
2289 ; Wait for an event. The event is triggered by either the SEVL
2290 ; or STLR instructions (store release).
2291 WFE
2292
2293 ; Atomically read at lockaddr. This marks the memory location as
2294 ; exclusive. This instruction also has memory constraints which
2295 ; make sure all previous data reads and writes are done before
2296 ; executing it.
2297 LDAXR x2, [x0]
2298
2299 ; Try again if another thread holds the lock.
2300 CBNZ x2, again
2301
2302 ; We can lock it! Write the address of the collecting_t object.
2303 ; This instruction will fail if the memory location is not marked
2304 ; as exclusive anymore. If it succeeds, it will remove the
2305 ; exclusive mark on the memory location. This way, if another
2306 ; thread executes this instruction before us, we will fail and try
2307 ; all over again.
2308 STXR w2, x1, [x0]
2309 CBNZ w2, again
2310
2311 */
2312
2313 p += emit_mov_addr (p, x0, lockaddr);
2314 p += emit_mov (p, x1, register_operand (sp));
2315
2316 p += emit_sevl (p);
2317 p += emit_wfe (p);
2318 p += emit_ldaxr (p, x2, x0);
2319 p += emit_cb (p, 1, w2, -2 * 4);
2320 p += emit_stxr (p, w2, x1, x0);
2321 p += emit_cb (p, 1, x2, -4 * 4);
2322
2323 /* Call collector (struct tracepoint *, unsigned char *):
2324
2325 MOV x0, #(tpoint)
2326 ...
2327
2328 ; Saved registers start after the collecting_t object.
2329 ADD x1, sp, #16
2330
2331 ; We use an intra-procedure-call scratch register.
2332 MOV ip0, #(collector)
2333 ...
2334
2335 ; And call back to C!
2336 BLR ip0
2337
2338 */
2339
2340 p += emit_mov_addr (p, x0, tpoint);
2341 p += emit_add (p, x1, sp, immediate_operand (16));
2342
2343 p += emit_mov_addr (p, ip0, collector);
2344 p += emit_blr (p, ip0);
2345
2346 /* Release the lock.
2347
2348 MOV x0, #(lockaddr)
2349 ...
2350
2351 ; This instruction is a normal store with memory ordering
2352 ; constraints. Thanks to this we do not have to put a data
2353 ; barrier instruction to make sure all data read and writes are done
2354 ; before this instruction is executed. Furthermore, this instrucion
2355 ; will trigger an event, letting other threads know they can grab
2356 ; the lock.
2357 STLR xzr, [x0]
2358
2359 */
2360 p += emit_mov_addr (p, x0, lockaddr);
2361 p += emit_stlr (p, xzr, x0);
2362
2363 /* Free collecting_t object:
2364
2365 ADD sp, sp, #16
2366
2367 */
2368 p += emit_add (p, sp, sp, immediate_operand (16));
2369
2370 /* Restore CPSR (NZCV), FPSR and FPCR. And free all special purpose
2371 registers from the stack.
2372
2373 LDR x2, [sp, #(2 * 16)]
2374 LDR x1, [sp, #(1 * 16)]
2375 LDR x0, [sp, #(0 * 16)]
2376
2377 MSR NZCV, x2
2378 MSR FPSR, x1
2379 MSR FPCR, x0
2380
2381 ADD sp, sp #(5 * 16)
2382
2383 */
2384 p += emit_ldr (p, x2, sp, offset_memory_operand (2 * 16));
2385 p += emit_ldr (p, x1, sp, offset_memory_operand (1 * 16));
2386 p += emit_ldr (p, x0, sp, offset_memory_operand (0 * 16));
2387 p += emit_msr (p, NZCV, x2);
2388 p += emit_msr (p, FPSR, x1);
2389 p += emit_msr (p, FPCR, x0);
2390
2391 p += emit_add (p, sp, sp, immediate_operand (5 * 16));
2392
2393 /* Pop general purpose registers:
2394
2395 LDR x0, [sp]
2396 ...
2397 LDR x30, [sp, #(30 * 16)]
2398
2399 ADD sp, sp, #(31 * 16)
2400
2401 */
2402 for (i = 0; i <= 30; i += 1)
2403 p += emit_ldr (p, aarch64_register (i, 1), sp,
2404 offset_memory_operand (i * 16));
2405 p += emit_add (p, sp, sp, immediate_operand (31 * 16));
2406
2407 /* Pop SIMD&FP registers:
2408
2409 LDP q0, q1, [sp]
2410 ...
2411 LDP q30, q31, [sp, #(30 * 16)]
2412
2413 ADD sp, sp, #(32 * 16)
2414
2415 */
2416 for (i = 0; i <= 30; i += 2)
2417 p += emit_ldp_q_offset (p, i, i + 1, sp, i * 16);
2418 p += emit_add (p, sp, sp, immediate_operand (32 * 16));
2419
2420 /* Write the code into the inferior memory. */
2421 append_insns (&buildaddr, p - buf, buf);
2422
2423 /* Now emit the relocated instruction. */
2424 *adjusted_insn_addr = buildaddr;
2425 aarch64_relocate_instruction (&buildaddr, tpaddr);
2426 *adjusted_insn_addr_end = buildaddr;
2427
2428 /* We may not have been able to relocate the instruction. */
2429 if (*adjusted_insn_addr == *adjusted_insn_addr_end)
2430 {
2431 sprintf (err,
2432 "E.Could not relocate instruction from %s to %s.",
2433 core_addr_to_string_nz (tpaddr),
2434 core_addr_to_string_nz (buildaddr));
2435 return 1;
2436 }
2437
2438 /* Go back to the start of the buffer. */
2439 p = buf;
2440
2441 /* Emit a branch back from the jump pad. */
2442 offset = (tpaddr + orig_size - buildaddr);
2443 if (!can_encode_int32 (offset, 28))
2444 {
2445 sprintf (err,
2446 "E.Jump back from jump pad too far from tracepoint "
2447 "(offset 0x%" PRIx32 " cannot be encoded in 28 bits).",
2448 offset);
2449 return 1;
2450 }
2451
2452 p += emit_b (p, 0, offset);
2453 append_insns (&buildaddr, p - buf, buf);
2454
2455 /* Give the caller a branch instruction into the jump pad. */
2456 offset = (*jump_entry - tpaddr);
2457 if (!can_encode_int32 (offset, 28))
2458 {
2459 sprintf (err,
2460 "E.Jump pad too far from tracepoint "
2461 "(offset 0x%" PRIx32 " cannot be encoded in 28 bits).",
2462 offset);
2463 return 1;
2464 }
2465
2466 emit_b ((uint32_t *) jjump_pad_insn, 0, offset);
2467 *jjump_pad_insn_size = 4;
2468
2469 /* Return the end address of our pad. */
2470 *jump_entry = buildaddr;
2471
2472 return 0;
2473}
2474
afbe19f8
PL
2475/* Helper function writing LEN instructions from START into
2476 current_insn_ptr. */
2477
2478static void
2479emit_ops_insns (const uint32_t *start, int len)
2480{
2481 CORE_ADDR buildaddr = current_insn_ptr;
2482
2483 if (debug_threads)
2484 debug_printf ("Adding %d instrucions at %s\n",
2485 len, paddress (buildaddr));
2486
2487 append_insns (&buildaddr, len, start);
2488 current_insn_ptr = buildaddr;
2489}
2490
2491/* Pop a register from the stack. */
2492
2493static int
2494emit_pop (uint32_t *buf, struct aarch64_register rt)
2495{
2496 return emit_ldr (buf, rt, sp, postindex_memory_operand (1 * 16));
2497}
2498
2499/* Push a register on the stack. */
2500
2501static int
2502emit_push (uint32_t *buf, struct aarch64_register rt)
2503{
2504 return emit_str (buf, rt, sp, preindex_memory_operand (-1 * 16));
2505}
2506
2507/* Implementation of emit_ops method "emit_prologue". */
2508
2509static void
2510aarch64_emit_prologue (void)
2511{
2512 uint32_t buf[16];
2513 uint32_t *p = buf;
2514
2515 /* This function emit a prologue for the following function prototype:
2516
2517 enum eval_result_type f (unsigned char *regs,
2518 ULONGEST *value);
2519
2520 The first argument is a buffer of raw registers. The second
2521 argument is the result of
2522 evaluating the expression, which will be set to whatever is on top of
2523 the stack at the end.
2524
2525 The stack set up by the prologue is as such:
2526
2527 High *------------------------------------------------------*
2528 | LR |
2529 | FP | <- FP
2530 | x1 (ULONGEST *value) |
2531 | x0 (unsigned char *regs) |
2532 Low *------------------------------------------------------*
2533
2534 As we are implementing a stack machine, each opcode can expand the
2535 stack so we never know how far we are from the data saved by this
2536 prologue. In order to be able refer to value and regs later, we save
2537 the current stack pointer in the frame pointer. This way, it is not
2538 clobbered when calling C functions.
2539
2540 Finally, throughtout every operation, we are using register x0 as the
2541 top of the stack, and x1 as a scratch register. */
2542
2543 p += emit_stp (p, x0, x1, sp, preindex_memory_operand (-2 * 16));
2544 p += emit_str (p, lr, sp, offset_memory_operand (3 * 8));
2545 p += emit_str (p, fp, sp, offset_memory_operand (2 * 8));
2546
2547 p += emit_add (p, fp, sp, immediate_operand (2 * 8));
2548
2549
2550 emit_ops_insns (buf, p - buf);
2551}
2552
2553/* Implementation of emit_ops method "emit_epilogue". */
2554
2555static void
2556aarch64_emit_epilogue (void)
2557{
2558 uint32_t buf[16];
2559 uint32_t *p = buf;
2560
2561 /* Store the result of the expression (x0) in *value. */
2562 p += emit_sub (p, x1, fp, immediate_operand (1 * 8));
2563 p += emit_ldr (p, x1, x1, offset_memory_operand (0));
2564 p += emit_str (p, x0, x1, offset_memory_operand (0));
2565
2566 /* Restore the previous state. */
2567 p += emit_add (p, sp, fp, immediate_operand (2 * 8));
2568 p += emit_ldp (p, fp, lr, fp, offset_memory_operand (0));
2569
2570 /* Return expr_eval_no_error. */
2571 p += emit_mov (p, x0, immediate_operand (expr_eval_no_error));
2572 p += emit_ret (p, lr);
2573
2574 emit_ops_insns (buf, p - buf);
2575}
2576
2577/* Implementation of emit_ops method "emit_add". */
2578
2579static void
2580aarch64_emit_add (void)
2581{
2582 uint32_t buf[16];
2583 uint32_t *p = buf;
2584
2585 p += emit_pop (p, x1);
2586 p += emit_add (p, x0, x0, register_operand (x1));
2587
2588 emit_ops_insns (buf, p - buf);
2589}
2590
2591/* Implementation of emit_ops method "emit_sub". */
2592
2593static void
2594aarch64_emit_sub (void)
2595{
2596 uint32_t buf[16];
2597 uint32_t *p = buf;
2598
2599 p += emit_pop (p, x1);
2600 p += emit_sub (p, x0, x0, register_operand (x1));
2601
2602 emit_ops_insns (buf, p - buf);
2603}
2604
2605/* Implementation of emit_ops method "emit_mul". */
2606
2607static void
2608aarch64_emit_mul (void)
2609{
2610 uint32_t buf[16];
2611 uint32_t *p = buf;
2612
2613 p += emit_pop (p, x1);
2614 p += emit_mul (p, x0, x1, x0);
2615
2616 emit_ops_insns (buf, p - buf);
2617}
2618
2619/* Implementation of emit_ops method "emit_lsh". */
2620
2621static void
2622aarch64_emit_lsh (void)
2623{
2624 uint32_t buf[16];
2625 uint32_t *p = buf;
2626
2627 p += emit_pop (p, x1);
2628 p += emit_lslv (p, x0, x1, x0);
2629
2630 emit_ops_insns (buf, p - buf);
2631}
2632
2633/* Implementation of emit_ops method "emit_rsh_signed". */
2634
2635static void
2636aarch64_emit_rsh_signed (void)
2637{
2638 uint32_t buf[16];
2639 uint32_t *p = buf;
2640
2641 p += emit_pop (p, x1);
2642 p += emit_asrv (p, x0, x1, x0);
2643
2644 emit_ops_insns (buf, p - buf);
2645}
2646
2647/* Implementation of emit_ops method "emit_rsh_unsigned". */
2648
2649static void
2650aarch64_emit_rsh_unsigned (void)
2651{
2652 uint32_t buf[16];
2653 uint32_t *p = buf;
2654
2655 p += emit_pop (p, x1);
2656 p += emit_lsrv (p, x0, x1, x0);
2657
2658 emit_ops_insns (buf, p - buf);
2659}
2660
2661/* Implementation of emit_ops method "emit_ext". */
2662
2663static void
2664aarch64_emit_ext (int arg)
2665{
2666 uint32_t buf[16];
2667 uint32_t *p = buf;
2668
2669 p += emit_sbfx (p, x0, x0, 0, arg);
2670
2671 emit_ops_insns (buf, p - buf);
2672}
2673
2674/* Implementation of emit_ops method "emit_log_not". */
2675
2676static void
2677aarch64_emit_log_not (void)
2678{
2679 uint32_t buf[16];
2680 uint32_t *p = buf;
2681
2682 /* If the top of the stack is 0, replace it with 1. Else replace it with
2683 0. */
2684
2685 p += emit_cmp (p, x0, immediate_operand (0));
2686 p += emit_cset (p, x0, EQ);
2687
2688 emit_ops_insns (buf, p - buf);
2689}
2690
2691/* Implementation of emit_ops method "emit_bit_and". */
2692
2693static void
2694aarch64_emit_bit_and (void)
2695{
2696 uint32_t buf[16];
2697 uint32_t *p = buf;
2698
2699 p += emit_pop (p, x1);
2700 p += emit_and (p, x0, x0, x1);
2701
2702 emit_ops_insns (buf, p - buf);
2703}
2704
2705/* Implementation of emit_ops method "emit_bit_or". */
2706
2707static void
2708aarch64_emit_bit_or (void)
2709{
2710 uint32_t buf[16];
2711 uint32_t *p = buf;
2712
2713 p += emit_pop (p, x1);
2714 p += emit_orr (p, x0, x0, x1);
2715
2716 emit_ops_insns (buf, p - buf);
2717}
2718
2719/* Implementation of emit_ops method "emit_bit_xor". */
2720
2721static void
2722aarch64_emit_bit_xor (void)
2723{
2724 uint32_t buf[16];
2725 uint32_t *p = buf;
2726
2727 p += emit_pop (p, x1);
2728 p += emit_eor (p, x0, x0, x1);
2729
2730 emit_ops_insns (buf, p - buf);
2731}
2732
2733/* Implementation of emit_ops method "emit_bit_not". */
2734
2735static void
2736aarch64_emit_bit_not (void)
2737{
2738 uint32_t buf[16];
2739 uint32_t *p = buf;
2740
2741 p += emit_mvn (p, x0, x0);
2742
2743 emit_ops_insns (buf, p - buf);
2744}
2745
2746/* Implementation of emit_ops method "emit_equal". */
2747
2748static void
2749aarch64_emit_equal (void)
2750{
2751 uint32_t buf[16];
2752 uint32_t *p = buf;
2753
2754 p += emit_pop (p, x1);
2755 p += emit_cmp (p, x0, register_operand (x1));
2756 p += emit_cset (p, x0, EQ);
2757
2758 emit_ops_insns (buf, p - buf);
2759}
2760
2761/* Implementation of emit_ops method "emit_less_signed". */
2762
2763static void
2764aarch64_emit_less_signed (void)
2765{
2766 uint32_t buf[16];
2767 uint32_t *p = buf;
2768
2769 p += emit_pop (p, x1);
2770 p += emit_cmp (p, x1, register_operand (x0));
2771 p += emit_cset (p, x0, LT);
2772
2773 emit_ops_insns (buf, p - buf);
2774}
2775
2776/* Implementation of emit_ops method "emit_less_unsigned". */
2777
2778static void
2779aarch64_emit_less_unsigned (void)
2780{
2781 uint32_t buf[16];
2782 uint32_t *p = buf;
2783
2784 p += emit_pop (p, x1);
2785 p += emit_cmp (p, x1, register_operand (x0));
2786 p += emit_cset (p, x0, LO);
2787
2788 emit_ops_insns (buf, p - buf);
2789}
2790
2791/* Implementation of emit_ops method "emit_ref". */
2792
2793static void
2794aarch64_emit_ref (int size)
2795{
2796 uint32_t buf[16];
2797 uint32_t *p = buf;
2798
2799 switch (size)
2800 {
2801 case 1:
2802 p += emit_ldrb (p, w0, x0, offset_memory_operand (0));
2803 break;
2804 case 2:
2805 p += emit_ldrh (p, w0, x0, offset_memory_operand (0));
2806 break;
2807 case 4:
2808 p += emit_ldr (p, w0, x0, offset_memory_operand (0));
2809 break;
2810 case 8:
2811 p += emit_ldr (p, x0, x0, offset_memory_operand (0));
2812 break;
2813 default:
2814 /* Unknown size, bail on compilation. */
2815 emit_error = 1;
2816 break;
2817 }
2818
2819 emit_ops_insns (buf, p - buf);
2820}
2821
2822/* Implementation of emit_ops method "emit_if_goto". */
2823
2824static void
2825aarch64_emit_if_goto (int *offset_p, int *size_p)
2826{
2827 uint32_t buf[16];
2828 uint32_t *p = buf;
2829
2830 /* The Z flag is set or cleared here. */
2831 p += emit_cmp (p, x0, immediate_operand (0));
2832 /* This instruction must not change the Z flag. */
2833 p += emit_pop (p, x0);
2834 /* Branch over the next instruction if x0 == 0. */
2835 p += emit_bcond (p, EQ, 8);
2836
2837 /* The NOP instruction will be patched with an unconditional branch. */
2838 if (offset_p)
2839 *offset_p = (p - buf) * 4;
2840 if (size_p)
2841 *size_p = 4;
2842 p += emit_nop (p);
2843
2844 emit_ops_insns (buf, p - buf);
2845}
2846
2847/* Implementation of emit_ops method "emit_goto". */
2848
2849static void
2850aarch64_emit_goto (int *offset_p, int *size_p)
2851{
2852 uint32_t buf[16];
2853 uint32_t *p = buf;
2854
2855 /* The NOP instruction will be patched with an unconditional branch. */
2856 if (offset_p)
2857 *offset_p = 0;
2858 if (size_p)
2859 *size_p = 4;
2860 p += emit_nop (p);
2861
2862 emit_ops_insns (buf, p - buf);
2863}
2864
2865/* Implementation of emit_ops method "write_goto_address". */
2866
2867void
2868aarch64_write_goto_address (CORE_ADDR from, CORE_ADDR to, int size)
2869{
2870 uint32_t insn;
2871
2872 emit_b (&insn, 0, to - from);
2873 append_insns (&from, 1, &insn);
2874}
2875
2876/* Implementation of emit_ops method "emit_const". */
2877
2878static void
2879aarch64_emit_const (LONGEST num)
2880{
2881 uint32_t buf[16];
2882 uint32_t *p = buf;
2883
2884 p += emit_mov_addr (p, x0, num);
2885
2886 emit_ops_insns (buf, p - buf);
2887}
2888
2889/* Implementation of emit_ops method "emit_call". */
2890
2891static void
2892aarch64_emit_call (CORE_ADDR fn)
2893{
2894 uint32_t buf[16];
2895 uint32_t *p = buf;
2896
2897 p += emit_mov_addr (p, ip0, fn);
2898 p += emit_blr (p, ip0);
2899
2900 emit_ops_insns (buf, p - buf);
2901}
2902
2903/* Implementation of emit_ops method "emit_reg". */
2904
2905static void
2906aarch64_emit_reg (int reg)
2907{
2908 uint32_t buf[16];
2909 uint32_t *p = buf;
2910
2911 /* Set x0 to unsigned char *regs. */
2912 p += emit_sub (p, x0, fp, immediate_operand (2 * 8));
2913 p += emit_ldr (p, x0, x0, offset_memory_operand (0));
2914 p += emit_mov (p, x1, immediate_operand (reg));
2915
2916 emit_ops_insns (buf, p - buf);
2917
2918 aarch64_emit_call (get_raw_reg_func_addr ());
2919}
2920
2921/* Implementation of emit_ops method "emit_pop". */
2922
2923static void
2924aarch64_emit_pop (void)
2925{
2926 uint32_t buf[16];
2927 uint32_t *p = buf;
2928
2929 p += emit_pop (p, x0);
2930
2931 emit_ops_insns (buf, p - buf);
2932}
2933
2934/* Implementation of emit_ops method "emit_stack_flush". */
2935
2936static void
2937aarch64_emit_stack_flush (void)
2938{
2939 uint32_t buf[16];
2940 uint32_t *p = buf;
2941
2942 p += emit_push (p, x0);
2943
2944 emit_ops_insns (buf, p - buf);
2945}
2946
2947/* Implementation of emit_ops method "emit_zero_ext". */
2948
2949static void
2950aarch64_emit_zero_ext (int arg)
2951{
2952 uint32_t buf[16];
2953 uint32_t *p = buf;
2954
2955 p += emit_ubfx (p, x0, x0, 0, arg);
2956
2957 emit_ops_insns (buf, p - buf);
2958}
2959
2960/* Implementation of emit_ops method "emit_swap". */
2961
2962static void
2963aarch64_emit_swap (void)
2964{
2965 uint32_t buf[16];
2966 uint32_t *p = buf;
2967
2968 p += emit_ldr (p, x1, sp, offset_memory_operand (0 * 16));
2969 p += emit_str (p, x0, sp, offset_memory_operand (0 * 16));
2970 p += emit_mov (p, x0, register_operand (x1));
2971
2972 emit_ops_insns (buf, p - buf);
2973}
2974
2975/* Implementation of emit_ops method "emit_stack_adjust". */
2976
2977static void
2978aarch64_emit_stack_adjust (int n)
2979{
2980 /* This is not needed with our design. */
2981 uint32_t buf[16];
2982 uint32_t *p = buf;
2983
2984 p += emit_add (p, sp, sp, immediate_operand (n * 16));
2985
2986 emit_ops_insns (buf, p - buf);
2987}
2988
2989/* Implementation of emit_ops method "emit_int_call_1". */
2990
2991static void
2992aarch64_emit_int_call_1 (CORE_ADDR fn, int arg1)
2993{
2994 uint32_t buf[16];
2995 uint32_t *p = buf;
2996
2997 p += emit_mov (p, x0, immediate_operand (arg1));
2998
2999 emit_ops_insns (buf, p - buf);
3000
3001 aarch64_emit_call (fn);
3002}
3003
3004/* Implementation of emit_ops method "emit_void_call_2". */
3005
3006static void
3007aarch64_emit_void_call_2 (CORE_ADDR fn, int arg1)
3008{
3009 uint32_t buf[16];
3010 uint32_t *p = buf;
3011
3012 /* Push x0 on the stack. */
3013 aarch64_emit_stack_flush ();
3014
3015 /* Setup arguments for the function call:
3016
3017 x0: arg1
3018 x1: top of the stack
3019
3020 MOV x1, x0
3021 MOV x0, #arg1 */
3022
3023 p += emit_mov (p, x1, register_operand (x0));
3024 p += emit_mov (p, x0, immediate_operand (arg1));
3025
3026 emit_ops_insns (buf, p - buf);
3027
3028 aarch64_emit_call (fn);
3029
3030 /* Restore x0. */
3031 aarch64_emit_pop ();
3032}
3033
3034/* Implementation of emit_ops method "emit_eq_goto". */
3035
3036static void
3037aarch64_emit_eq_goto (int *offset_p, int *size_p)
3038{
3039 uint32_t buf[16];
3040 uint32_t *p = buf;
3041
3042 p += emit_pop (p, x1);
3043 p += emit_cmp (p, x1, register_operand (x0));
3044 /* Branch over the next instruction if x0 != x1. */
3045 p += emit_bcond (p, NE, 8);
3046 /* The NOP instruction will be patched with an unconditional branch. */
3047 if (offset_p)
3048 *offset_p = (p - buf) * 4;
3049 if (size_p)
3050 *size_p = 4;
3051 p += emit_nop (p);
3052
3053 emit_ops_insns (buf, p - buf);
3054}
3055
3056/* Implementation of emit_ops method "emit_ne_goto". */
3057
3058static void
3059aarch64_emit_ne_goto (int *offset_p, int *size_p)
3060{
3061 uint32_t buf[16];
3062 uint32_t *p = buf;
3063
3064 p += emit_pop (p, x1);
3065 p += emit_cmp (p, x1, register_operand (x0));
3066 /* Branch over the next instruction if x0 == x1. */
3067 p += emit_bcond (p, EQ, 8);
3068 /* The NOP instruction will be patched with an unconditional branch. */
3069 if (offset_p)
3070 *offset_p = (p - buf) * 4;
3071 if (size_p)
3072 *size_p = 4;
3073 p += emit_nop (p);
3074
3075 emit_ops_insns (buf, p - buf);
3076}
3077
3078/* Implementation of emit_ops method "emit_lt_goto". */
3079
3080static void
3081aarch64_emit_lt_goto (int *offset_p, int *size_p)
3082{
3083 uint32_t buf[16];
3084 uint32_t *p = buf;
3085
3086 p += emit_pop (p, x1);
3087 p += emit_cmp (p, x1, register_operand (x0));
3088 /* Branch over the next instruction if x0 >= x1. */
3089 p += emit_bcond (p, GE, 8);
3090 /* The NOP instruction will be patched with an unconditional branch. */
3091 if (offset_p)
3092 *offset_p = (p - buf) * 4;
3093 if (size_p)
3094 *size_p = 4;
3095 p += emit_nop (p);
3096
3097 emit_ops_insns (buf, p - buf);
3098}
3099
3100/* Implementation of emit_ops method "emit_le_goto". */
3101
3102static void
3103aarch64_emit_le_goto (int *offset_p, int *size_p)
3104{
3105 uint32_t buf[16];
3106 uint32_t *p = buf;
3107
3108 p += emit_pop (p, x1);
3109 p += emit_cmp (p, x1, register_operand (x0));
3110 /* Branch over the next instruction if x0 > x1. */
3111 p += emit_bcond (p, GT, 8);
3112 /* The NOP instruction will be patched with an unconditional branch. */
3113 if (offset_p)
3114 *offset_p = (p - buf) * 4;
3115 if (size_p)
3116 *size_p = 4;
3117 p += emit_nop (p);
3118
3119 emit_ops_insns (buf, p - buf);
3120}
3121
3122/* Implementation of emit_ops method "emit_gt_goto". */
3123
3124static void
3125aarch64_emit_gt_goto (int *offset_p, int *size_p)
3126{
3127 uint32_t buf[16];
3128 uint32_t *p = buf;
3129
3130 p += emit_pop (p, x1);
3131 p += emit_cmp (p, x1, register_operand (x0));
3132 /* Branch over the next instruction if x0 <= x1. */
3133 p += emit_bcond (p, LE, 8);
3134 /* The NOP instruction will be patched with an unconditional branch. */
3135 if (offset_p)
3136 *offset_p = (p - buf) * 4;
3137 if (size_p)
3138 *size_p = 4;
3139 p += emit_nop (p);
3140
3141 emit_ops_insns (buf, p - buf);
3142}
3143
3144/* Implementation of emit_ops method "emit_ge_got". */
3145
3146static void
3147aarch64_emit_ge_got (int *offset_p, int *size_p)
3148{
3149 uint32_t buf[16];
3150 uint32_t *p = buf;
3151
3152 p += emit_pop (p, x1);
3153 p += emit_cmp (p, x1, register_operand (x0));
3154 /* Branch over the next instruction if x0 <= x1. */
3155 p += emit_bcond (p, LT, 8);
3156 /* The NOP instruction will be patched with an unconditional branch. */
3157 if (offset_p)
3158 *offset_p = (p - buf) * 4;
3159 if (size_p)
3160 *size_p = 4;
3161 p += emit_nop (p);
3162
3163 emit_ops_insns (buf, p - buf);
3164}
3165
3166static struct emit_ops aarch64_emit_ops_impl =
3167{
3168 aarch64_emit_prologue,
3169 aarch64_emit_epilogue,
3170 aarch64_emit_add,
3171 aarch64_emit_sub,
3172 aarch64_emit_mul,
3173 aarch64_emit_lsh,
3174 aarch64_emit_rsh_signed,
3175 aarch64_emit_rsh_unsigned,
3176 aarch64_emit_ext,
3177 aarch64_emit_log_not,
3178 aarch64_emit_bit_and,
3179 aarch64_emit_bit_or,
3180 aarch64_emit_bit_xor,
3181 aarch64_emit_bit_not,
3182 aarch64_emit_equal,
3183 aarch64_emit_less_signed,
3184 aarch64_emit_less_unsigned,
3185 aarch64_emit_ref,
3186 aarch64_emit_if_goto,
3187 aarch64_emit_goto,
3188 aarch64_write_goto_address,
3189 aarch64_emit_const,
3190 aarch64_emit_call,
3191 aarch64_emit_reg,
3192 aarch64_emit_pop,
3193 aarch64_emit_stack_flush,
3194 aarch64_emit_zero_ext,
3195 aarch64_emit_swap,
3196 aarch64_emit_stack_adjust,
3197 aarch64_emit_int_call_1,
3198 aarch64_emit_void_call_2,
3199 aarch64_emit_eq_goto,
3200 aarch64_emit_ne_goto,
3201 aarch64_emit_lt_goto,
3202 aarch64_emit_le_goto,
3203 aarch64_emit_gt_goto,
3204 aarch64_emit_ge_got,
3205};
3206
3207/* Implementation of linux_target_ops method "emit_ops". */
3208
3209static struct emit_ops *
3210aarch64_emit_ops (void)
3211{
3212 return &aarch64_emit_ops_impl;
3213}
3214
bb903df0
PL
3215/* Implementation of linux_target_ops method
3216 "get_min_fast_tracepoint_insn_len". */
3217
3218static int
3219aarch64_get_min_fast_tracepoint_insn_len (void)
3220{
3221 return 4;
3222}
3223
d1d0aea1
PL
3224/* Implementation of linux_target_ops method "supports_range_stepping". */
3225
3226static int
3227aarch64_supports_range_stepping (void)
3228{
3229 return 1;
3230}
3231
176eb98c
MS
3232struct linux_target_ops the_low_target =
3233{
3234 aarch64_arch_setup,
3aee8918 3235 aarch64_regs_info,
176eb98c
MS
3236 aarch64_cannot_fetch_register,
3237 aarch64_cannot_store_register,
421530db 3238 NULL, /* fetch_register */
176eb98c
MS
3239 aarch64_get_pc,
3240 aarch64_set_pc,
3241 (const unsigned char *) &aarch64_breakpoint,
3242 aarch64_breakpoint_len,
421530db
PL
3243 NULL, /* breakpoint_reinsert_addr */
3244 0, /* decr_pc_after_break */
176eb98c 3245 aarch64_breakpoint_at,
802e8e6d 3246 aarch64_supports_z_point_type,
176eb98c
MS
3247 aarch64_insert_point,
3248 aarch64_remove_point,
3249 aarch64_stopped_by_watchpoint,
3250 aarch64_stopped_data_address,
421530db
PL
3251 NULL, /* collect_ptrace_register */
3252 NULL, /* supply_ptrace_register */
ade90bde 3253 aarch64_linux_siginfo_fixup,
176eb98c
MS
3254 aarch64_linux_new_process,
3255 aarch64_linux_new_thread,
3a8a0396 3256 aarch64_linux_new_fork,
176eb98c 3257 aarch64_linux_prepare_to_resume,
421530db 3258 NULL, /* process_qsupported */
7671bf47 3259 aarch64_supports_tracepoints,
bb903df0
PL
3260 aarch64_get_thread_area,
3261 aarch64_install_fast_tracepoint_jump_pad,
afbe19f8 3262 aarch64_emit_ops,
bb903df0 3263 aarch64_get_min_fast_tracepoint_insn_len,
d1d0aea1 3264 aarch64_supports_range_stepping,
176eb98c 3265};
3aee8918
PA
3266
3267void
3268initialize_low_arch (void)
3269{
3270 init_registers_aarch64 ();
3271
3b53ae99
YQ
3272 initialize_low_arch_aarch32 ();
3273
3aee8918
PA
3274 initialize_regsets_info (&aarch64_regsets_info);
3275}
This page took 0.533201 seconds and 4 git commands to generate.