//////////////////////////////////////// Utility Functions
+#undef DEBUG
+#ifdef DEBUG
+# define D(x) x
+#else
+# define D(x)
+#endif // DEBUG
+
+const int debug_gdbserver = 0;
+
void die(const char* msg)
{
fprintf(stderr, "gdbserver code died: %s\n", msg);
gs.mstatus = ((uint64_t) gs.read_debug_ram(3) << 32) | gs.read_debug_ram(2);
gs.write_debug_ram(0, csrr(S0, CSR_DCSR));
gs.write_debug_ram(1, sd(S0, 0, (uint16_t) DEBUG_RAM_START + 16));
- gs.write_debug_ram(2, jal(0, (uint32_t) (DEBUG_ROM_RESUME - (DEBUG_RAM_START + 4*6))));
+ gs.write_debug_ram(2, jal(0, (uint32_t) (DEBUG_ROM_RESUME - (DEBUG_RAM_START + 4*2))));
gs.set_interrupt(0);
return false;
for (unsigned int i = 0; i < access_size; i++) {
if (data) {
*(data++) = value & 0xff;
- fprintf(stderr, "%02x", (unsigned int) (value & 0xff));
+ D(fprintf(stderr, "%02x", (unsigned int) (value & 0xff)));
} else {
sprintf(buffer, "%02x", (unsigned int) (value & 0xff));
gs.send(buffer);
}
value >>= 8;
}
- if (data)
- fprintf(stderr, "\n");
+ if (data && debug_gdbserver) {
+ D(fprintf(stderr, "\n"));
+ }
length -= access_size;
paddr += access_size;
if (step == 0) {
access_size = find_access_size(paddr, length);
- fprintf(stderr, "write to 0x%lx -> 0x%lx (access=%d): ", vaddr, paddr,
- access_size);
- for (unsigned int i = 0; i < length; i++)
- fprintf(stderr, "%02x", data[i]);
- fprintf(stderr, "\n");
+ D(fprintf(stderr, "write to 0x%lx -> 0x%lx (access=%d): ", vaddr, paddr,
+ access_size));
+ for (unsigned int i = 0; i < length; i++) {
+ D(fprintf(stderr, "%02x", data[i]));
+ }
+ D(fprintf(stderr, "\n"));
// address goes in S0
gs.write_debug_ram(0, ld(S0, 0, (uint16_t) DEBUG_RAM_START + 16));
case STATE_READ_PTE:
gs.pte_cache[pte_addr] = ((uint64_t) gs.read_debug_ram(5) << 32) |
gs.read_debug_ram(4);
- fprintf(stderr, "pte_cache[0x%lx] = 0x%lx\n", pte_addr, gs.pte_cache[pte_addr]);
+ D(fprintf(stderr, "pte_cache[0x%lx] = 0x%lx\n", pte_addr, gs.pte_cache[pte_addr]));
break;
}
reg_t vpn = vaddr >> PGSHIFT;
reg_t paddr = (ppn | (vpn & ((reg_t(1) << ptshift) - 1))) << PGSHIFT;
paddr += vaddr & (PGSIZE-1);
- fprintf(stderr, "gdbserver translate 0x%lx -> 0x%lx\n", vaddr, paddr);
+ D(fprintf(stderr, "gdbserver translate 0x%lx -> 0x%lx\n", vaddr, paddr));
return paddr;
}
}
// Client can't take any more data right now.
break;
} else {
- fprintf(stderr, "wrote %ld bytes: ", bytes);
+ D(fprintf(stderr, "wrote %ld bytes: ", bytes));
for (unsigned int i = 0; i < bytes; i++) {
- fprintf(stderr, "%c", send_buf[i]);
+ D(fprintf(stderr, "%c", send_buf[i]));
}
- fprintf(stderr, "\n");
+ D(fprintf(stderr, "\n"));
send_buf.consume(bytes);
}
}
}
if (packet.empty() && b == 3) {
- fprintf(stderr, "Received interrupt\n");
+ D(fprintf(stderr, "Received interrupt\n"));
recv_buf.consume(1);
handle_interrupt();
break;
return end_packet();
}
- fprintf(stderr, "Unsupported query %s\n", name.c_str());
+ D(fprintf(stderr, "Unsupported query %s\n", name.c_str()));
return send_packet("");
}
return;
}
- fprintf(stderr, "Received %ld-byte packet from debug client: ", packet.size());
- print_packet(packet);
+ D(fprintf(stderr, "Received %ld-byte packet from debug client: ", packet.size()));
+ D(print_packet(packet));
send("+");
switch (packet[1]) {
}
// Not supported.
- fprintf(stderr, "** Unsupported packet: ");
- print_packet(packet);
+ D(fprintf(stderr, "** Unsupported packet: "));
+ D(print_packet(packet));
send_packet("");
}