6 #include <sys/socket.h>
17 #include "gdbserver.h"
20 #define C_EBREAK 0x9002
21 #define EBREAK 0x00100073
23 //////////////////////////////////////// Utility Functions
25 void die(const char* msg
)
27 fprintf(stderr
, "gdbserver code died: %s\n", msg
);
31 // gdb's register list is defined in riscv_gdb_reg_names gdb/riscv-tdep.c in
32 // its source tree. We must interpret the numbers the same here.
44 //////////////////////////////////////// Functions to generate RISC-V opcodes.
46 // TODO: Does this already exist somewhere?
48 // Using regnames.cc as source. The RVG Calling Convention of the 2.0 RISC-V
49 // spec says it should be 2 and 3.
52 static uint32_t bits(uint32_t value
, unsigned int hi
, unsigned int lo
) {
53 return (value
>> lo
) & ((1 << (hi
+1-lo
)) - 1);
56 static uint32_t bit(uint32_t value
, unsigned int b
) {
57 return (value
>> b
) & 1;
60 static uint32_t jal(unsigned int rd
, uint32_t imm
) {
61 return (bit(imm
, 20) << 31) |
62 (bits(imm
, 10, 1) << 21) |
63 (bit(imm
, 11) << 20) |
64 (bits(imm
, 19, 12) << 12) |
69 static uint32_t csrsi(unsigned int csr
, uint8_t imm
) {
71 (bits(imm
, 4, 0) << 15) |
75 static uint32_t csrci(unsigned int csr
, uint8_t imm
) {
77 (bits(imm
, 4, 0) << 15) |
81 static uint32_t csrr(unsigned int rd
, unsigned int csr
) {
82 return (csr
<< 20) | (rd
<< 7) | MATCH_CSRRS
;
85 static uint32_t csrw(unsigned int source
, unsigned int csr
) {
86 return (csr
<< 20) | (source
<< 15) | MATCH_CSRRW
;
89 static uint32_t sw(unsigned int src
, unsigned int base
, uint16_t offset
)
91 return (bits(offset
, 11, 5) << 25) |
94 (bits(offset
, 4, 0) << 7) |
98 static uint32_t sd(unsigned int src
, unsigned int base
, uint16_t offset
)
100 return (bits(offset
, 11, 5) << 25) |
101 (bits(src
, 4, 0) << 20) |
103 (bits(offset
, 4, 0) << 7) |
107 static uint32_t ld(unsigned int src
, unsigned int base
, uint16_t offset
)
109 return (bits(offset
, 11, 5) << 25) |
110 (bits(src
, 4, 0) << 20) |
112 (bits(offset
, 4, 0) << 7) |
116 static uint32_t fsd(unsigned int src
, unsigned int base
, uint16_t offset
)
118 return (bits(offset
, 11, 5) << 25) |
119 (bits(src
, 4, 0) << 20) |
121 (bits(offset
, 4, 0) << 7) |
125 static uint32_t addi(unsigned int dest
, unsigned int src
, uint16_t imm
)
127 return (bits(imm
, 11, 0) << 20) |
133 static uint32_t nop()
135 return addi(0, 0, 0);
138 template <typename T
>
139 unsigned int circular_buffer_t
<T
>::size() const
144 return end
+ capacity
- start
;
147 template <typename T
>
148 void circular_buffer_t
<T
>::consume(unsigned int bytes
)
150 start
= (start
+ bytes
) % capacity
;
153 template <typename T
>
154 unsigned int circular_buffer_t
<T
>::contiguous_empty_size() const
158 return capacity
- end
- 1;
160 return capacity
- end
;
162 return start
- end
- 1;
165 template <typename T
>
166 unsigned int circular_buffer_t
<T
>::contiguous_data_size() const
171 return capacity
- start
;
174 template <typename T
>
175 void circular_buffer_t
<T
>::data_added(unsigned int bytes
)
178 assert(end
<= capacity
);
183 template <typename T
>
184 void circular_buffer_t
<T
>::reset()
190 template <typename T
>
191 void circular_buffer_t
<T
>::append(const T
*src
, unsigned int count
)
193 unsigned int copy
= std::min(count
, contiguous_empty_size());
194 memcpy(contiguous_empty(), src
, copy
* sizeof(T
));
198 assert(count
< contiguous_empty_size());
199 memcpy(contiguous_empty(), src
, count
* sizeof(T
));
204 ////////////////////////////// Debug Operations
206 class halt_op_t
: public operation_t
209 halt_op_t(gdbserver_t
& gdbserver
) : operation_t(gdbserver
) {};
213 // TODO: For now we just assume the target is 64-bit.
214 gs
.write_debug_ram(0, csrsi(DCSR_ADDRESS
, DCSR_HALT_MASK
));
215 gs
.write_debug_ram(1, csrr(S0
, DPC_ADDRESS
));
216 gs
.write_debug_ram(2, sd(S0
, 0, (uint16_t) DEBUG_RAM_START
));
217 gs
.write_debug_ram(3, csrr(S0
, CSR_MBADADDR
));
218 gs
.write_debug_ram(4, sd(S0
, 0, (uint16_t) DEBUG_RAM_START
+ 8));
219 gs
.write_debug_ram(5, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*5))));
221 // We could read mcause here as well, but only on 64-bit targets. I'm
222 // trying to keep The patterns here usable for 32-bit ISAs as well. (On a
223 // 32-bit ISA 8 words are required, while the minimum Debug RAM size is 7
231 if (state
== READ_DPC
) {
232 gs
.saved_dpc
= ((uint64_t) gs
.read_debug_ram(1) << 32) | gs
.read_debug_ram(0);
233 gs
.saved_mbadaddr
= ((uint64_t) gs
.read_debug_ram(3) << 32) | gs
.read_debug_ram(2);
234 gs
.write_debug_ram(0, csrr(S0
, CSR_MCAUSE
));
235 gs
.write_debug_ram(1, sd(S0
, 0, (uint16_t) DEBUG_RAM_START
+ 16));
236 gs
.write_debug_ram(2, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*2))));
241 gs
.saved_mcause
= ((uint64_t) gs
.read_debug_ram(1) << 32) | gs
.read_debug_ram(0);
253 class continue_op_t
: public operation_t
256 continue_op_t(gdbserver_t
& gdbserver
) : operation_t(gdbserver
) {};
260 gs
.write_debug_ram(0, ld(S0
, 0, (uint16_t) DEBUG_RAM_START
+16));
261 gs
.write_debug_ram(1, csrw(S0
, DPC_ADDRESS
));
262 gs
.write_debug_ram(2, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*2))));
263 gs
.write_debug_ram(4, gs
.saved_dpc
);
264 gs
.write_debug_ram(5, gs
.saved_dpc
>> 32);
272 if (state
== WRITE_DPC
) {
273 gs
.write_debug_ram(0, ld(S0
, 0, (uint16_t) DEBUG_RAM_START
+16));
274 gs
.write_debug_ram(1, csrw(S0
, CSR_MBADADDR
));
275 gs
.write_debug_ram(2, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*2))));
276 gs
.write_debug_ram(4, gs
.saved_mbadaddr
);
277 gs
.write_debug_ram(5, gs
.saved_mbadaddr
>> 32);
279 state
= WRITE_MBADADDR
;
282 gs
.write_debug_ram(0, ld(S0
, 0, (uint16_t) DEBUG_RAM_START
+16));
283 gs
.write_debug_ram(1, csrw(S0
, CSR_MCAUSE
));
284 gs
.write_debug_ram(2, csrci(DCSR_ADDRESS
, DCSR_HALT_MASK
));
285 gs
.write_debug_ram(3, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*3))));
286 gs
.write_debug_ram(4, gs
.saved_mcause
);
287 gs
.write_debug_ram(5, gs
.saved_mcause
>> 32);
300 class general_registers_read_op_t
: public operation_t
302 // Register order that gdb expects is:
303 // "x0", "x1", "x2", "x3", "x4", "x5", "x6", "x7",
304 // "x8", "x9", "x10", "x11", "x12", "x13", "x14", "x15",
305 // "x16", "x17", "x18", "x19", "x20", "x21", "x22", "x23",
306 // "x24", "x25", "x26", "x27", "x28", "x29", "x30", "x31",
308 // Each byte of register data is described by two hex digits. The bytes with
309 // the register are transmitted in target byte order. The size of each
310 // register and their position within the ‘g’ packet are determined by the
311 // gdb internal gdbarch functions DEPRECATED_REGISTER_RAW_SIZE and
312 // gdbarch_register_name.
315 general_registers_read_op_t(gdbserver_t
& gdbserver
) :
316 operation_t(gdbserver
), current_reg(0) {};
322 // x0 is always zero.
325 gs
.write_debug_ram(0, sd(1, 0, (uint16_t) DEBUG_RAM_START
+ 16));
326 gs
.write_debug_ram(1, sd(2, 0, (uint16_t) DEBUG_RAM_START
+ 0));
327 gs
.write_debug_ram(2, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*2))));
335 fprintf(stderr
, "step %d\n", current_reg
);
336 gs
.send(((uint64_t) gs
.read_debug_ram(5) << 32) | gs
.read_debug_ram(4));
337 if (current_reg
>= 31) {
342 gs
.send(((uint64_t) gs
.read_debug_ram(1) << 32) | gs
.read_debug_ram(0));
345 // TODO properly read s0 and s1
346 gs
.write_debug_ram(0, sd(current_reg
, 0, (uint16_t) DEBUG_RAM_START
+ 16));
347 gs
.write_debug_ram(1, sd(current_reg
+1, 0, (uint16_t) DEBUG_RAM_START
+ 0));
348 gs
.write_debug_ram(2, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*2))));
355 unsigned int current_reg
;
358 class register_read_op_t
: public operation_t
361 register_read_op_t(gdbserver_t
& gdbserver
, unsigned int reg
) :
362 operation_t(gdbserver
), reg(reg
) {};
366 if (reg
>= REG_XPR0
&& reg
<= REG_XPR31
) {
367 die("handle_register_read");
368 // send(p->state.XPR[reg - REG_XPR0]);
369 } else if (reg
== REG_PC
) {
371 gs
.send(gs
.saved_dpc
);
374 } else if (reg
>= REG_FPR0
&& reg
<= REG_FPR31
) {
375 // send(p->state.FPR[reg - REG_FPR0]);
376 gs
.write_debug_ram(0, fsd(reg
- REG_FPR0
, 0, (uint16_t) DEBUG_RAM_START
+ 16));
377 gs
.write_debug_ram(1, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*1))));
378 } else if (reg
== REG_CSR0
+ CSR_MBADADDR
) {
380 gs
.send(gs
.saved_mbadaddr
);
383 } else if (reg
== REG_CSR0
+ CSR_MCAUSE
) {
385 gs
.send(gs
.saved_mcause
);
388 } else if (reg
>= REG_CSR0
&& reg
<= REG_CSR4095
) {
389 gs
.write_debug_ram(0, csrr(S0
, reg
- REG_CSR0
));
390 gs
.write_debug_ram(1, sd(S0
, 0, (uint16_t) DEBUG_RAM_START
+ 16));
391 gs
.write_debug_ram(2, jal(0, (uint32_t) (DEBUG_ROM_RESUME
- (DEBUG_RAM_START
+ 4*2))));
392 // If we hit an exception reading the CSR, we'll end up returning ~0 as
393 // the register's value, which is what we want. (Right?)
394 gs
.write_debug_ram(4, 0xffffffff);
395 gs
.write_debug_ram(5, 0xffffffff);
397 gs
.send_packet("E02");
409 gs
.send(((uint64_t) gs
.read_debug_ram(5) << 32) | gs
.read_debug_ram(4));
418 ////////////////////////////// gdbserver itself
420 gdbserver_t::gdbserver_t(uint16_t port
, sim_t
*sim
) :
423 recv_buf(64 * 1024), send_buf(64 * 1024),
426 socket_fd
= socket(AF_INET
, SOCK_STREAM
, 0);
427 if (socket_fd
== -1) {
428 fprintf(stderr
, "failed to make socket: %s (%d)\n", strerror(errno
), errno
);
432 fcntl(socket_fd
, F_SETFL
, O_NONBLOCK
);
434 if (setsockopt(socket_fd
, SOL_SOCKET
, SO_REUSEADDR
, &reuseaddr
,
435 sizeof(int)) == -1) {
436 fprintf(stderr
, "failed setsockopt: %s (%d)\n", strerror(errno
), errno
);
440 struct sockaddr_in addr
;
441 memset(&addr
, 0, sizeof(addr
));
442 addr
.sin_family
= AF_INET
;
443 addr
.sin_addr
.s_addr
= INADDR_ANY
;
444 addr
.sin_port
= htons(port
);
446 if (bind(socket_fd
, (struct sockaddr
*) &addr
, sizeof(addr
)) == -1) {
447 fprintf(stderr
, "failed to bind socket: %s (%d)\n", strerror(errno
), errno
);
451 if (listen(socket_fd
, 1) == -1) {
452 fprintf(stderr
, "failed to listen on socket: %s (%d)\n", strerror(errno
), errno
);
457 void gdbserver_t::write_debug_ram(unsigned int index
, uint32_t value
)
459 sim
->debug_module
.ram_write32(index
, value
);
462 uint32_t gdbserver_t::read_debug_ram(unsigned int index
)
464 return sim
->debug_module
.ram_read32(index
);
467 void gdbserver_t::set_operation(operation_t
* operation
)
469 assert(this->operation
== NULL
|| operation
== NULL
);
470 if (operation
&& operation
->start()) {
473 this->operation
= operation
;
477 void gdbserver_t::accept()
479 client_fd
= ::accept(socket_fd
, NULL
, NULL
);
480 if (client_fd
== -1) {
481 if (errno
== EAGAIN
) {
482 // No client waiting to connect right now.
484 fprintf(stderr
, "failed to accept on socket: %s (%d)\n", strerror(errno
),
489 fcntl(client_fd
, F_SETFL
, O_NONBLOCK
);
492 extended_mode
= false;
494 // gdb wants the core to be halted when it attaches.
495 set_operation(new halt_op_t(*this));
499 void gdbserver_t::read()
501 // Reading from a non-blocking socket still blocks if there is no data
504 size_t count
= recv_buf
.contiguous_empty_size();
506 ssize_t bytes
= ::read(client_fd
, recv_buf
.contiguous_empty(), count
);
508 if (errno
== EAGAIN
) {
509 // We'll try again the next call.
511 fprintf(stderr
, "failed to read on socket: %s (%d)\n", strerror(errno
), errno
);
514 } else if (bytes
== 0) {
515 // The remote disconnected.
517 processor_t
*p
= sim
->get_core(0);
518 // TODO p->set_halted(false, HR_NONE);
522 recv_buf
.data_added(bytes
);
526 void gdbserver_t::write()
528 if (send_buf
.empty())
531 while (!send_buf
.empty()) {
532 unsigned int count
= send_buf
.contiguous_data_size();
534 ssize_t bytes
= ::write(client_fd
, send_buf
.contiguous_data(), count
);
536 fprintf(stderr
, "failed to write to socket: %s (%d)\n", strerror(errno
), errno
);
538 } else if (bytes
== 0) {
539 // Client can't take any more data right now.
542 fprintf(stderr
, "wrote %ld bytes: ", bytes
);
543 for (unsigned int i
= 0; i
< bytes
; i
++) {
544 fprintf(stderr
, "%c", send_buf
[i
]);
546 fprintf(stderr
, "\n");
547 send_buf
.consume(bytes
);
552 void print_packet(const std::vector
<uint8_t> &packet
)
554 for (uint8_t c
: packet
) {
555 if (c
>= ' ' and c
<= '~')
556 fprintf(stderr
, "%c", c
);
558 fprintf(stderr
, "\\x%x", c
);
560 fprintf(stderr
, "\n");
563 uint8_t compute_checksum(const std::vector
<uint8_t> &packet
)
565 uint8_t checksum
= 0;
566 for (auto i
= packet
.begin() + 1; i
!= packet
.end() - 3; i
++ ) {
572 uint8_t character_hex_value(uint8_t character
)
574 if (character
>= '0' && character
<= '9')
575 return character
- '0';
576 if (character
>= 'a' && character
<= 'f')
577 return 10 + character
- 'a';
578 if (character
>= 'A' && character
<= 'F')
579 return 10 + character
- 'A';
583 uint8_t extract_checksum(const std::vector
<uint8_t> &packet
)
585 return character_hex_value(*(packet
.end() - 1)) +
586 16 * character_hex_value(*(packet
.end() - 2));
589 void gdbserver_t::process_requests()
591 // See https://sourceware.org/gdb/onlinedocs/gdb/Remote-Protocol.html
593 while (!recv_buf
.empty()) {
594 std::vector
<uint8_t> packet
;
595 for (unsigned int i
= 0; i
< recv_buf
.size(); i
++) {
596 uint8_t b
= recv_buf
[i
];
598 if (packet
.empty() && expect_ack
&& b
== '+') {
603 if (packet
.empty() && b
== 3) {
604 fprintf(stderr
, "Received interrupt\n");
611 // Start of new packet.
612 if (!packet
.empty()) {
613 fprintf(stderr
, "Received malformed %ld-byte packet from debug client: ",
615 print_packet(packet
);
623 // Packets consist of $<packet-data>#<checksum>
624 // where <checksum> is
625 if (packet
.size() >= 4 &&
626 packet
[packet
.size()-3] == '#') {
627 handle_packet(packet
);
628 recv_buf
.consume(i
+1);
632 // There's a partial packet in the buffer. Wait until we get more data to
640 void gdbserver_t::handle_halt_reason(const std::vector
<uint8_t> &packet
)
645 void gdbserver_t::handle_general_registers_read(const std::vector
<uint8_t> &packet
)
647 set_operation(new general_registers_read_op_t(*this));
650 void gdbserver_t::set_interrupt(uint32_t hartid
) {
651 sim
->debug_module
.set_interrupt(hartid
);
654 // First byte is the most-significant one.
655 // Eg. "08675309" becomes 0x08675309.
656 uint64_t consume_hex_number(std::vector
<uint8_t>::const_iterator
&iter
,
657 std::vector
<uint8_t>::const_iterator end
)
661 while (iter
!= end
) {
663 uint64_t c_value
= character_hex_value(c
);
673 // First byte is the least-significant one.
674 // Eg. "08675309" becomes 0x09536708
675 uint64_t consume_hex_number_le(std::vector
<uint8_t>::const_iterator
&iter
,
676 std::vector
<uint8_t>::const_iterator end
)
679 unsigned int shift
= 4;
681 while (iter
!= end
) {
683 uint64_t c_value
= character_hex_value(c
);
687 value
|= c_value
<< shift
;
688 if ((shift
% 8) == 0)
696 void consume_string(std::string
&str
, std::vector
<uint8_t>::const_iterator
&iter
,
697 std::vector
<uint8_t>::const_iterator end
, uint8_t separator
)
699 while (iter
!= end
&& *iter
!= separator
) {
700 str
.append(1, (char) *iter
);
705 void gdbserver_t::handle_register_read(const std::vector
<uint8_t> &packet
)
709 std::vector
<uint8_t>::const_iterator iter
= packet
.begin() + 2;
710 unsigned int n
= consume_hex_number(iter
, packet
.end());
712 return send_packet("E01");
714 set_operation(new register_read_op_t(*this, n
));
717 void gdbserver_t::handle_register_write(const std::vector
<uint8_t> &packet
)
721 std::vector
<uint8_t>::const_iterator iter
= packet
.begin() + 2;
722 unsigned int n
= consume_hex_number(iter
, packet
.end());
724 return send_packet("E05");
727 reg_t value
= consume_hex_number_le(iter
, packet
.end());
729 return send_packet("E06");
731 processor_t
*p
= sim
->get_core(0);
733 die("handle_register_write");
735 if (n >= REG_XPR0 && n <= REG_XPR31) {
736 p->state.XPR.write(n - REG_XPR0, value);
737 } else if (n == REG_PC) {
739 } else if (n >= REG_FPR0 && n <= REG_FPR31) {
740 p->state.FPR.write(n - REG_FPR0, value);
741 } else if (n >= REG_CSR0 && n <= REG_CSR4095) {
743 p->set_csr(n - REG_CSR0, value);
745 return send_packet("EFF");
748 return send_packet("E07");
752 return send_packet("OK");
755 void gdbserver_t::handle_memory_read(const std::vector
<uint8_t> &packet
)
758 std::vector
<uint8_t>::const_iterator iter
= packet
.begin() + 2;
759 reg_t address
= consume_hex_number(iter
, packet
.end());
761 return send_packet("E10");
763 reg_t length
= consume_hex_number(iter
, packet
.end());
765 return send_packet("E11");
769 processor_t
*p
= sim
->get_core(0);
770 mmu_t
* mmu
= sim
->debug_mmu
;
772 for (reg_t i
= 0; i
< length
; i
++) {
773 sprintf(buffer
, "%02x", mmu
->load_uint8(address
+ i
));
779 void gdbserver_t::handle_memory_binary_write(const std::vector
<uint8_t> &packet
)
781 // X addr,length:XX...
782 std::vector
<uint8_t>::const_iterator iter
= packet
.begin() + 2;
783 reg_t address
= consume_hex_number(iter
, packet
.end());
785 return send_packet("E20");
787 reg_t length
= consume_hex_number(iter
, packet
.end());
789 return send_packet("E21");
792 processor_t
*p
= sim
->get_core(0);
793 mmu_t
* mmu
= sim
->debug_mmu
;
794 for (unsigned int i
= 0; i
< length
; i
++) {
795 if (iter
== packet
.end()) {
796 return send_packet("E22");
798 mmu
->store_uint8(address
+ i
, *iter
);
802 return send_packet("E4b"); // EOVERFLOW
807 void gdbserver_t::handle_continue(const std::vector
<uint8_t> &packet
)
810 processor_t
*p
= sim
->get_core(0);
811 if (packet
[2] != '#') {
812 std::vector
<uint8_t>::const_iterator iter
= packet
.begin() + 2;
813 saved_dpc
= consume_hex_number(iter
, packet
.end());
815 return send_packet("E30");
818 set_operation(new continue_op_t(*this));
821 void gdbserver_t::handle_step(const std::vector
<uint8_t> &packet
)
824 if (packet
[2] != '#') {
825 std::vector
<uint8_t>::const_iterator iter
= packet
.begin() + 2;
827 //p->state.pc = consume_hex_number(iter, packet.end());
829 return send_packet("E40");
832 // TODO: p->set_single_step(true);
833 // TODO running = true;
836 void gdbserver_t::handle_kill(const std::vector
<uint8_t> &packet
)
839 // The exact effect of this packet is not specified.
840 // Looks like OpenOCD disconnects?
844 void gdbserver_t::handle_extended(const std::vector
<uint8_t> &packet
)
846 // Enable extended mode. In extended mode, the remote server is made
847 // persistent. The ‘R’ packet is used to restart the program being debugged.
849 extended_mode
= true;
852 void software_breakpoint_t::insert(mmu_t
* mmu
)
855 instruction
= mmu
->load_uint16(address
);
856 mmu
->store_uint16(address
, C_EBREAK
);
858 instruction
= mmu
->load_uint32(address
);
859 mmu
->store_uint32(address
, EBREAK
);
861 fprintf(stderr
, ">>> Read %x from %lx\n", instruction
, address
);
864 void software_breakpoint_t::remove(mmu_t
* mmu
)
866 fprintf(stderr
, ">>> write %x to %lx\n", instruction
, address
);
868 mmu
->store_uint16(address
, instruction
);
870 mmu
->store_uint32(address
, instruction
);
874 void gdbserver_t::handle_breakpoint(const std::vector
<uint8_t> &packet
)
876 // insert: Z type,addr,kind
877 // remove: z type,addr,kind
879 software_breakpoint_t bp
;
880 bool insert
= (packet
[1] == 'Z');
881 std::vector
<uint8_t>::const_iterator iter
= packet
.begin() + 2;
882 int type
= consume_hex_number(iter
, packet
.end());
884 return send_packet("E50");
886 bp
.address
= consume_hex_number(iter
, packet
.end());
888 return send_packet("E51");
890 bp
.size
= consume_hex_number(iter
, packet
.end());
891 // There may be more options after a ; here, but we don't support that.
893 return send_packet("E52");
895 if (bp
.size
!= 2 && bp
.size
!= 4) {
896 return send_packet("E53");
899 processor_t
*p
= sim
->get_core(0);
900 die("handle_breakpoint");
905 breakpoints[bp.address] = bp;
908 bp = breakpoints[bp.address];
910 breakpoints.erase(bp.address);
913 sim->debug_mmu->flush_icache();
915 return send_packet("OK");
918 void gdbserver_t::handle_query(const std::vector
<uint8_t> &packet
)
921 std::vector
<uint8_t>::const_iterator iter
= packet
.begin() + 2;
923 consume_string(name
, iter
, packet
.end(), ':');
924 if (iter
!= packet
.end())
926 if (name
== "Supported") {
928 while (iter
!= packet
.end()) {
930 consume_string(feature
, iter
, packet
.end(), ';');
931 if (iter
!= packet
.end())
933 if (feature
== "swbreak+") {
940 fprintf(stderr
, "Unsupported query %s\n", name
.c_str());
941 return send_packet("");
944 void gdbserver_t::handle_packet(const std::vector
<uint8_t> &packet
)
946 if (compute_checksum(packet
) != extract_checksum(packet
)) {
947 fprintf(stderr
, "Received %ld-byte packet with invalid checksum\n", packet
.size());
948 fprintf(stderr
, "Computed checksum: %x\n", compute_checksum(packet
));
949 print_packet(packet
);
954 fprintf(stderr
, "Received %ld-byte packet from debug client: ", packet
.size());
955 print_packet(packet
);
960 return handle_extended(packet
);
962 return handle_halt_reason(packet
);
964 return handle_general_registers_read(packet
);
966 return handle_kill(packet
);
968 return handle_memory_read(packet
);
970 // return handle_memory_write(packet);
972 return handle_memory_binary_write(packet
);
974 return handle_register_read(packet
);
976 return handle_register_write(packet
);
978 return handle_continue(packet
);
980 return handle_step(packet
);
983 return handle_breakpoint(packet
);
986 return handle_query(packet
);
990 fprintf(stderr
, "** Unsupported packet: ");
991 print_packet(packet
);
995 void gdbserver_t::handle_interrupt()
997 processor_t
*p
= sim
->get_core(0);
998 // TODO p->set_halted(true, HR_INTERRUPT);
999 send_packet("S02"); // Pretend program received SIGINT.
1000 // TODO running = false;
1003 void gdbserver_t::handle()
1005 if (client_fd
> 0) {
1006 processor_t
*p
= sim
->get_core(0);
1008 bool interrupt
= sim
->debug_module
.get_interrupt(0);
1011 if (operation
&& operation
->step()) {
1013 set_operation(NULL
);
1019 // gdb requested a halt and now it's done.
1021 fprintf(stderr, "DPC: 0x%x\n", read_debug_ram(0));
1022 fprintf(stderr, "DCSR: 0x%x\n", read_debug_ram(2));
1023 state = STATE_HALTED;
1030 if (running && p->halted) {
1031 // The core was running, but now it's halted. Better tell gdb.
1032 switch (p->halt_reason) {
1034 fprintf(stderr, "Internal error. Processor halted without reason.\n");
1040 // There's no gdb code for this.
1044 send_packet("T05swbreak:;");
1048 // TODO: Actually include register values here
1061 this->process_requests();
1065 void gdbserver_t::send(const char* msg
)
1067 unsigned int length
= strlen(msg
);
1068 for (const char *c
= msg
; *c
; c
++)
1069 running_checksum
+= *c
;
1070 send_buf
.append((const uint8_t *) msg
, length
);
1073 void gdbserver_t::send(uint64_t value
)
1076 for (unsigned int i
= 0; i
< 8; i
++) {
1077 sprintf(buffer
, "%02x", (int) (value
& 0xff));
1083 void gdbserver_t::send(uint32_t value
)
1086 for (unsigned int i
= 0; i
< 4; i
++) {
1087 sprintf(buffer
, "%02x", (int) (value
& 0xff));
1093 void gdbserver_t::send_packet(const char* data
)
1101 void gdbserver_t::start_packet()
1104 running_checksum
= 0;
1107 void gdbserver_t::end_packet(const char* data
)
1113 char checksum_string
[4];
1114 sprintf(checksum_string
, "#%02x", running_checksum
);
1115 send(checksum_string
);