|
|
@@ -20,18 +20,18 @@
|
|
|
#include <iphlpapi.h>
|
|
|
#define SHUT_RDWR 2
|
|
|
#else
|
|
|
+#include <unistd.h>
|
|
|
#include <sys/select.h>
|
|
|
#include <sys/socket.h>
|
|
|
#include <sys/un.h>
|
|
|
#include <netinet/in.h>
|
|
|
-#include <unistd.h>
|
|
|
#endif
|
|
|
|
|
|
#include "common/logging/log.h"
|
|
|
#include "common/string_util.h"
|
|
|
-#include <core/arm/arm_interface.h>
|
|
|
#include "core/core.h"
|
|
|
#include "core/memory.h"
|
|
|
+#include "core/arm/arm_interface.h"
|
|
|
#include "gdbstub.h"
|
|
|
|
|
|
const int GDB_BUFFER_SIZE = 10000;
|
|
|
@@ -67,8 +67,7 @@ static u8 command_buffer[GDB_BUFFER_SIZE];
|
|
|
static u32 command_length;
|
|
|
|
|
|
static u32 latest_signal = 0;
|
|
|
-static u32 send_signal = 0;
|
|
|
-static u32 step_break = 0;
|
|
|
+static bool step_break = false;
|
|
|
static bool memory_break = false;
|
|
|
|
|
|
// Binding to a port within the reserved ports range (0-1023) requires root permissions,
|
|
|
@@ -356,33 +355,21 @@ static void HandleSetThread() {
|
|
|
SendReply("E01");
|
|
|
}
|
|
|
|
|
|
-/// Create and send signal packet.
|
|
|
-static void HandleSignal() {
|
|
|
- std::string buffer = Common::StringFromFormat("T%02x%02x:%08x;%02x:%08x;", latest_signal, 15, htonl(Core::g_app_core->GetPC()), 13, htonl(Core::g_app_core->GetReg(13)));
|
|
|
-
|
|
|
- LOG_DEBUG(Debug_GDBStub, "Response: %s", buffer.c_str());
|
|
|
-
|
|
|
- SendReply(buffer.c_str());
|
|
|
-}
|
|
|
-
|
|
|
/**
|
|
|
- * Set signal and send packet to client through HandleSignal if signal flag is set using SendSignal.
|
|
|
+ * Send signal packet to client.
|
|
|
*
|
|
|
* @param signal Signal to be sent to client.
|
|
|
*/
|
|
|
-int SendSignal(u32 signal) {
|
|
|
+void SendSignal(u32 signal) {
|
|
|
if (gdbserver_socket == -1) {
|
|
|
- return 1;
|
|
|
+ return;
|
|
|
}
|
|
|
|
|
|
latest_signal = signal;
|
|
|
|
|
|
- if (send_signal) {
|
|
|
- HandleSignal();
|
|
|
- send_signal = 0;
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
+ std::string buffer = Common::StringFromFormat("T%02x%02x:%08x;%02x:%08x;", latest_signal, 15, htonl(Core::g_app_core->GetPC()), 13, htonl(Core::g_app_core->GetReg(13)));
|
|
|
+ LOG_DEBUG(Debug_GDBStub, "Response: %s", buffer.c_str());
|
|
|
+ SendReply(buffer.c_str());
|
|
|
}
|
|
|
|
|
|
/// Read command from gdb client.
|
|
|
@@ -397,7 +384,6 @@ static void ReadCommand() {
|
|
|
} else if (c == 0x03) {
|
|
|
LOG_INFO(Debug_GDBStub, "gdb: found break command\n");
|
|
|
halt_loop = true;
|
|
|
- send_signal = 1;
|
|
|
SendSignal(SIGTRAP);
|
|
|
return;
|
|
|
} else if (c != GDB_STUB_START) {
|
|
|
@@ -566,17 +552,14 @@ static void WriteRegisters() {
|
|
|
static void ReadMemory() {
|
|
|
static u8 reply[GDB_BUFFER_SIZE - 4];
|
|
|
|
|
|
- int i = 1;
|
|
|
+ auto start_offset = command_buffer+1;
|
|
|
+ auto addr_pos = std::find(start_offset, command_buffer+command_length, ',');
|
|
|
PAddr addr = 0;
|
|
|
- while (command_buffer[i] != ',') {
|
|
|
- addr = (addr << 4) | HexCharToValue(command_buffer[i++]);
|
|
|
- }
|
|
|
- i++;
|
|
|
+ HexToMem((u8*)&addr, start_offset, (addr_pos - start_offset) / 2);
|
|
|
|
|
|
+ start_offset = addr_pos+1;
|
|
|
u32 len = 0;
|
|
|
- while (i < command_length) {
|
|
|
- len = (len << 4) | HexCharToValue(command_buffer[i++]);
|
|
|
- }
|
|
|
+ HexToMem((u8*)&len, start_offset, ((command_buffer + command_length) - start_offset) / 2);
|
|
|
|
|
|
if (len * 2 > sizeof(reply)) {
|
|
|
SendReply("E01");
|
|
|
@@ -594,31 +577,28 @@ static void ReadMemory() {
|
|
|
|
|
|
/// Modify location in memory with data received from the gdb client.
|
|
|
static void WriteMemory() {
|
|
|
- int i = 1;
|
|
|
+ auto start_offset = command_buffer+1;
|
|
|
+ auto addr_pos = std::find(start_offset, command_buffer+command_length, ',');
|
|
|
PAddr addr = 0;
|
|
|
- while (command_buffer[i] != ',') {
|
|
|
- addr = (addr << 4) | HexCharToValue(command_buffer[i++]);
|
|
|
- }
|
|
|
- i++;
|
|
|
+ HexToMem((u8*)&addr, start_offset, (addr_pos - start_offset) / 2);
|
|
|
|
|
|
+ start_offset = addr_pos+1;
|
|
|
+ auto len_pos = std::find(start_offset, command_buffer+command_length, ':');
|
|
|
u32 len = 0;
|
|
|
- while (command_buffer[i] != ':') {
|
|
|
- len = (len << 4) | HexCharToValue(command_buffer[i++]);
|
|
|
- }
|
|
|
+ HexToMem((u8*)&len, start_offset, (len_pos - start_offset) / 2);
|
|
|
|
|
|
u8* dst = Memory::GetPointer(addr);
|
|
|
if (!dst) {
|
|
|
return SendReply("E00");
|
|
|
}
|
|
|
|
|
|
- HexToMem(dst, command_buffer + i + 1, len);
|
|
|
+ HexToMem(dst, len_pos + 1, len);
|
|
|
SendReply("OK");
|
|
|
}
|
|
|
|
|
|
void Break(bool is_memory_break) {
|
|
|
if (!halt_loop) {
|
|
|
halt_loop = true;
|
|
|
- send_signal = 1;
|
|
|
SendSignal(SIGTRAP);
|
|
|
}
|
|
|
|
|
|
@@ -629,8 +609,7 @@ void Break(bool is_memory_break) {
|
|
|
static void Step() {
|
|
|
step_loop = true;
|
|
|
halt_loop = true;
|
|
|
- send_signal = 1;
|
|
|
- step_break = 1;
|
|
|
+ step_break = true;
|
|
|
SendSignal(SIGTRAP);
|
|
|
}
|
|
|
|
|
|
@@ -645,7 +624,7 @@ bool IsMemoryBreak() {
|
|
|
/// Tell the CPU to continue executing.
|
|
|
static void Continue() {
|
|
|
memory_break = false;
|
|
|
- step_break = 0;
|
|
|
+ step_break = false;
|
|
|
step_loop = false;
|
|
|
halt_loop = false;
|
|
|
}
|
|
|
@@ -694,17 +673,14 @@ static void AddBreakpoint() {
|
|
|
return SendReply("E01");
|
|
|
}
|
|
|
|
|
|
- int i = 3;
|
|
|
+ auto start_offset = command_buffer+3;
|
|
|
+ auto addr_pos = std::find(start_offset, command_buffer+command_length, ',');
|
|
|
PAddr addr = 0;
|
|
|
- while (command_buffer[i] != ',') {
|
|
|
- addr = addr << 4 | HexCharToValue(command_buffer[i++]);
|
|
|
- }
|
|
|
- i++;
|
|
|
+ HexToMem((u8*)&addr, start_offset, (addr_pos - start_offset) / 2);
|
|
|
|
|
|
+ start_offset = addr_pos+1;
|
|
|
u32 len = 0;
|
|
|
- while (i < command_length) {
|
|
|
- len = len << 4 | HexCharToValue(command_buffer[i++]);
|
|
|
- }
|
|
|
+ HexToMem((u8*)&len, start_offset, ((command_buffer + command_length) - start_offset) / 2);
|
|
|
|
|
|
if (type == BreakpointType::Access) {
|
|
|
// Access is made up of Read and Write types, so add both breakpoints
|
|
|
@@ -747,17 +723,14 @@ static void RemoveBreakpoint() {
|
|
|
return SendReply("E01");
|
|
|
}
|
|
|
|
|
|
- int i = 3;
|
|
|
+ auto start_offset = command_buffer+3;
|
|
|
+ auto addr_pos = std::find(start_offset, command_buffer+command_length, ',');
|
|
|
PAddr addr = 0;
|
|
|
- while (command_buffer[i] != ',') {
|
|
|
- addr = (addr << 4) | HexCharToValue(command_buffer[i++]);
|
|
|
- }
|
|
|
- i++;
|
|
|
+ HexToMem((u8*)&addr, start_offset, (addr_pos - start_offset) / 2);
|
|
|
|
|
|
+ start_offset = addr_pos+1;
|
|
|
u32 len = 0;
|
|
|
- while (i < command_length) {
|
|
|
- len = (len << 4) | HexCharToValue(command_buffer[i++]);
|
|
|
- }
|
|
|
+ HexToMem((u8*)&len, start_offset, ((command_buffer + command_length) - start_offset) / 2);
|
|
|
|
|
|
if (type == BreakpointType::Access) {
|
|
|
// Access is made up of Read and Write types, so add both breakpoints
|
|
|
@@ -795,7 +768,7 @@ void HandlePacket() {
|
|
|
HandleSetThread();
|
|
|
break;
|
|
|
case '?':
|
|
|
- HandleSignal();
|
|
|
+ SendSignal(latest_signal);
|
|
|
break;
|
|
|
case 'k':
|
|
|
Shutdown();
|