1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
|
/*
* This file is part of ltrace.
*
* Copyright (C) 2007 by Instituto Nokia de Tecnologia (INdT)
*
* Author: Anderson Lizardo <anderson.lizardo@indt.org.br>
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
* 02110-1301 USA
*
* Modified from sysdeps/linux-gnu/breakpoint.c and added ARM Thumb support.
*/
#include <sys/ptrace.h>
#include "config.h"
#include "common.h"
void
arch_enable_breakpoint(pid_t pid, struct breakpoint *sbp)
{
unsigned int i, j;
const unsigned char break_insn[] = BREAKPOINT_VALUE;
const unsigned char thumb_break_insn[] = THUMB_BREAKPOINT_VALUE;
debug(1, "arch_enable_breakpoint(%d,%p)", pid, sbp->addr);
for (i = 0; i < 1 + ((BREAKPOINT_LENGTH - 1) / sizeof(long)); i++) {
union _ { long l; unsigned char b[SIZEOF_LONG]; };
union _ orig, current;
unsigned char *bytes = current.b;
for (j = 0; j < sizeof(long); j++) {
orig.b[j] = sbp->orig_value[i * sizeof(long) + j];
}
current.l = ptrace(PTRACE_PEEKTEXT, pid, sbp->addr + i * sizeof(long), 0);
debug(2, "current = 0x%lx, orig_value = 0x%lx, thumb_mode = %d", current.l, orig.l, sbp->thumb_mode);
for (j = 0; j < sizeof(long) && i * sizeof(long) + j < BREAKPOINT_LENGTH; j++) {
sbp->orig_value[i * sizeof(long) + j] = bytes[j];
if (!sbp->thumb_mode) {
bytes[j] = break_insn[i * sizeof(long) + j];
}
else if (j < THUMB_BREAKPOINT_LENGTH) {
bytes[j] = thumb_break_insn[i * sizeof(long) + j];
}
}
ptrace(PTRACE_POKETEXT, pid, sbp->addr + i * sizeof(long), current.l);
}
}
void
arch_disable_breakpoint(pid_t pid, const struct breakpoint *sbp)
{
unsigned int i, j;
debug(1, "arch_disable_breakpoint(%d,%p)", pid, sbp->addr);
for (i = 0; i < 1 + ((BREAKPOINT_LENGTH - 1) / sizeof(long)); i++) {
union _ { long l; unsigned char b[SIZEOF_LONG]; };
union _ orig, current;
unsigned char *bytes = current.b;
for (j = 0; j < sizeof(long); j++) {
orig.b[j] = sbp->orig_value[i * sizeof(long) + j];
}
current.l = ptrace(PTRACE_PEEKTEXT, pid, sbp->addr + i * sizeof(long), 0);
debug(2, "current = 0x%lx, orig_value = 0x%lx, thumb_mode = %d", current.l, orig.l, sbp->thumb_mode);
for (j = 0; j < sizeof(long) && i * sizeof(long) + j < BREAKPOINT_LENGTH; j++) {
bytes[j] = sbp->orig_value[i * sizeof(long) + j];
}
ptrace(PTRACE_POKETEXT, pid, sbp->addr + i * sizeof(long), current.l);
}
}
int
arch_breakpoint_init(struct Process *proc, struct breakpoint *sbp)
{
int thumb_mode = (int)addr & 1;
if (thumb_mode)
addr = (void *)((int)addr & ~1);
sbp->arch.thumb_mode = thumb_mode | proc->thumb_mode;
proc->thumb_mode = 0;
return 0;
}
|