X-Git-Url: https://review.openocd.org/gitweb?a=blobdiff_plain;f=src%2Fserver%2Fgdb_server.c;h=1fac46972a9e4f6c9c3bae36313f396012272421;hb=652a5b18b4d769035b6d6c3357de4b9d858cbbe6;hp=6c9936eec98f273d20a5b2136717d29d15388899;hpb=0689e3dd6752f45f493eceb3edf040fbc7849846;p=openocd.git diff --git a/src/server/gdb_server.c b/src/server/gdb_server.c index 6c9936eec9..1fac46972a 100644 --- a/src/server/gdb_server.c +++ b/src/server/gdb_server.c @@ -43,11 +43,12 @@ #define _DEBUG_GDB_IO_ #endif +extern int gdb_error(connection_t *connection, int retval); static unsigned short gdb_port; static const char *DIGITS = "0123456789abcdef"; -static void gdb_log_callback(void *priv, const char *file, int line, - const char *function, const char *format, va_list args); +static void gdb_log_callback(void *priv, const char *file, int line, + const char *function, const char *string); enum gdb_detach_mode { @@ -84,14 +85,58 @@ int gdb_last_signal(target_t *target) case DBG_REASON_NOTHALTED: return 0x0; /* no signal... shouldn't happen */ default: - ERROR("BUG: undefined debug reason"); - exit(-1); + USER("undefined debug reason %d - target needs reset", target->debug_reason); + return 0x0; + } +} + +#ifndef _WIN32 +int check_pending(connection_t *connection, int timeout_s, int *got_data) +{ + /* a non-blocking socket will block if there is 0 bytes available on the socket, + * but return with as many bytes as are available immediately + */ + struct timeval tv; + fd_set read_fds; + gdb_connection_t *gdb_con = connection->priv; + int t; + if (got_data==NULL) + got_data=&t; + *got_data=0; + + if (gdb_con->buf_cnt>0) + { + *got_data = 1; + return ERROR_OK; + } + + FD_ZERO(&read_fds); + FD_SET(connection->fd, &read_fds); + + tv.tv_sec = timeout_s; + tv.tv_usec = 0; + if (select(connection->fd + 1, &read_fds, NULL, NULL, &tv) == 0) + { + /* This can typically be because a "monitor" command took too long + * before printing any progress messages + */ + if (timeout_s>0) + { + return ERROR_GDB_TIMEOUT; + } else + { + return ERROR_OK; + } } + *got_data=FD_ISSET(connection->fd, &read_fds)!=0; + return ERROR_OK; } +#endif int gdb_get_char(connection_t *connection, int* next_char) { gdb_connection_t *gdb_con = connection->priv; + int retval=ERROR_OK; #ifdef _DEBUG_GDB_IO_ char *debug_buffer; @@ -115,24 +160,9 @@ int gdb_get_char(connection_t *connection, int* next_char) for (;;) { #ifndef _WIN32 - /* a non-blocking socket will block if there is 0 bytes available on the socket, - * but return with as many bytes as are available immediately - */ - struct timeval tv; - fd_set read_fds; - - FD_ZERO(&read_fds); - FD_SET(connection->fd, &read_fds); - - tv.tv_sec = 1; - tv.tv_usec = 0; - if (select(connection->fd + 1, &read_fds, NULL, NULL, &tv) == 0) - { - /* This can typically be because a "monitor" command took too long - * before printing any progress messages - */ - return ERROR_GDB_TIMEOUT; - } + retval=check_pending(connection, 1, NULL); + if (retval!=ERROR_OK) + return retval; #endif gdb_con->buf_cnt = read_socket(connection->fd, gdb_con->buffer, GDB_BUFFER_SIZE); if (gdb_con->buf_cnt > 0) @@ -154,8 +184,10 @@ int gdb_get_char(connection_t *connection, int* next_char) usleep(1000); break; case WSAECONNABORTED: + gdb_con->closed = 1; return ERROR_SERVER_REMOTE_CLOSED; case WSAECONNRESET: + gdb_con->closed = 1; return ERROR_SERVER_REMOTE_CLOSED; default: ERROR("read: %d", errno); @@ -168,11 +200,14 @@ int gdb_get_char(connection_t *connection, int* next_char) usleep(1000); break; case ECONNABORTED: + gdb_con->closed = 1; return ERROR_SERVER_REMOTE_CLOSED; case ECONNRESET: + gdb_con->closed = 1; return ERROR_SERVER_REMOTE_CLOSED; default: ERROR("read: %s", strerror(errno)); + gdb_con->closed = 1; return ERROR_SERVER_REMOTE_CLOSED; } #endif @@ -192,12 +227,12 @@ int gdb_get_char(connection_t *connection, int* next_char) if (gdb_con->buf_cnt > 0) connection->input_pending = 1; else - connection->input_pending = 0; + connection->input_pending = 0; #ifdef _DEBUG_GDB_IO_ DEBUG("returned char '%c' (0x%2.2x)", *next_char, *next_char); #endif - return ERROR_OK; + return retval; } int gdb_putback_char(connection_t *connection, int last_char) @@ -211,7 +246,7 @@ int gdb_putback_char(connection_t *connection, int last_char) } else { - ERROR("BUG: couldn't put character back"); + ERROR("BUG: couldn't put character back"); } return ERROR_OK; @@ -248,6 +283,27 @@ int gdb_put_packet_inner(connection_t *connection, char *buffer, int len) for (i = 0; i < len; i++) my_checksum += buffer[i]; +#ifdef _DEBUG_GDB_IO_ + /* + * At this point we should have nothing in the input queue from GDB, + * however sometimes '-' is sent even though we've already received + * an ACK (+) for everything we've sent off. + */ +#ifndef _WIN32 + int gotdata; + for (;;) + { + if ((retval=check_pending(connection, 0, &gotdata))!=ERROR_OK) + return retval; + if (!gotdata) + break; + if ((retval = gdb_get_char(connection, &reply)) != ERROR_OK) + return retval; + WARNING("Discard unexpected char %c", reply); + } +#endif +#endif + while (1) { #ifdef _DEBUG_GDB_IO_ @@ -257,44 +313,30 @@ int gdb_put_packet_inner(connection_t *connection, char *buffer, int len) DEBUG("sending packet '$%s#%2.2x'", debug_buffer, my_checksum); free(debug_buffer); #endif -#if 0 - char checksum[3]; - gdb_write(connection, "$", 1); - if (len > 0) - gdb_write(connection, buffer, len); - gdb_write(connection, "#", 1); - - snprintf(checksum, 3, "%2.2x", my_checksum); - - gdb_write(connection, checksum, 2); -#else - void *allocated = NULL; - char stackAlloc[1024]; - char *t = stackAlloc; - int totalLen = 1 + len + 1 + 2; - if (totalLen > sizeof(stackAlloc)) + + char local_buffer[1024]; + local_buffer[0] = '$'; + if (len+4 <= sizeof(local_buffer)) { - allocated = malloc(totalLen); - t = allocated; - if (allocated == NULL) - { - ERROR("Ran out of memory trying to reply packet %d\n", totalLen); - exit(-1); - } + /* performance gain on smaller packets by only a single call to gdb_write() */ + memcpy(local_buffer+1, buffer, len++); + local_buffer[len++] = '#'; + local_buffer[len++] = DIGITS[(my_checksum >> 4) & 0xf]; + local_buffer[len++] = DIGITS[my_checksum & 0xf]; + gdb_write(connection, local_buffer, len); } - t[0] = '$'; - memcpy(t + 1, buffer, len); - t[1 + len] = '#'; - t[1 + len + 1] = DIGITS[(my_checksum >> 4) & 0xf]; - t[1 + len + 2] = DIGITS[my_checksum & 0xf]; - - gdb_write(connection, t, totalLen); - - if (allocated) + else { - free(allocated); + /* larger packets are transmitted directly from caller supplied buffer + by several calls to gdb_write() to avoid dynamic allocation */ + local_buffer[1] = '#'; + local_buffer[2] = DIGITS[(my_checksum >> 4) & 0xf]; + local_buffer[3] = DIGITS[my_checksum & 0xf]; + gdb_write(connection, local_buffer, 1); + gdb_write(connection, buffer, len); + gdb_write(connection, local_buffer+1, 3); } -#endif + if ((retval = gdb_get_char(connection, &reply)) != ERROR_OK) return retval; @@ -322,12 +364,14 @@ int gdb_put_packet_inner(connection_t *connection, char *buffer, int len) else { ERROR("unknown character 0x%2.2x in reply, dropping connection", reply); + gdb_con->closed=1; return ERROR_SERVER_REMOTE_CLOSED; } } else { ERROR("unknown character 0x%2.2x in reply, dropping connection", reply); + gdb_con->closed=1; return ERROR_SERVER_REMOTE_CLOSED; } } @@ -387,21 +431,21 @@ int gdb_get_packet_inner(connection_t *connection, char *buffer, int *len) } while (character != '$'); my_checksum = 0; - + count = 0; gdb_connection_t *gdb_con = connection->priv; for (;;) { /* The common case is that we have an entire packet with no escape chars. * We need to leave at least 2 bytes in the buffer to have - * gdb_get_char() update various bits and bobs correctly. + * gdb_get_char() update various bits and bobs correctly. */ if ((gdb_con->buf_cnt > 2) && ((gdb_con->buf_cnt+count) < *len)) { /* The compiler will struggle a bit with constant propagation and * aliasing, so we help it by showing that these values do not - * change inside the loop - */ + * change inside the loop + */ int i; char *buf = gdb_con->buf_p; int run = gdb_con->buf_cnt - 2; @@ -413,13 +457,13 @@ int gdb_get_packet_inner(connection_t *connection, char *buffer, int *len) i++; if (character == '#') { - /* Danger! character can be '#' when esc is + /* Danger! character can be '#' when esc is * used so we need an explicit boolean for done here. */ done = 1; break; } - + if (character == '}') { /* data transmitted in binary mode (X packet) @@ -437,15 +481,15 @@ int gdb_get_packet_inner(connection_t *connection, char *buffer, int *len) } gdb_con->buf_p += i; gdb_con->buf_cnt -= i; - if (done) + if (done) break; - } + } if (count > *len) { ERROR("packet buffer too small"); return ERROR_GDB_BUFFER_TOO_SMALL; } - + if ((retval = gdb_get_char(connection, &character)) != ERROR_OK) return retval; @@ -503,8 +547,8 @@ int gdb_get_packet(connection_t *connection, char *buffer, int *len) gdb_con->busy = 0; return retval; } - -int gdb_output_con(connection_t *connection, char* line) + +int gdb_output_con(connection_t *connection, const char* line) { char *hex_buffer; int i, bin_size; @@ -512,6 +556,8 @@ int gdb_output_con(connection_t *connection, char* line) bin_size = strlen(line); hex_buffer = malloc(bin_size*2 + 2); + if (hex_buffer == NULL) + return ERROR_GDB_BUFFER_TOO_SMALL; hex_buffer[0] = 'O'; for (i=0; igdb_program_script) { - script = open_file_from_path(cmd_ctx, target->gdb_program_script, "r"); + script = open_file_from_path(target->gdb_program_script, "r"); if (!script) { ERROR("couldn't open script file %s", target->gdb_program_script); @@ -548,10 +594,10 @@ int gdb_program_handler(struct target_s *target, enum target_event event, void * INFO("executing gdb_program script '%s'", target->gdb_program_script); command_run_file(cmd_ctx, script, COMMAND_EXEC); fclose(script); - + jtag_execute_queue(); } - + return ERROR_OK; } @@ -566,10 +612,10 @@ int gdb_target_callback_event_handler(struct target_s *target, enum target_event { case TARGET_EVENT_HALTED: /* In the GDB protocol when we are stepping or coninuing execution, - * we have a lingering reply. Upon receiving a halted event + * we have a lingering reply. Upon receiving a halted event * when we have that lingering packet, we reply to the original * step or continue packet. - * + * * Executing monitor commands can bring the target in and * out of the running state so we'll see lots of TARGET_EVENT_XXX * that are to be ignored. @@ -578,7 +624,7 @@ int gdb_target_callback_event_handler(struct target_s *target, enum target_event { /* stop forwarding log packets! */ log_remove_callback(gdb_log_callback, connection); - + if (gdb_connection->ctrl_c) { signal = 0x2; @@ -603,8 +649,8 @@ int gdb_target_callback_event_handler(struct target_s *target, enum target_event return ERROR_OK; } - - + + int gdb_new_connection(connection_t *connection) { gdb_connection_t *gdb_connection = malloc(sizeof(gdb_connection_t)); @@ -623,27 +669,36 @@ int gdb_new_connection(connection_t *connection) gdb_connection->closed = 0; gdb_connection->busy = 0; + /* send ACK to GDB for debug request */ + gdb_write(connection, "+", 1); + /* output goes through gdb connection */ command_set_output_handler(connection->cmd_ctx, gdb_output, connection); /* register callback to be informed about target events */ - target_register_event_callback(gdb_target_callback_event_handler, connection); - - /* a gdb session just attached, put the target in halt mode */ + target_register_event_callback(gdb_target_callback_event_handler, connection); + + /* a gdb session just attached, try to put the target in halt mode + * or alterantively try to issue a reset. + * + * GDB connection will fail if e.g. register read packets fail, + * otherwise resetting/halting the target could have been left to GDB init + * scripts + */ if (((retval = gdb_service->target->type->halt(gdb_service->target)) != ERROR_OK) && (retval != ERROR_TARGET_ALREADY_HALTED)) { - ERROR("error(%d) when trying to halt target, falling back to \"reset halt\"", retval); - command_run_line(connection->cmd_ctx, "reset halt"); + ERROR("error(%d) when trying to halt target, falling back to \"reset\"", retval); + command_run_line(connection->cmd_ctx, "reset"); } - - /* This will time out after 1 second */ - command_run_line(connection->cmd_ctx, "wait_halt 1"); - + /* remove the initial ACK from the incoming buffer */ if ((retval = gdb_get_char(connection, &initial_ack)) != ERROR_OK) return retval; + /* FIX!!!??? would we actually ever receive a + here??? + * Not observed. + */ if (initial_ack != '+') gdb_putback_char(connection, initial_ack); @@ -665,7 +720,7 @@ int gdb_connection_closed(connection_t *connection) /* if this connection registered a debug-message receiver delete it */ delete_debug_msg_receiver(connection->cmd_ctx, gdb_service->target); - + if (connection->priv) { free(connection->priv); @@ -712,7 +767,7 @@ void gdb_str_to_target(target_t *target, char *tstr, reg_t *reg) u8 *buf; int buf_len; buf = reg->value; - buf_len = CEIL(reg->size, 8); + buf_len = CEIL(reg->size, 8); if (target->endianness == TARGET_LITTLE_ENDIAN) { @@ -729,7 +784,7 @@ void gdb_str_to_target(target_t *target, char *tstr, reg_t *reg) tstr[(buf_len-1-i)*2] = DIGITS[(buf[i]>>4)&0xf]; tstr[(buf_len-1-i)*2+1] = DIGITS[buf[i]&0xf]; } - } + } } void gdb_target_to_str(target_t *target, char *tstr, char *str) @@ -757,7 +812,7 @@ void gdb_target_to_str(target_t *target, char *tstr, char *str) { str[i] = tstr[i]; } - } + } } int gdb_get_registers_packet(connection_t *connection, target_t *target, char* packet, int packet_size) @@ -776,16 +831,7 @@ int gdb_get_registers_packet(connection_t *connection, target_t *target, char* p if ((retval = target->type->get_gdb_reg_list(target, ®_list, ®_list_size)) != ERROR_OK) { - switch (retval) - { - case ERROR_TARGET_NOT_HALTED: - ERROR("gdb requested registers but we're not halted, dropping connection"); - return ERROR_SERVER_REMOTE_CLOSED; - default: - /* this is a bug condition - get_gdb_reg_list() may not return any other error */ - ERROR("BUG: unexpected error returned by get_gdb_reg_list()"); - exit(-1); - } + return gdb_error(connection, retval); } for (i = 0; i < reg_list_size; i++) @@ -843,16 +889,7 @@ int gdb_set_registers_packet(connection_t *connection, target_t *target, char *p if ((retval = target->type->get_gdb_reg_list(target, ®_list, ®_list_size)) != ERROR_OK) { - switch (retval) - { - case ERROR_TARGET_NOT_HALTED: - ERROR("gdb tried to registers but we're not halted, dropping connection"); - return ERROR_SERVER_REMOTE_CLOSED; - default: - /* this is a bug condition - get_gdb_reg_list() may not return any other error */ - ERROR("BUG: unexpected error returned by get_gdb_reg_list()"); - exit(-1); - } + return gdb_error(connection, retval); } packet_p = packet; @@ -870,7 +907,7 @@ int gdb_set_registers_packet(connection_t *connection, target_t *target, char *p bin_buf = malloc(CEIL(reg_list[i]->size, 8)); str_to_buf(hex_buf, CEIL(reg_list[i]->size, 8) * 2, bin_buf, reg_list[i]->size, 16); - /* get register arch_type, and call set method */ + /* get register arch_type, and call set method */ arch_type = register_get_arch_type(reg_list[i]->arch_type); if (arch_type == NULL) { @@ -879,14 +916,14 @@ int gdb_set_registers_packet(connection_t *connection, target_t *target, char *p } arch_type->set(reg_list[i], bin_buf); - /* advance packet pointer */ + /* advance packet pointer */ packet_p += (CEIL(reg_list[i]->size, 8) * 2); free(bin_buf); free(hex_buf); } - /* free reg_t *reg_list[] array allocated by get_gdb_reg_list */ + /* free reg_t *reg_list[] array allocated by get_gdb_reg_list */ free(reg_list); gdb_put_packet(connection, "OK", 2); @@ -908,16 +945,7 @@ int gdb_get_register_packet(connection_t *connection, target_t *target, char *pa if ((retval = target->type->get_gdb_reg_list(target, ®_list, ®_list_size)) != ERROR_OK) { - switch (retval) - { - case ERROR_TARGET_NOT_HALTED: - ERROR("gdb requested registers but we're not halted, dropping connection"); - return ERROR_SERVER_REMOTE_CLOSED; - default: - /* this is a bug condition - get_gdb_reg_list() may not return any other error */ - ERROR("BUG: unexpected error returned by get_gdb_reg_list()"); - exit(-1); - } + return gdb_error(connection, retval); } if (reg_list_size <= reg_num) @@ -953,22 +981,13 @@ int gdb_set_register_packet(connection_t *connection, target_t *target, char *pa if ((retval = target->type->get_gdb_reg_list(target, ®_list, ®_list_size)) != ERROR_OK) { - switch (retval) - { - case ERROR_TARGET_NOT_HALTED: - ERROR("gdb tried to set a register but we're not halted, dropping connection"); - return ERROR_SERVER_REMOTE_CLOSED; - default: - /* this is a bug condition - get_gdb_reg_list() may not return any other error */ - ERROR("BUG: unexpected error returned by get_gdb_reg_list()"); - exit(-1); - } + return gdb_error(connection, retval); } if (reg_list_size < reg_num) { ERROR("gdb requested a non-existing register"); - return ERROR_SERVER_REMOTE_CLOSED; + return ERROR_SERVER_REMOTE_CLOSED; } if (*separator != '=') @@ -985,7 +1004,7 @@ int gdb_set_register_packet(connection_t *connection, target_t *target, char *pa bin_buf = malloc(CEIL(reg_list[reg_num]->size, 8)); str_to_buf(hex_buf, CEIL(reg_list[reg_num]->size, 8) * 2, bin_buf, reg_list[reg_num]->size, 16); - /* get register arch_type, and call set method */ + /* get register arch_type, and call set method */ arch_type = register_get_arch_type(reg_list[reg_num]->arch_type); if (arch_type == NULL) { @@ -1003,13 +1022,10 @@ int gdb_set_register_packet(connection_t *connection, target_t *target, char *pa return ERROR_OK; } -int gdb_memory_packet_error(connection_t *connection, int retval) +int gdb_error(connection_t *connection, int retval) { switch (retval) { - case ERROR_TARGET_NOT_HALTED: - ERROR("gdb tried to read memory but we're not halted, dropping connection"); - return ERROR_SERVER_REMOTE_CLOSED; case ERROR_TARGET_DATA_ABORT: gdb_send_error(connection, EIO); break; @@ -1019,10 +1035,14 @@ int gdb_memory_packet_error(connection_t *connection, int retval) case ERROR_TARGET_UNALIGNED_ACCESS: gdb_send_error(connection, EFAULT); break; + case ERROR_TARGET_NOT_HALTED: + gdb_send_error(connection, EFAULT); + break; default: /* This could be that the target reset itself. */ - ERROR("unexpected error %i. Dropping connection.", retval); - return ERROR_SERVER_REMOTE_CLOSED; + ERROR("unexpected error %i", retval); + gdb_send_error(connection, EFAULT); + break; } return ERROR_OK; @@ -1030,7 +1050,7 @@ int gdb_memory_packet_error(connection_t *connection, int retval) /* We don't have to worry about the default 2 second timeout for GDB packets, * because GDB breaks up large memory reads into smaller reads. - * + * * 8191 bytes by the looks of it. Why 8191 bytes instead of 8192????? */ int gdb_read_memory_packet(connection_t *connection, target_t *target, char *packet, int packet_size) @@ -1067,11 +1087,11 @@ int gdb_read_memory_packet(connection_t *connection, target_t *target, char *pac { /* TODO : Here we have to lie and send back all zero's lest stack traces won't work. * At some point this might be fixed in GDB, in which case this code can be removed. - * + * * OpenOCD developers are acutely aware of this problem, but there is nothing * gained by involving the user in this problem that hopefully will get resolved * eventually - * + * * http://sourceware.org/cgi-bin/gnatsweb.pl?cmd=view%20audit-trail&database=gdb&pr=2395 * * For now, the default is to fix up things to make current GDB versions work. @@ -1099,7 +1119,7 @@ int gdb_read_memory_packet(connection_t *connection, target_t *target, char *pac } else { - retval = gdb_memory_packet_error(connection, retval); + retval = gdb_error(connection, retval); } free(buffer); @@ -1156,8 +1176,8 @@ int gdb_write_memory_packet(connection_t *connection, target_t *target, char *pa } else { - if ((retval = gdb_memory_packet_error(connection, retval)) != ERROR_OK) - return retval; + if ((retval = gdb_error(connection, retval)) != ERROR_OK) + return retval; } free(buffer); @@ -1206,8 +1226,8 @@ int gdb_write_memory_binary_packet(connection_t *connection, target_t *target, c } else { - if ((retval = gdb_memory_packet_error(connection, retval)) != ERROR_OK) - return retval; + if ((retval = gdb_error(connection, retval)) != ERROR_OK) + return retval; } return ERROR_OK; @@ -1242,25 +1262,6 @@ void gdb_step_continue_packet(connection_t *connection, target_t *target, char * } } -int gdb_bp_wp_packet_error(connection_t *connection, int retval) -{ - switch (retval) - { - case ERROR_TARGET_NOT_HALTED: - ERROR("gdb tried to set a breakpoint but we're not halted, dropping connection"); - return ERROR_SERVER_REMOTE_CLOSED; - break; - case ERROR_TARGET_RESOURCE_NOT_AVAILABLE: - gdb_send_error(connection, EBUSY); - break; - default: - ERROR("BUG: unexpected error %i", retval); - exit(-1); - } - - return ERROR_OK; -} - int gdb_breakpoint_watchpoint_packet(connection_t *connection, target_t *target, char *packet, int packet_size) { int type; @@ -1310,7 +1311,7 @@ int gdb_breakpoint_watchpoint_packet(connection_t *connection, target_t *target, { if ((retval = breakpoint_add(target, address, size, bp_type)) != ERROR_OK) { - if ((retval = gdb_bp_wp_packet_error(connection, retval)) != ERROR_OK) + if ((retval = gdb_error(connection, retval)) != ERROR_OK) return retval; } else @@ -1332,7 +1333,7 @@ int gdb_breakpoint_watchpoint_packet(connection_t *connection, target_t *target, { if ((retval = watchpoint_add(target, address, size, type-2, 0, 0xffffffffu)) != ERROR_OK) { - if ((retval = gdb_bp_wp_packet_error(connection, retval)) != ERROR_OK) + if ((retval = gdb_error(connection, retval)) != ERROR_OK) return retval; } else @@ -1362,14 +1363,14 @@ void xml_printf(int *retval, char **xml, int *pos, int *size, const char *fmt, . return; } int first = 1; - + for (;;) { if ((*xml == NULL) || (!first)) { /* start by 0 to exercise all the code paths. * Need minimum 2 bytes to fit 1 char and 0 terminator. */ - + *size = *size * 2 + 2; char *t = *xml; *xml = realloc(*xml, *size); @@ -1381,26 +1382,26 @@ void xml_printf(int *retval, char **xml, int *pos, int *size, const char *fmt, . return; } } - - va_list ap; - int ret; - va_start(ap, fmt); - ret = vsnprintf(*xml + *pos, *size - *pos, fmt, ap); - va_end(ap); - if ((ret > 0) && ((ret + 1) < *size - *pos)) - { - *pos += ret; - return; - } - /* there was just enough or not enough space, allocate more. */ - first = 0; + + va_list ap; + int ret; + va_start(ap, fmt); + ret = vsnprintf(*xml + *pos, *size - *pos, fmt, ap); + va_end(ap); + if ((ret > 0) && ((ret + 1) < *size - *pos)) + { + *pos += ret; + return; + } + /* there was just enough or not enough space, allocate more. */ + first = 0; } } static int decode_xfer_read(char *buf, char **annex, int *ofs, unsigned int *len) { char *separator; - + /* Extract and NUL-terminate the annex. */ *annex = buf; while (*buf && *buf != ':') @@ -1408,17 +1409,17 @@ static int decode_xfer_read(char *buf, char **annex, int *ofs, unsigned int *len if (*buf == '\0') return -1; *buf++ = 0; - + /* After the read marker and annex, qXfer looks like a * traditional 'm' packet. */ - + *ofs = strtoul(buf, &separator, 16); if (*separator != ',') return -1; *len = strtoul(separator+1, NULL, 16); - + return 0; } @@ -1426,22 +1427,22 @@ int gdb_calc_blocksize(flash_bank_t *bank) { int i; int block_size = 0xffffffff; - + /* loop through all sectors and return smallest sector size */ - + for (i = 0; i < bank->num_sectors; i++) { if (bank->sectors[i].size < block_size) block_size = bank->sectors[i].size; } - + return block_size; } int gdb_query_packet(connection_t *connection, target_t *target, char *packet, int packet_size) { command_context_t *cmd_ctx = connection->cmd_ctx; - + if (strstr(packet, "qRcmd,")) { if (packet_size > 6) @@ -1456,11 +1457,12 @@ int gdb_query_packet(connection_t *connection, target_t *target, char *packet, i cmd[i] = tmp; } cmd[(packet_size - 6)/2] = 0x0; - + /* We want to print all debug output to GDB connection */ log_add_callback(gdb_log_callback, connection); target_call_timer_callbacks(); command_run_line(cmd_ctx, cmd); + log_remove_callback(gdb_log_callback, connection); free(cmd); } gdb_put_packet(connection, "OK", 2); @@ -1476,22 +1478,22 @@ int gdb_query_packet(connection_t *connection, target_t *target, char *packet, i u32 checksum; u32 addr = 0; u32 len = 0; - + /* skip command character */ packet += 5; - + addr = strtoul(packet, &separator, 16); - + if (*separator != ',') { ERROR("incomplete read memory packet received, dropping connection"); return ERROR_SERVER_REMOTE_CLOSED; } - + len = strtoul(separator + 1, NULL, 16); - + retval = target_checksum_memory(target, addr, len, &checksum); - + if (retval == ERROR_OK) { snprintf(gdb_reply, 10, "C%8.8x", checksum); @@ -1499,10 +1501,10 @@ int gdb_query_packet(connection_t *connection, target_t *target, char *packet, i } else { - if ((retval = gdb_memory_packet_error(connection, retval)) != ERROR_OK) - return retval; + if ((retval = gdb_error(connection, retval)) != ERROR_OK) + return retval; } - + return ERROR_OK; } } @@ -1515,66 +1517,65 @@ int gdb_query_packet(connection_t *connection, target_t *target, char *packet, i int pos = 0; int size = 0; - xml_printf(&retval, &buffer, &pos, &size, + xml_printf(&retval, &buffer, &pos, &size, "PacketSize=%x;qXfer:memory-map:read%c;qXfer:features:read-", (GDB_BUFFER_SIZE - 1), gdb_use_memory_map == 1 ? '+' : '-'); - + if (retval != ERROR_OK) { gdb_send_error(connection, 01); return ERROR_OK; } - + gdb_put_packet(connection, buffer, strlen(buffer)); free(buffer); - + return ERROR_OK; } else if (strstr(packet, "qXfer:memory-map:read::")) { /* We get away with only specifying flash here. Regions that are not - * specified are treated as if we provided no memory map(if not we + * specified are treated as if we provided no memory map(if not we * could detect the holes and mark them as RAM). * Normally we only execute this code once, but no big deal if we * have to regenerate it a couple of times. */ - + flash_bank_t *p; char *xml = NULL; int size = 0; int pos = 0; int retval = ERROR_OK; - + int offset; int length; char *separator; int blocksize; - + /* skip command character */ packet += 23; - + offset = strtoul(packet, &separator, 16); length = strtoul(separator + 1, &separator, 16); - + xml_printf(&retval, &xml, &pos, &size, "\n"); - - int i = 0; - for (;;) + + int i; + for (i=0; i\n" \ "0x%x\n" \ "\n", \ p->base, p->size, blocksize); - i++; } - + xml_printf(&retval, &xml, &pos, &size, "\n"); if (retval != ERROR_OK) @@ -1582,7 +1583,7 @@ int gdb_query_packet(connection_t *connection, target_t *target, char *packet, i gdb_send_error(connection, retval); return retval; } - + if (offset + length > pos) { length = pos - offset; @@ -1592,52 +1593,52 @@ int gdb_query_packet(connection_t *connection, target_t *target, char *packet, i t[0] = 'l'; memcpy(t + 1, xml + offset, length); gdb_put_packet(connection, t, length + 1); - + free(t); free(xml); return ERROR_OK; } else if (strstr(packet, "qXfer:features:read:")) - { + { char *xml = NULL; int size = 0; int pos = 0; int retval = ERROR_OK; - + int offset; unsigned int length; char *annex; - + /* skip command character */ packet += 20; - + if (decode_xfer_read(packet, &annex, &offset, &length) < 0) { gdb_send_error(connection, 01); return ERROR_OK; } - + if (strcmp(annex, "target.xml") != 0) { gdb_send_error(connection, 01); return ERROR_OK; } - + xml_printf(&retval, &xml, &pos, &size, \ "l\narm\n\n"); - + if (retval != ERROR_OK) { gdb_send_error(connection, retval); return retval; } - + gdb_put_packet(connection, xml, strlen(xml) + 1); - + free(xml); return ERROR_OK; } - + gdb_put_packet(connection, "", 0); return ERROR_OK; } @@ -1649,18 +1650,18 @@ int gdb_v_packet(connection_t *connection, target_t *target, char *packet, int p int result; /* if flash programming disabled - send a empty reply */ - + if (gdb_flash_program == 0) { gdb_put_packet(connection, "", 0); return ERROR_OK; } - + if (strstr(packet, "vFlashErase:")) { unsigned long addr; unsigned long length; - + char *parse = packet + 12; if (*parse == '\0') { @@ -1683,14 +1684,14 @@ int gdb_v_packet(connection_t *connection, target_t *target, char *packet, int p ERROR("incomplete vFlashErase packet received, dropping connection"); return ERROR_SERVER_REMOTE_CLOSED; } - + /* assume all sectors need erasing - stops any problems * when flash_write is called multiple times */ flash_set_dirty(); - + /* perform any target specific operations before the erase */ target_call_event_callbacks(gdb_service->target, TARGET_EVENT_GDB_PROGRAM); - + /* perform erase */ if ((result = flash_erase_address_range(gdb_service->target, addr, length)) != ERROR_OK) { @@ -1702,7 +1703,7 @@ int gdb_v_packet(connection_t *connection, target_t *target, char *packet, int p } else gdb_put_packet(connection, "OK", 2); - + return ERROR_OK; } @@ -1724,7 +1725,7 @@ int gdb_v_packet(connection_t *connection, target_t *target, char *packet, int p return ERROR_SERVER_REMOTE_CLOSED; } length = packet_size - (parse - packet); - + /* create a new image if there isn't already one */ if (gdb_connection->vflash_image == NULL) { @@ -1758,11 +1759,11 @@ int gdb_v_packet(connection_t *connection, target_t *target, char *packet, int p DEBUG("wrote %u bytes from vFlash image to flash", written); gdb_put_packet(connection, "OK", 2); } - + image_close(gdb_connection->vflash_image); free(gdb_connection->vflash_image); gdb_connection->vflash_image = NULL; - + return ERROR_OK; } @@ -1777,43 +1778,37 @@ int gdb_detach(connection_t *connection, target_t *target) case GDB_DETACH_RESUME: target->type->resume(target, 1, 0, 1, 0); break; - + case GDB_DETACH_RESET: target_process_reset(connection->cmd_ctx); break; - + case GDB_DETACH_HALT: target->type->halt(target); break; - + case GDB_DETACH_NOTHING: break; } - + gdb_put_packet(connection, "OK", 2); - + return ERROR_OK; } -static void gdb_log_callback(void *priv, const char *file, int line, - const char *function, const char *format, va_list args) +static void gdb_log_callback(void *priv, const char *file, int line, + const char *function, const char *string) { connection_t *connection = priv; gdb_connection_t *gdb_con = connection->priv; - + if (gdb_con->busy) { /* do not reply this using the O packet */ return; } - char *t = alloc_printf(format, args); - if (t == NULL) - return; - - gdb_output_con(connection, t); - - free(t); + gdb_output_con(connection, string); } int gdb_input_inner(connection_t *connection) @@ -1846,7 +1841,7 @@ int gdb_input_inner(connection_t *connection) switch (packet[0]) { case 'H': - /* Hct... -- set thread + /* Hct... -- set thread * we don't have threads, send empty reply */ gdb_put_packet(connection, NULL, 0); break; @@ -1881,7 +1876,7 @@ int gdb_input_inner(connection_t *connection) case 'c': case 's': { - /* We're running/stepping, in which case we can + /* We're running/stepping, in which case we can * forward log output until the target is halted */ gdb_connection_t *gdb_con = connection->priv; gdb_con->frontend_state = TARGET_RUNNING; @@ -1943,8 +1938,14 @@ int gdb_input_inner(connection_t *connection) int gdb_input(connection_t *connection) { int retval = gdb_input_inner(connection); + gdb_connection_t *gdb_con = connection->priv; if (retval == ERROR_SERVER_REMOTE_CLOSED) return retval; + + /* logging does not propagate the error, yet can set th gdb_con->closed flag */ + if (gdb_con->closed) + return ERROR_SERVER_REMOTE_CLOSED; + /* we'll recover from any other errors(e.g. temporary timeouts, etc.) */ return ERROR_OK; } @@ -2025,7 +2026,7 @@ int handle_gdb_detach_command(struct command_context_s *cmd_ctx, char *cmd, char return ERROR_OK; } } - + WARNING("invalid gdb_detach configuration directive: %s", args[0]); return ERROR_OK; } @@ -2045,7 +2046,7 @@ int handle_gdb_memory_map_command(struct command_context_s *cmd_ctx, char *cmd, return ERROR_OK; } } - + WARNING("invalid gdb_memory_map configuration directive: %s", args[0]); return ERROR_OK; } @@ -2065,7 +2066,7 @@ int handle_gdb_flash_program_command(struct command_context_s *cmd_ctx, char *cm return ERROR_OK; } } - + WARNING("invalid gdb_memory_map configuration directive: %s", args[0]); return ERROR_OK; } @@ -2085,7 +2086,7 @@ int handle_gdb_report_data_abort_command(struct command_context_s *cmd_ctx, char return ERROR_OK; } } - + WARNING("invalid gdb_report_data_abort configuration directive: %s", args[0]); return ERROR_OK; }