Update
[gdb.git] / gdb / gdbserver / remote-utils.c
blob2e049ee22a4cb783da42f52ffc0d046b2a40bc31
1 /* Remote utility routines for the remote server for GDB.
2 Copyright (C) 1986, 1989, 1993, 1994, 1995, 1996, 1997, 1998, 1999, 2000,
3 2001, 2002, 2003, 2004, 2005, 2006, 2007, 2008
4 Free Software Foundation, Inc.
6 This file is part of GDB.
8 This program is free software; you can redistribute it and/or modify
9 it under the terms of the GNU General Public License as published by
10 the Free Software Foundation; either version 3 of the License, or
11 (at your option) any later version.
13 This program is distributed in the hope that it will be useful,
14 but WITHOUT ANY WARRANTY; without even the implied warranty of
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 GNU General Public License for more details.
18 You should have received a copy of the GNU General Public License
19 along with this program. If not, see <http://www.gnu.org/licenses/>. */
21 #include "server.h"
22 #include "terminal.h"
23 #include <stdio.h>
24 #include <string.h>
25 #if HAVE_SYS_IOCTL_H
26 #include <sys/ioctl.h>
27 #endif
28 #if HAVE_SYS_FILE_H
29 #include <sys/file.h>
30 #endif
31 #if HAVE_NETINET_IN_H
32 #include <netinet/in.h>
33 #endif
34 #if HAVE_SYS_SOCKET_H
35 #include <sys/socket.h>
36 #endif
37 #if HAVE_NETDB_H
38 #include <netdb.h>
39 #endif
40 #if HAVE_NETINET_TCP_H
41 #include <netinet/tcp.h>
42 #endif
43 #if HAVE_SYS_IOCTL_H
44 #include <sys/ioctl.h>
45 #endif
46 #if HAVE_SIGNAL_H
47 #include <signal.h>
48 #endif
49 #if HAVE_FCNTL_H
50 #include <fcntl.h>
51 #endif
52 #include <sys/time.h>
53 #if HAVE_UNISTD_H
54 #include <unistd.h>
55 #endif
56 #if HAVE_ARPA_INET_H
57 #include <arpa/inet.h>
58 #endif
59 #include <sys/stat.h>
60 #if HAVE_ERRNO_H
61 #include <errno.h>
62 #endif
64 #if USE_WIN32API
65 #include <winsock.h>
66 #endif
68 #ifndef HAVE_SOCKLEN_T
69 typedef int socklen_t;
70 #endif
72 #if USE_WIN32API
73 # define INVALID_DESCRIPTOR INVALID_SOCKET
74 #else
75 # define INVALID_DESCRIPTOR -1
76 #endif
78 /* A cache entry for a successfully looked-up symbol. */
79 struct sym_cache
81 const char *name;
82 CORE_ADDR addr;
83 struct sym_cache *next;
86 /* The symbol cache. */
87 static struct sym_cache *symbol_cache;
89 /* If this flag has been set, assume cache misses are
90 failures. */
91 int all_symbols_looked_up;
93 int remote_debug = 0;
94 struct ui_file *gdb_stdlog;
96 static int remote_desc = INVALID_DESCRIPTOR;
98 /* FIXME headerize? */
99 extern int using_threads;
100 extern int debug_threads;
102 #ifdef USE_WIN32API
103 # define read(fd, buf, len) recv (fd, (char *) buf, len, 0)
104 # define write(fd, buf, len) send (fd, (char *) buf, len, 0)
105 #endif
107 /* Open a connection to a remote debugger.
108 NAME is the filename used for communication. */
110 void
111 remote_open (char *name)
113 #if defined(F_SETFL) && defined (FASYNC)
114 int save_fcntl_flags;
115 #endif
116 char *port_str;
118 port_str = strchr (name, ':');
119 if (port_str == NULL)
121 #ifdef USE_WIN32API
122 error ("Only <host>:<port> is supported on this platform.");
123 #else
124 struct stat statbuf;
126 if (stat (name, &statbuf) == 0
127 && (S_ISCHR (statbuf.st_mode) || S_ISFIFO (statbuf.st_mode)))
128 remote_desc = open (name, O_RDWR);
129 else
131 errno = EINVAL;
132 remote_desc = -1;
135 if (remote_desc < 0)
136 perror_with_name ("Could not open remote device");
138 #ifdef HAVE_TERMIOS
140 struct termios termios;
141 tcgetattr (remote_desc, &termios);
143 termios.c_iflag = 0;
144 termios.c_oflag = 0;
145 termios.c_lflag = 0;
146 termios.c_cflag &= ~(CSIZE | PARENB);
147 termios.c_cflag |= CLOCAL | CS8;
148 termios.c_cc[VMIN] = 1;
149 termios.c_cc[VTIME] = 0;
151 tcsetattr (remote_desc, TCSANOW, &termios);
153 #endif
155 #ifdef HAVE_TERMIO
157 struct termio termio;
158 ioctl (remote_desc, TCGETA, &termio);
160 termio.c_iflag = 0;
161 termio.c_oflag = 0;
162 termio.c_lflag = 0;
163 termio.c_cflag &= ~(CSIZE | PARENB);
164 termio.c_cflag |= CLOCAL | CS8;
165 termio.c_cc[VMIN] = 1;
166 termio.c_cc[VTIME] = 0;
168 ioctl (remote_desc, TCSETA, &termio);
170 #endif
172 #ifdef HAVE_SGTTY
174 struct sgttyb sg;
176 ioctl (remote_desc, TIOCGETP, &sg);
177 sg.sg_flags = RAW;
178 ioctl (remote_desc, TIOCSETP, &sg);
180 #endif
182 fprintf (stderr, "Remote debugging using %s\n", name);
183 #endif /* USE_WIN32API */
185 else
187 #ifdef USE_WIN32API
188 static int winsock_initialized;
189 #endif
190 int port;
191 struct sockaddr_in sockaddr;
192 socklen_t tmp;
193 int tmp_desc;
194 char *port_end;
196 port = strtoul (port_str + 1, &port_end, 10);
197 if (port_str[1] == '\0' || *port_end != '\0')
198 fatal ("Bad port argument: %s", name);
200 #ifdef USE_WIN32API
201 if (!winsock_initialized)
203 WSADATA wsad;
205 WSAStartup (MAKEWORD (1, 0), &wsad);
206 winsock_initialized = 1;
208 #endif
210 tmp_desc = socket (PF_INET, SOCK_STREAM, IPPROTO_TCP);
211 if (tmp_desc < 0)
212 perror_with_name ("Can't open socket");
214 /* Allow rapid reuse of this port. */
215 tmp = 1;
216 setsockopt (tmp_desc, SOL_SOCKET, SO_REUSEADDR, (char *) &tmp,
217 sizeof (tmp));
219 sockaddr.sin_family = PF_INET;
220 sockaddr.sin_port = htons (port);
221 sockaddr.sin_addr.s_addr = INADDR_ANY;
223 if (bind (tmp_desc, (struct sockaddr *) &sockaddr, sizeof (sockaddr))
224 || listen (tmp_desc, 1))
225 perror_with_name ("Can't bind address");
227 /* If port is zero, a random port will be selected, and the
228 fprintf below needs to know what port was selected. */
229 if (port == 0)
231 socklen_t len = sizeof (sockaddr);
232 if (getsockname (tmp_desc, (struct sockaddr *) &sockaddr, &len) < 0
233 || len < sizeof (sockaddr))
234 perror_with_name ("Can't determine port");
235 port = ntohs (sockaddr.sin_port);
238 fprintf (stderr, "Listening on port %d\n", port);
239 fflush (stderr);
241 tmp = sizeof (sockaddr);
242 remote_desc = accept (tmp_desc, (struct sockaddr *) &sockaddr, &tmp);
243 if (remote_desc == -1)
244 perror_with_name ("Accept failed");
246 /* Enable TCP keep alive process. */
247 tmp = 1;
248 setsockopt (remote_desc, SOL_SOCKET, SO_KEEPALIVE,
249 (char *) &tmp, sizeof (tmp));
251 /* Tell TCP not to delay small packets. This greatly speeds up
252 interactive response. */
253 tmp = 1;
254 setsockopt (remote_desc, IPPROTO_TCP, TCP_NODELAY,
255 (char *) &tmp, sizeof (tmp));
258 #ifndef USE_WIN32API
259 close (tmp_desc); /* No longer need this */
261 signal (SIGPIPE, SIG_IGN); /* If we don't do this, then gdbserver simply
262 exits when the remote side dies. */
263 #else
264 closesocket (tmp_desc); /* No longer need this */
265 #endif
267 /* Convert IP address to string. */
268 fprintf (stderr, "Remote debugging from host %s\n",
269 inet_ntoa (sockaddr.sin_addr));
272 #if defined(F_SETFL) && defined (FASYNC)
273 save_fcntl_flags = fcntl (remote_desc, F_GETFL, 0);
274 fcntl (remote_desc, F_SETFL, save_fcntl_flags | FASYNC);
275 #if defined (F_SETOWN)
276 fcntl (remote_desc, F_SETOWN, getpid ());
277 #endif
278 #endif
281 void
282 remote_close (void)
284 #ifdef USE_WIN32API
285 closesocket (remote_desc);
286 #else
287 close (remote_desc);
288 #endif
291 /* Convert hex digit A to a number. */
293 static int
294 fromhex (int a)
296 if (a >= '0' && a <= '9')
297 return a - '0';
298 else if (a >= 'a' && a <= 'f')
299 return a - 'a' + 10;
300 else
301 error ("Reply contains invalid hex digit");
302 return 0;
306 unhexify (char *bin, const char *hex, int count)
308 int i;
310 for (i = 0; i < count; i++)
312 if (hex[0] == 0 || hex[1] == 0)
314 /* Hex string is short, or of uneven length.
315 Return the count that has been converted so far. */
316 return i;
318 *bin++ = fromhex (hex[0]) * 16 + fromhex (hex[1]);
319 hex += 2;
321 return i;
324 void
325 decode_address (CORE_ADDR *addrp, const char *start, int len)
327 CORE_ADDR addr;
328 char ch;
329 int i;
331 addr = 0;
332 for (i = 0; i < len; i++)
334 ch = start[i];
335 addr = addr << 4;
336 addr = addr | (fromhex (ch) & 0x0f);
338 *addrp = addr;
341 const char *
342 decode_address_to_semicolon (CORE_ADDR *addrp, const char *start)
344 const char *end;
346 end = start;
347 while (*end != '\0' && *end != ';')
348 end++;
350 decode_address (addrp, start, end - start);
352 if (*end == ';')
353 end++;
354 return end;
357 /* Convert number NIB to a hex digit. */
359 static int
360 tohex (int nib)
362 if (nib < 10)
363 return '0' + nib;
364 else
365 return 'a' + nib - 10;
369 hexify (char *hex, const char *bin, int count)
371 int i;
373 /* May use a length, or a nul-terminated string as input. */
374 if (count == 0)
375 count = strlen (bin);
377 for (i = 0; i < count; i++)
379 *hex++ = tohex ((*bin >> 4) & 0xf);
380 *hex++ = tohex (*bin++ & 0xf);
382 *hex = 0;
383 return i;
386 /* Convert BUFFER, binary data at least LEN bytes long, into escaped
387 binary data in OUT_BUF. Set *OUT_LEN to the length of the data
388 encoded in OUT_BUF, and return the number of bytes in OUT_BUF
389 (which may be more than *OUT_LEN due to escape characters). The
390 total number of bytes in the output buffer will be at most
391 OUT_MAXLEN. */
394 remote_escape_output (const gdb_byte *buffer, int len,
395 gdb_byte *out_buf, int *out_len,
396 int out_maxlen)
398 int input_index, output_index;
400 output_index = 0;
401 for (input_index = 0; input_index < len; input_index++)
403 gdb_byte b = buffer[input_index];
405 if (b == '$' || b == '#' || b == '}' || b == '*')
407 /* These must be escaped. */
408 if (output_index + 2 > out_maxlen)
409 break;
410 out_buf[output_index++] = '}';
411 out_buf[output_index++] = b ^ 0x20;
413 else
415 if (output_index + 1 > out_maxlen)
416 break;
417 out_buf[output_index++] = b;
421 *out_len = input_index;
422 return output_index;
425 /* Convert BUFFER, escaped data LEN bytes long, into binary data
426 in OUT_BUF. Return the number of bytes written to OUT_BUF.
427 Raise an error if the total number of bytes exceeds OUT_MAXLEN.
429 This function reverses remote_escape_output. It allows more
430 escaped characters than that function does, in particular because
431 '*' must be escaped to avoid the run-length encoding processing
432 in reading packets. */
434 static int
435 remote_unescape_input (const gdb_byte *buffer, int len,
436 gdb_byte *out_buf, int out_maxlen)
438 int input_index, output_index;
439 int escaped;
441 output_index = 0;
442 escaped = 0;
443 for (input_index = 0; input_index < len; input_index++)
445 gdb_byte b = buffer[input_index];
447 if (output_index + 1 > out_maxlen)
448 error ("Received too much data from the target.");
450 if (escaped)
452 out_buf[output_index++] = b ^ 0x20;
453 escaped = 0;
455 else if (b == '}')
456 escaped = 1;
457 else
458 out_buf[output_index++] = b;
461 if (escaped)
462 error ("Unmatched escape character in target response.");
464 return output_index;
467 /* Look for a sequence of characters which can be run-length encoded.
468 If there are any, update *CSUM and *P. Otherwise, output the
469 single character. Return the number of characters consumed. */
471 static int
472 try_rle (char *buf, int remaining, unsigned char *csum, char **p)
474 int n;
476 /* Always output the character. */
477 *csum += buf[0];
478 *(*p)++ = buf[0];
480 /* Don't go past '~'. */
481 if (remaining > 97)
482 remaining = 97;
484 for (n = 1; n < remaining; n++)
485 if (buf[n] != buf[0])
486 break;
488 /* N is the index of the first character not the same as buf[0].
489 buf[0] is counted twice, so by decrementing N, we get the number
490 of characters the RLE sequence will replace. */
491 n--;
493 if (n < 3)
494 return 1;
496 /* Skip the frame characters. The manual says to skip '+' and '-'
497 also, but there's no reason to. Unfortunately these two unusable
498 characters double the encoded length of a four byte zero
499 value. */
500 while (n + 29 == '$' || n + 29 == '#')
501 n--;
503 *csum += '*';
504 *(*p)++ = '*';
505 *csum += n + 29;
506 *(*p)++ = n + 29;
508 return n + 1;
511 /* Send a packet to the remote machine, with error checking.
512 The data of the packet is in BUF, and the length of the
513 packet is in CNT. Returns >= 0 on success, -1 otherwise. */
516 putpkt_binary (char *buf, int cnt)
518 int i;
519 unsigned char csum = 0;
520 char *buf2;
521 char buf3[1];
522 char *p;
524 buf2 = malloc (PBUFSIZ);
526 /* Copy the packet into buffer BUF2, encapsulating it
527 and giving it a checksum. */
529 p = buf2;
530 *p++ = '$';
532 for (i = 0; i < cnt;)
533 i += try_rle (buf + i, cnt - i, &csum, &p);
535 *p++ = '#';
536 *p++ = tohex ((csum >> 4) & 0xf);
537 *p++ = tohex (csum & 0xf);
539 *p = '\0';
541 /* Send it over and over until we get a positive ack. */
545 int cc;
547 if (write (remote_desc, buf2, p - buf2) != p - buf2)
549 perror ("putpkt(write)");
550 free (buf2);
551 return -1;
554 if (remote_debug)
556 fprintf (stderr, "putpkt (\"%s\"); [looking for ack]\n", buf2);
557 fflush (stderr);
559 cc = read (remote_desc, buf3, 1);
560 if (remote_debug)
562 fprintf (stderr, "[received '%c' (0x%x)]\n", buf3[0], buf3[0]);
563 fflush (stderr);
566 if (cc <= 0)
568 if (cc == 0)
569 fprintf (stderr, "putpkt(read): Got EOF\n");
570 else
571 perror ("putpkt(read)");
573 free (buf2);
574 return -1;
577 /* Check for an input interrupt while we're here. */
578 if (buf3[0] == '\003' && current_inferior != NULL)
579 (*the_target->request_interrupt) ();
581 while (buf3[0] != '+');
583 free (buf2);
584 return 1; /* Success! */
587 /* Send a packet to the remote machine, with error checking. The data
588 of the packet is in BUF, and the packet should be a NUL-terminated
589 string. Returns >= 0 on success, -1 otherwise. */
592 putpkt (char *buf)
594 return putpkt_binary (buf, strlen (buf));
597 /* Come here when we get an input interrupt from the remote side. This
598 interrupt should only be active while we are waiting for the child to do
599 something. About the only thing that should come through is a ^C, which
600 will cause us to request child interruption. */
602 static void
603 input_interrupt (int unused)
605 fd_set readset;
606 struct timeval immediate = { 0, 0 };
608 /* Protect against spurious interrupts. This has been observed to
609 be a problem under NetBSD 1.4 and 1.5. */
611 FD_ZERO (&readset);
612 FD_SET (remote_desc, &readset);
613 if (select (remote_desc + 1, &readset, 0, 0, &immediate) > 0)
615 int cc;
616 char c = 0;
618 cc = read (remote_desc, &c, 1);
620 if (cc != 1 || c != '\003' || current_inferior == NULL)
622 fprintf (stderr, "input_interrupt, count = %d c = %d ('%c')\n",
623 cc, c, c);
624 return;
627 (*the_target->request_interrupt) ();
631 /* Check if the remote side sent us an interrupt request (^C). */
632 void
633 check_remote_input_interrupt_request (void)
635 /* This function may be called before establishing communications,
636 therefore we need to validate the remote descriptor. */
638 if (remote_desc == INVALID_DESCRIPTOR)
639 return;
641 input_interrupt (0);
644 /* Asynchronous I/O support. SIGIO must be enabled when waiting, in order to
645 accept Control-C from the client, and must be disabled when talking to
646 the client. */
648 static void
649 unblock_async_io (void)
651 #ifndef USE_WIN32API
652 sigset_t sigio_set;
654 sigemptyset (&sigio_set);
655 sigaddset (&sigio_set, SIGIO);
656 sigprocmask (SIG_UNBLOCK, &sigio_set, NULL);
657 #endif
660 /* Current state of asynchronous I/O. */
661 static int async_io_enabled;
663 /* Enable asynchronous I/O. */
664 void
665 enable_async_io (void)
667 if (async_io_enabled)
668 return;
670 #ifndef USE_WIN32API
671 signal (SIGIO, input_interrupt);
672 #endif
673 async_io_enabled = 1;
676 /* Disable asynchronous I/O. */
677 void
678 disable_async_io (void)
680 if (!async_io_enabled)
681 return;
683 #ifndef USE_WIN32API
684 signal (SIGIO, SIG_IGN);
685 #endif
686 async_io_enabled = 0;
689 void
690 initialize_async_io (void)
692 /* Make sure that async I/O starts disabled. */
693 async_io_enabled = 1;
694 disable_async_io ();
696 /* Make sure the signal is unblocked. */
697 unblock_async_io ();
700 /* Returns next char from remote GDB. -1 if error. */
702 static int
703 readchar (void)
705 static unsigned char buf[BUFSIZ];
706 static int bufcnt = 0;
707 static unsigned char *bufp;
709 if (bufcnt-- > 0)
710 return *bufp++;
712 bufcnt = read (remote_desc, buf, sizeof (buf));
714 if (bufcnt <= 0)
716 if (bufcnt == 0)
717 fprintf (stderr, "readchar: Got EOF\n");
718 else
719 perror ("readchar");
721 return -1;
724 bufp = buf;
725 bufcnt--;
726 return *bufp++;
729 /* Read a packet from the remote machine, with error checking,
730 and store it in BUF. Returns length of packet, or negative if error. */
733 getpkt (char *buf)
735 char *bp;
736 unsigned char csum, c1, c2;
737 int c;
739 while (1)
741 csum = 0;
743 while (1)
745 c = readchar ();
746 if (c == '$')
747 break;
748 if (remote_debug)
750 fprintf (stderr, "[getpkt: discarding char '%c']\n", c);
751 fflush (stderr);
754 if (c < 0)
755 return -1;
758 bp = buf;
759 while (1)
761 c = readchar ();
762 if (c < 0)
763 return -1;
764 if (c == '#')
765 break;
766 *bp++ = c;
767 csum += c;
769 *bp = 0;
771 c1 = fromhex (readchar ());
772 c2 = fromhex (readchar ());
774 if (csum == (c1 << 4) + c2)
775 break;
777 fprintf (stderr, "Bad checksum, sentsum=0x%x, csum=0x%x, buf=%s\n",
778 (c1 << 4) + c2, csum, buf);
779 write (remote_desc, "-", 1);
782 if (remote_debug)
784 fprintf (stderr, "getpkt (\"%s\"); [sending ack] \n", buf);
785 fflush (stderr);
788 write (remote_desc, "+", 1);
790 if (remote_debug)
792 fprintf (stderr, "[sent ack]\n");
793 fflush (stderr);
796 return bp - buf;
799 void
800 write_ok (char *buf)
802 buf[0] = 'O';
803 buf[1] = 'K';
804 buf[2] = '\0';
807 void
808 write_enn (char *buf)
810 /* Some day, we should define the meanings of the error codes... */
811 buf[0] = 'E';
812 buf[1] = '0';
813 buf[2] = '1';
814 buf[3] = '\0';
817 void
818 convert_int_to_ascii (unsigned char *from, char *to, int n)
820 int nib;
821 int ch;
822 while (n--)
824 ch = *from++;
825 nib = ((ch & 0xf0) >> 4) & 0x0f;
826 *to++ = tohex (nib);
827 nib = ch & 0x0f;
828 *to++ = tohex (nib);
830 *to++ = 0;
834 void
835 convert_ascii_to_int (char *from, unsigned char *to, int n)
837 int nib1, nib2;
838 while (n--)
840 nib1 = fromhex (*from++);
841 nib2 = fromhex (*from++);
842 *to++ = (((nib1 & 0x0f) << 4) & 0xf0) | (nib2 & 0x0f);
846 static char *
847 outreg (int regno, char *buf)
849 if ((regno >> 12) != 0)
850 *buf++ = tohex ((regno >> 12) & 0xf);
851 if ((regno >> 8) != 0)
852 *buf++ = tohex ((regno >> 8) & 0xf);
853 *buf++ = tohex ((regno >> 4) & 0xf);
854 *buf++ = tohex (regno & 0xf);
855 *buf++ = ':';
856 collect_register_as_string (regno, buf);
857 buf += 2 * register_size (regno);
858 *buf++ = ';';
860 return buf;
863 void
864 new_thread_notify (int id)
866 char own_buf[256];
868 /* The `n' response is not yet part of the remote protocol. Do nothing. */
869 if (1)
870 return;
872 if (server_waiting == 0)
873 return;
875 sprintf (own_buf, "n%x", id);
876 disable_async_io ();
877 putpkt (own_buf);
878 enable_async_io ();
881 void
882 dead_thread_notify (int id)
884 char own_buf[256];
886 /* The `x' response is not yet part of the remote protocol. Do nothing. */
887 if (1)
888 return;
890 sprintf (own_buf, "x%x", id);
891 disable_async_io ();
892 putpkt (own_buf);
893 enable_async_io ();
896 void
897 prepare_resume_reply (char *buf, char status, unsigned char sig)
899 int nib;
901 *buf++ = status;
903 nib = ((sig & 0xf0) >> 4);
904 *buf++ = tohex (nib);
905 nib = sig & 0x0f;
906 *buf++ = tohex (nib);
908 if (status == 'T')
910 const char **regp = gdbserver_expedite_regs;
912 if (the_target->stopped_by_watchpoint != NULL
913 && (*the_target->stopped_by_watchpoint) ())
915 CORE_ADDR addr;
916 int i;
918 strncpy (buf, "watch:", 6);
919 buf += 6;
921 addr = (*the_target->stopped_data_address) ();
923 /* Convert each byte of the address into two hexadecimal chars.
924 Note that we take sizeof (void *) instead of sizeof (addr);
925 this is to avoid sending a 64-bit address to a 32-bit GDB. */
926 for (i = sizeof (void *) * 2; i > 0; i--)
928 *buf++ = tohex ((addr >> (i - 1) * 4) & 0xf);
930 *buf++ = ';';
933 while (*regp)
935 buf = outreg (find_regno (*regp), buf);
936 regp ++;
939 /* Formerly, if the debugger had not used any thread features we would not
940 burden it with a thread status response. This was for the benefit of
941 GDB 4.13 and older. However, in recent GDB versions the check
942 (``if (cont_thread != 0)'') does not have the desired effect because of
943 sillyness in the way that the remote protocol handles specifying a thread.
944 Since thread support relies on qSymbol support anyway, assume GDB can handle
945 threads. */
947 if (using_threads)
949 unsigned int gdb_id_from_wait;
951 /* FIXME right place to set this? */
952 thread_from_wait = ((struct inferior_list_entry *)current_inferior)->id;
953 gdb_id_from_wait = thread_to_gdb_id (current_inferior);
955 if (debug_threads)
956 fprintf (stderr, "Writing resume reply for %ld\n\n", thread_from_wait);
957 /* This if (1) ought to be unnecessary. But remote_wait in GDB
958 will claim this event belongs to inferior_ptid if we do not
959 specify a thread, and there's no way for gdbserver to know
960 what inferior_ptid is. */
961 if (1 || old_thread_from_wait != thread_from_wait)
963 general_thread = thread_from_wait;
964 sprintf (buf, "thread:%x;", gdb_id_from_wait);
965 buf += strlen (buf);
966 old_thread_from_wait = thread_from_wait;
970 if (dlls_changed)
972 strcpy (buf, "library:;");
973 buf += strlen (buf);
974 dlls_changed = 0;
977 /* For W and X, we're done. */
978 *buf++ = 0;
981 void
982 decode_m_packet (char *from, CORE_ADDR *mem_addr_ptr, unsigned int *len_ptr)
984 int i = 0, j = 0;
985 char ch;
986 *mem_addr_ptr = *len_ptr = 0;
988 while ((ch = from[i++]) != ',')
990 *mem_addr_ptr = *mem_addr_ptr << 4;
991 *mem_addr_ptr |= fromhex (ch) & 0x0f;
994 for (j = 0; j < 4; j++)
996 if ((ch = from[i++]) == 0)
997 break;
998 *len_ptr = *len_ptr << 4;
999 *len_ptr |= fromhex (ch) & 0x0f;
1003 void
1004 decode_M_packet (char *from, CORE_ADDR *mem_addr_ptr, unsigned int *len_ptr,
1005 unsigned char *to)
1007 int i = 0;
1008 char ch;
1009 *mem_addr_ptr = *len_ptr = 0;
1011 while ((ch = from[i++]) != ',')
1013 *mem_addr_ptr = *mem_addr_ptr << 4;
1014 *mem_addr_ptr |= fromhex (ch) & 0x0f;
1017 while ((ch = from[i++]) != ':')
1019 *len_ptr = *len_ptr << 4;
1020 *len_ptr |= fromhex (ch) & 0x0f;
1023 convert_ascii_to_int (&from[i++], to, *len_ptr);
1027 decode_X_packet (char *from, int packet_len, CORE_ADDR *mem_addr_ptr,
1028 unsigned int *len_ptr, unsigned char *to)
1030 int i = 0;
1031 char ch;
1032 *mem_addr_ptr = *len_ptr = 0;
1034 while ((ch = from[i++]) != ',')
1036 *mem_addr_ptr = *mem_addr_ptr << 4;
1037 *mem_addr_ptr |= fromhex (ch) & 0x0f;
1040 while ((ch = from[i++]) != ':')
1042 *len_ptr = *len_ptr << 4;
1043 *len_ptr |= fromhex (ch) & 0x0f;
1046 if (remote_unescape_input ((const gdb_byte *) &from[i], packet_len - i,
1047 to, *len_ptr) != *len_ptr)
1048 return -1;
1050 return 0;
1053 /* Decode a qXfer write request. */
1055 decode_xfer_write (char *buf, int packet_len, char **annex, CORE_ADDR *offset,
1056 unsigned int *len, unsigned char *data)
1058 char ch;
1060 /* Extract and NUL-terminate the annex. */
1061 *annex = buf;
1062 while (*buf && *buf != ':')
1063 buf++;
1064 if (*buf == '\0')
1065 return -1;
1066 *buf++ = 0;
1068 /* Extract the offset. */
1069 *offset = 0;
1070 while ((ch = *buf++) != ':')
1072 *offset = *offset << 4;
1073 *offset |= fromhex (ch) & 0x0f;
1076 /* Get encoded data. */
1077 packet_len -= buf - *annex;
1078 *len = remote_unescape_input ((const gdb_byte *) buf, packet_len,
1079 data, packet_len);
1080 return 0;
1083 /* Ask GDB for the address of NAME, and return it in ADDRP if found.
1084 Returns 1 if the symbol is found, 0 if it is not, -1 on error. */
1087 look_up_one_symbol (const char *name, CORE_ADDR *addrp)
1089 char own_buf[266], *p, *q;
1090 int len;
1091 struct sym_cache *sym;
1093 /* Check the cache first. */
1094 for (sym = symbol_cache; sym; sym = sym->next)
1095 if (strcmp (name, sym->name) == 0)
1097 *addrp = sym->addr;
1098 return 1;
1101 /* If we've passed the call to thread_db_look_up_symbols, then
1102 anything not in the cache must not exist; we're not interested
1103 in any libraries loaded after that point, only in symbols in
1104 libpthread.so. It might not be an appropriate time to look
1105 up a symbol, e.g. while we're trying to fetch registers. */
1106 if (all_symbols_looked_up)
1107 return 0;
1109 /* Send the request. */
1110 strcpy (own_buf, "qSymbol:");
1111 hexify (own_buf + strlen ("qSymbol:"), name, strlen (name));
1112 if (putpkt (own_buf) < 0)
1113 return -1;
1115 /* FIXME: Eventually add buffer overflow checking (to getpkt?) */
1116 len = getpkt (own_buf);
1117 if (len < 0)
1118 return -1;
1120 /* We ought to handle pretty much any packet at this point while we
1121 wait for the qSymbol "response". That requires re-entering the
1122 main loop. For now, this is an adequate approximation; allow
1123 GDB to read from memory while it figures out the address of the
1124 symbol. */
1125 while (own_buf[0] == 'm')
1127 CORE_ADDR mem_addr;
1128 unsigned char *mem_buf;
1129 unsigned int mem_len;
1131 decode_m_packet (&own_buf[1], &mem_addr, &mem_len);
1132 mem_buf = malloc (mem_len);
1133 if (read_inferior_memory (mem_addr, mem_buf, mem_len) == 0)
1134 convert_int_to_ascii (mem_buf, own_buf, mem_len);
1135 else
1136 write_enn (own_buf);
1137 free (mem_buf);
1138 if (putpkt (own_buf) < 0)
1139 return -1;
1140 len = getpkt (own_buf);
1141 if (len < 0)
1142 return -1;
1145 if (strncmp (own_buf, "qSymbol:", strlen ("qSymbol:")) != 0)
1147 warning ("Malformed response to qSymbol, ignoring: %s\n", own_buf);
1148 return -1;
1151 p = own_buf + strlen ("qSymbol:");
1152 q = p;
1153 while (*q && *q != ':')
1154 q++;
1156 /* Make sure we found a value for the symbol. */
1157 if (p == q || *q == '\0')
1158 return 0;
1160 decode_address (addrp, p, q - p);
1162 /* Save the symbol in our cache. */
1163 sym = malloc (sizeof (*sym));
1164 sym->name = strdup (name);
1165 sym->addr = *addrp;
1166 sym->next = symbol_cache;
1167 symbol_cache = sym;
1169 return 1;
1172 void
1173 monitor_output (const char *msg)
1175 char *buf = malloc (strlen (msg) * 2 + 2);
1177 buf[0] = 'O';
1178 hexify (buf + 1, msg, 0);
1180 putpkt (buf);
1181 free (buf);
1184 /* Return a malloc allocated string with special characters from TEXT
1185 replaced by entity references. */
1187 char *
1188 xml_escape_text (const char *text)
1190 char *result;
1191 int i, special;
1193 /* Compute the length of the result. */
1194 for (i = 0, special = 0; text[i] != '\0'; i++)
1195 switch (text[i])
1197 case '\'':
1198 case '\"':
1199 special += 5;
1200 break;
1201 case '&':
1202 special += 4;
1203 break;
1204 case '<':
1205 case '>':
1206 special += 3;
1207 break;
1208 default:
1209 break;
1212 /* Expand the result. */
1213 result = malloc (i + special + 1);
1214 for (i = 0, special = 0; text[i] != '\0'; i++)
1215 switch (text[i])
1217 case '\'':
1218 strcpy (result + i + special, "&apos;");
1219 special += 5;
1220 break;
1221 case '\"':
1222 strcpy (result + i + special, "&quot;");
1223 special += 5;
1224 break;
1225 case '&':
1226 strcpy (result + i + special, "&amp;");
1227 special += 4;
1228 break;
1229 case '<':
1230 strcpy (result + i + special, "&lt;");
1231 special += 3;
1232 break;
1233 case '>':
1234 strcpy (result + i + special, "&gt;");
1235 special += 3;
1236 break;
1237 default:
1238 result[i + special] = text[i];
1239 break;
1241 result[i + special] = '\0';
1243 return result;