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
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
|
/*
* Copyright 2014 Google Inc.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation; either version 2 of
* the License, or (at your option) any later version.
*
* 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
*/
#include <gdb.h>
#include <libpayload.h>
struct gdb_state gdb_state;
static u8 reply_buf[2048];
static u8 command_buf[2048];
static struct gdb_message command = {
.buf = command_buf,
.used = 0,
.size = sizeof(command_buf),
};
static struct gdb_message reply = {
.buf = reply_buf,
.used = 0,
.size = sizeof(reply_buf),
};
void gdb_command_loop(u8 signal)
{
if (gdb_state.resumed) {
/* We were just running. Send a stop reply. */
reply.used = 0;
gdb_message_add_string(&reply, "S");
gdb_message_encode_bytes(&reply, &signal, 1);
gdb_send_reply(&reply);
}
gdb_state.signal = signal;
gdb_state.resumed = 0;
gdb_state.connected = 1;
while (1) {
int i;
gdb_get_command(&command);
reply.used = 0;
for (i = 0; i < gdb_command_count; i++) {
int clen = strlen(gdb_commands[i].str);
if (!strncmp(gdb_commands[i].str, (char *)command.buf,
MIN(clen, command.used))) {
gdb_commands[i].handler(&command, clen, &reply);
break;
}
}
/* If we're resuming, we won't send a reply until we stop. */
if (gdb_state.resumed)
return;
gdb_send_reply(&reply);
}
}
static void gdb_output_write(const void *buffer, size_t count)
{
if (!gdb_state.resumed) {
/* Must be a die_if() in GDB (or a bug), so bail out and die. */
gdb_exit(-1);
video_console_init();
puts("GDB died, redirecting its last words to the screen:\n");
console_write(buffer, count);
} else {
reply.used = 0;
reply.buf[reply.used++] = 'O';
gdb_message_encode_bytes(&reply, buffer, count);
gdb_send_reply(&reply);
}
}
static struct console_output_driver gdb_output_driver = {
.write = &gdb_output_write
};
static void gdb_init(void)
{
printf("Ready for GDB connection.\n");
gdb_transport_init();
gdb_arch_init();
console_add_output_driver(&gdb_output_driver);
}
void gdb_enter(void)
{
if (!gdb_state.connected)
gdb_init();
gdb_arch_enter();
}
void gdb_exit(s8 exit_status)
{
if (!gdb_state.connected)
return;
reply.used = 0;
gdb_message_add_string(&reply, "W");
gdb_message_encode_bytes(&reply, &exit_status, 1);
gdb_send_reply(&reply);
console_remove_output_driver(&gdb_output_write);
gdb_transport_teardown();
gdb_state.connected = 0;
printf("Detached from GDB connection.\n");
}
|
