|
|
|
@ -60,6 +60,59 @@ const u32 R15_REGISTER = 15; |
|
|
|
const u32 CPSR_REGISTER = 25; |
|
|
|
const u32 FPSCR_REGISTER = 58; |
|
|
|
|
|
|
|
// For sample XML files see the GDB source /gdb/features
|
|
|
|
// GDB also wants the l character at the start
|
|
|
|
// This XML defines what the registers are for this specific ARM device
|
|
|
|
static const char* target_xml = |
|
|
|
R"(l<?xml version="1.0"?> |
|
|
|
<!DOCTYPE target SYSTEM "gdb-target.dtd"> |
|
|
|
<target version="1.0"> |
|
|
|
<feature name="org.gnu.gdb.arm.core"> |
|
|
|
<reg name="r0" bitsize="32"/> |
|
|
|
<reg name="r1" bitsize="32"/> |
|
|
|
<reg name="r2" bitsize="32"/> |
|
|
|
<reg name="r3" bitsize="32"/> |
|
|
|
<reg name="r4" bitsize="32"/> |
|
|
|
<reg name="r5" bitsize="32"/> |
|
|
|
<reg name="r6" bitsize="32"/> |
|
|
|
<reg name="r7" bitsize="32"/> |
|
|
|
<reg name="r8" bitsize="32"/> |
|
|
|
<reg name="r9" bitsize="32"/> |
|
|
|
<reg name="r10" bitsize="32"/> |
|
|
|
<reg name="r11" bitsize="32"/> |
|
|
|
<reg name="r12" bitsize="32"/> |
|
|
|
<reg name="sp" bitsize="32" type="data_ptr"/> |
|
|
|
<reg name="lr" bitsize="32"/> |
|
|
|
<reg name="pc" bitsize="32" type="code_ptr"/> |
|
|
|
|
|
|
|
<!-- The CPSR is register 25, rather than register 16, because |
|
|
|
the FPA registers historically were placed between the PC |
|
|
|
and the CPSR in the "g" packet. --> |
|
|
|
|
|
|
|
<reg name="cpsr" bitsize="32" regnum="25"/> |
|
|
|
</feature> |
|
|
|
<feature name="org.gnu.gdb.arm.vfp"> |
|
|
|
<reg name="d0" bitsize="64" type="float"/> |
|
|
|
<reg name="d1" bitsize="64" type="float"/> |
|
|
|
<reg name="d2" bitsize="64" type="float"/> |
|
|
|
<reg name="d3" bitsize="64" type="float"/> |
|
|
|
<reg name="d4" bitsize="64" type="float"/> |
|
|
|
<reg name="d5" bitsize="64" type="float"/> |
|
|
|
<reg name="d6" bitsize="64" type="float"/> |
|
|
|
<reg name="d7" bitsize="64" type="float"/> |
|
|
|
<reg name="d8" bitsize="64" type="float"/> |
|
|
|
<reg name="d9" bitsize="64" type="float"/> |
|
|
|
<reg name="d10" bitsize="64" type="float"/> |
|
|
|
<reg name="d11" bitsize="64" type="float"/> |
|
|
|
<reg name="d12" bitsize="64" type="float"/> |
|
|
|
<reg name="d13" bitsize="64" type="float"/> |
|
|
|
<reg name="d14" bitsize="64" type="float"/> |
|
|
|
<reg name="d15" bitsize="64" type="float"/> |
|
|
|
<reg name="fpscr" bitsize="32" type="int" group="float"/> |
|
|
|
</feature> |
|
|
|
</target> |
|
|
|
)"; |
|
|
|
|
|
|
|
namespace GDBStub { |
|
|
|
|
|
|
|
static int gdbserver_socket = -1; |
|
|
|
@ -211,7 +264,7 @@ static u8 ReadByte() { |
|
|
|
} |
|
|
|
|
|
|
|
/// Calculate the checksum of the current command buffer.
|
|
|
|
static u8 CalculateChecksum(u8 *buffer, u32 length) { |
|
|
|
static u8 CalculateChecksum(u8* buffer, u32 length) { |
|
|
|
return static_cast<u8>(std::accumulate(buffer, buffer + length, 0, std::plus<u8>())); |
|
|
|
} |
|
|
|
|
|
|
|
@ -353,8 +406,15 @@ static void SendReply(const char* reply) { |
|
|
|
static void HandleQuery() { |
|
|
|
LOG_DEBUG(Debug_GDBStub, "gdb: query '%s'\n", command_buffer + 1); |
|
|
|
|
|
|
|
if (!strcmp(reinterpret_cast<const char*>(command_buffer + 1), "TStatus")) { |
|
|
|
const char* query = reinterpret_cast<const char*>(command_buffer + 1); |
|
|
|
|
|
|
|
if (strcmp(query, "TStatus") == 0 ) { |
|
|
|
SendReply("T0"); |
|
|
|
} else if (strncmp(query, "Supported:", strlen("Supported:")) == 0) { |
|
|
|
// PacketSize needs to be large enough for target xml
|
|
|
|
SendReply("PacketSize=800;qXfer:features:read+"); |
|
|
|
} else if (strncmp(query, "Xfer:features:read:target.xml:", strlen("Xfer:features:read:target.xml:")) == 0) { |
|
|
|
SendReply(target_xml); |
|
|
|
} else { |
|
|
|
SendReply(""); |
|
|
|
} |
|
|
|
@ -491,29 +551,25 @@ static void ReadRegisters() { |
|
|
|
memset(buffer, 0, sizeof(buffer)); |
|
|
|
|
|
|
|
u8* bufptr = buffer; |
|
|
|
for (int i = 0, reg = 0; reg <= FPSCR_REGISTER; i++, reg++) { |
|
|
|
if (reg <= R15_REGISTER) { |
|
|
|
IntToGdbHex(bufptr + i * CHAR_BIT, Core::g_app_core->GetReg(reg)); |
|
|
|
} else if (reg == CPSR_REGISTER) { |
|
|
|
IntToGdbHex(bufptr + i * CHAR_BIT, Core::g_app_core->GetCPSR()); |
|
|
|
} else if (reg == CPSR_REGISTER - 1) { |
|
|
|
// Dummy FPA register, ignore
|
|
|
|
IntToGdbHex(bufptr + i * CHAR_BIT, 0); |
|
|
|
} else if (reg < CPSR_REGISTER) { |
|
|
|
// Dummy FPA registers, ignore
|
|
|
|
IntToGdbHex(bufptr + i * CHAR_BIT, 0); |
|
|
|
IntToGdbHex(bufptr + (i + 1) * CHAR_BIT, 0); |
|
|
|
IntToGdbHex(bufptr + (i + 2) * CHAR_BIT, 0); |
|
|
|
i += 2; |
|
|
|
} else if (reg > CPSR_REGISTER && reg < FPSCR_REGISTER) { |
|
|
|
IntToGdbHex(bufptr + i * CHAR_BIT, Core::g_app_core->GetVFPReg(reg - CPSR_REGISTER - 1)); |
|
|
|
IntToGdbHex(bufptr + (i + 1) * CHAR_BIT, 0); |
|
|
|
i++; |
|
|
|
} else if (reg == FPSCR_REGISTER) { |
|
|
|
IntToGdbHex(bufptr + i * CHAR_BIT, Core::g_app_core->GetVFPSystemReg(VFP_FPSCR)); |
|
|
|
|
|
|
|
for (int reg = 0; reg <= R15_REGISTER; reg++) { |
|
|
|
IntToGdbHex(bufptr + reg * CHAR_BIT, Core::g_app_core->GetReg(reg)); |
|
|
|
} |
|
|
|
|
|
|
|
bufptr += (16 * CHAR_BIT); |
|
|
|
|
|
|
|
IntToGdbHex(bufptr, Core::g_app_core->GetCPSR()); |
|
|
|
|
|
|
|
bufptr += CHAR_BIT; |
|
|
|
|
|
|
|
for (int reg = 0; reg <= 31; reg++) { |
|
|
|
IntToGdbHex(bufptr + reg * CHAR_BIT, Core::g_app_core->GetVFPReg(reg)); |
|
|
|
} |
|
|
|
|
|
|
|
bufptr += (32 * CHAR_BIT); |
|
|
|
|
|
|
|
IntToGdbHex(bufptr, Core::g_app_core->GetVFPSystemReg(VFP_FPSCR)); |
|
|
|
|
|
|
|
SendReply(reinterpret_cast<char*>(buffer)); |
|
|
|
} |
|
|
|
|
|
|
|
@ -885,6 +941,12 @@ void Init(u16 port) { |
|
|
|
LOG_ERROR(Debug_GDBStub, "Failed to create gdb socket"); |
|
|
|
} |
|
|
|
|
|
|
|
// Set socket to SO_REUSEADDR so it can always bind on the same port
|
|
|
|
int reuse_enabled = 1; |
|
|
|
if (setsockopt(tmpsock, SOL_SOCKET, SO_REUSEADDR, (const char*)&reuse_enabled, sizeof(reuse_enabled)) < 0) { |
|
|
|
LOG_ERROR(Debug_GDBStub, "Failed to set gdb socket option"); |
|
|
|
} |
|
|
|
|
|
|
|
const sockaddr* server_addr = reinterpret_cast<const sockaddr*>(&saddr_server); |
|
|
|
socklen_t server_addrlen = sizeof(saddr_server); |
|
|
|
if (bind(tmpsock, server_addr, server_addrlen) < 0) { |
|
|
|
|