Add memory r/w support to gdbstub

This commit is contained in:
rkx1209 2018-03-30 23:28:00 +09:00
parent fdd127bcce
commit 3c66a58110
4 changed files with 76 additions and 23 deletions

View file

@ -21,8 +21,8 @@ int Interpreter::SingleStep() {
void Interpreter::Run() {
debug_print ("Running with Interpreter\n");
static uint64_t counter = 0;
//uint64_t estimate = 3413000, mx = 10000;
uint64_t estimate = 3414000, mx = 10000;
//uint64_t estimate = 3415400, mx = 1000;
uint64_t estimate = 0, mx = 3420000;
while (Cpu::GetState () == Cpu::State::Running) {
if (GdbStub::enabled) {
GdbStub::HandlePacket();

View file

@ -40,6 +40,13 @@ void ReadBytes(uint64_t gva, uint8_t *ptr, int size) {
}
}
void WriteBytes(uint64_t gva, uint8_t *ptr, int size) {
uint64_t gpa = gva;
for (int i = 0; i < size; i++) {
WriteU8 (gpa + i, ptr[i]);
}
}
uint8_t ReadU8(const uint64_t gva) {
/* XXX: Implement Page translation */
uint64_t gpa = gva;

View file

@ -32,6 +32,7 @@ static inline int FromHex(int v)
else
return 0;
}
static inline int ToHex(int v)
{
if (v < 10)
@ -40,6 +41,18 @@ static inline int ToHex(int v)
return v - 10 + 'a';
}
static void MemToHex(char *buf, const uint8_t *mem, int len)
{
char *q;
q = buf;
for(int i = 0; i < len; i++) {
int c = mem[i];
*q++ = ToHex(c >> 4);
*q++ = ToHex(c & 0xf);
}
*q = '\0';
}
static int IsQueryPacket (const char *p, const char *query, char separator)
{
unsigned int query_len = strlen(query);
@ -47,6 +60,38 @@ static int IsQueryPacket (const char *p, const char *query, char separator)
return strncmp(p, query, query_len) == 0 && (p[query_len] == '\0' || p[query_len] == separator);
}
static int TargetMemoryRW(uint64_t addr, uint8_t *buf, int len, bool is_write) {
ns_print("[%s] addr 0x%016lx(%d byte)\n", (is_write?"WRITE":"READ"), addr, len);
if ((int64_t)addr < 0) {
return -1; //FIXME: Correct validation is required
}
if (is_write) {
ARMv8::WriteBytes (addr, buf, len);
} else {
ARMv8::ReadBytes (addr, buf, len);
}
return 0;
}
static int ReadRegister (uint8_t *buf, int reg) {
if (reg < GPR_ZERO) {
*(uint64_t*)buf = X(reg);
} else {
switch(reg) {
case 31:
*(uint64_t *)buf = X(GPR_SP);
break;
case 32:
*(uint64_t *)buf = X(PC_IDX);
break;
default:
*(uint64_t *)buf = 0xdeadbeef;
break;
}
}
return sizeof(uint64_t);
}
void Init() {
struct sockaddr_in addr;
@ -57,7 +102,6 @@ void Init() {
addr.sin_family = AF_INET;
addr.sin_port = htons(1234);
addr.sin_addr.s_addr = INADDR_ANY;
addr.sin_len = sizeof(addr);
if (::bind(server_fd, (struct sockaddr *)&addr, sizeof(addr)) != 0) {
ns_abort ("bind failed");
@ -110,9 +154,10 @@ void SendPacket(uint8_t *buf, size_t len) {
}
}
void WritePacket(char *buf) {
SendPacket ((uint8_t *)buf, strlen(buf));
void WritePacket(std::string buf) {
SendPacket ((uint8_t *)buf.c_str(), buf.size());
}
static RSState HandleCommand(char *line_buf) {
const char *p;
uint32_t thread;
@ -139,15 +184,15 @@ static RSState HandleCommand(char *line_buf) {
break;
case 'g':
len = 0;
// for (addr = 0; addr < GENERAL_REG_MAX; addr++) {
// //reg_size = gdb_read_register(mem_buf + len, addr);
// len += reg_size;
// }
// memtohex(buf, mem_buf, len);
// WritePacket(buf);
break;
for (addr = 0; addr < 33; addr++) {
reg_size = ReadRegister (mem_buf + len, addr);
len += reg_size;
}
MemToHex(buf, mem_buf, len);
WritePacket(buf);
break;
case 'm':
addr = strtol(p, (char **)&p, 16);
addr = strtoul(p, (char **)&p, 16);
if (*p == ',')
p++;
len = strtol(p, NULL, 16);
@ -158,21 +203,21 @@ static RSState HandleCommand(char *line_buf) {
break;
}
// if (target_memory_rw (addr, mem_buf, len, false) != 0) {
// WritePacket ("E14");
// } else {
// //memtohex(buf, mem_buf, len);
// //WritePacket(buf);
// }
if (TargetMemoryRW (addr, mem_buf, len, false) != 0) {
WritePacket ("E14");
} else {
MemToHex(buf, mem_buf, len);
WritePacket(buf);
}
break;
case 'p':
addr = strtol(p, (char **)&p, 16);
//reg_size = gdb_read_register(mem_buf, addr);
reg_size = ReadRegister (mem_buf, addr);
if (reg_size) {
//memtohex(buf, mem_buf, reg_size);
WritePacket(buf);
MemToHex(buf, mem_buf, reg_size);
WritePacket(buf);
} else {
WritePacket("E14");
WritePacket("E14");
}
break;
case 'q':

View file

@ -11,6 +11,7 @@ uint16_t ReadU16(const uint64_t gva);
uint32_t ReadU32(const uint64_t gva);
uint64_t ReadU64(const uint64_t gva);
void ReadBytes(uint64_t gva, uint8_t *ptr, int size);
void WriteBytes(uint64_t gva, uint8_t *ptr, int size);
void WriteU8(const uint64_t gva, uint8_t value);
void WriteU16(const uint64_t gva, uint16_t value);