diff options
author | Spencer Oliver <spen@spen-soft.co.uk> | 2012-01-30 15:32:53 +0000 |
---|---|---|
committer | Spencer Oliver <spen@spen-soft.co.uk> | 2012-02-06 10:50:26 +0000 |
commit | 7b032df3aa63905c16c63f1ba4414a04687f3777 (patch) | |
tree | a1d03a5e1cd1cb7957b5c1873b4548dc6866a7c9 /src/rtos/rtos.c | |
parent | 8b00e56e6433cff3ff818835953b27765aaabab0 (diff) | |
download | riscv-openocd-7b032df3aa63905c16c63f1ba4414a04687f3777.zip riscv-openocd-7b032df3aa63905c16c63f1ba4414a04687f3777.tar.gz riscv-openocd-7b032df3aa63905c16c63f1ba4414a04687f3777.tar.bz2 |
build: cleanup src/rtos directory
Change-Id: I24bc62d12409dbfc20a0a986acf6b3f2c913e36d
Signed-off-by: Spencer Oliver <spen@spen-soft.co.uk>
Reviewed-on: http://openocd.zylin.com/416
Tested-by: jenkins
Diffstat (limited to 'src/rtos/rtos.c')
-rw-r--r-- | src/rtos/rtos.c | 390 |
1 files changed, 154 insertions, 236 deletions
diff --git a/src/rtos/rtos.c b/src/rtos/rtos.c index 3deeb68..07e44ea 100644 --- a/src/rtos/rtos.c +++ b/src/rtos/rtos.c @@ -22,16 +22,12 @@ #include "config.h" #endif - #include "rtos.h" #include "target/target.h" #include "helper/log.h" #include "server/gdb_server.h" - - -static void hex_to_str( char* dst, char * hex_src ); - +static void hex_to_str(char *dst, char *hex_src); /* RTOSs */ extern struct rtos_type FreeRTOS_rtos; @@ -39,8 +35,7 @@ extern struct rtos_type ThreadX_rtos; extern struct rtos_type eCos_rtos; extern struct rtos_type Linux_os; -static struct rtos_type *rtos_types[] = -{ +static struct rtos_type *rtos_types[] = { &ThreadX_rtos, &FreeRTOS_rtos, &eCos_rtos, @@ -57,69 +52,66 @@ int rtos_smp_init(struct target *target) return ERROR_TARGET_INIT_FAILED; } - -int rtos_create(Jim_GetOptInfo *goi, struct target * target) +int rtos_create(Jim_GetOptInfo *goi, struct target *target) { int x; char *cp; - if (! goi->isconfigure) { + if (!goi->isconfigure) { if (goi->argc != 0) { if (goi->argc != 0) { Jim_WrongNumArgs(goi->interp, - goi->argc, goi->argv, - "NO PARAMS"); + goi->argc, goi->argv, + "NO PARAMS"); return JIM_ERR; } Jim_SetResultString(goi->interp, - target_type_name(target), -1); + target_type_name(target), -1); } } - if (target->rtos) { + if (target->rtos) free((void *)(target->rtos)); - } -// e = Jim_GetOpt_String(goi, &cp, NULL); -// target->rtos = strdup(cp); + /* e = Jim_GetOpt_String(goi, + * &cp, NULL); */ +/* target->rtos = strdup(cp); */ Jim_GetOpt_String(goi, &cp, NULL); /* now does target type exist */ - if ( 0 == strcmp( cp, "auto") ) - { - // auto detection of RTOS + if (0 == strcmp(cp, "auto")) { + /* auto detection of RTOS */ target->rtos_auto_detect = true; x = 0; - } - else - { + } else { - for (x = 0 ; rtos_types[x] ; x++) { + for (x = 0; rtos_types[x]; x++) { if (0 == strcmp(cp, rtos_types[x]->name)) { /* found */ break; } } if (rtos_types[x] == NULL) { - Jim_SetResultFormatted(goi->interp, "Unknown rtos type %s, try one of ", cp); - for (x = 0 ; rtos_types[x] ; x++) { + Jim_SetResultFormatted(goi->interp, "Unknown rtos type %s, try one of ", + cp); + for (x = 0; rtos_types[x]; x++) { if (rtos_types[x + 1]) { Jim_AppendStrings(goi->interp, - Jim_GetResult(goi->interp), - rtos_types[x]->name, - ", ", NULL); + Jim_GetResult(goi->interp), + rtos_types[x]->name, + ", ", NULL); } else { Jim_AppendStrings(goi->interp, - Jim_GetResult(goi->interp), - " or ", - rtos_types[x]->name,NULL); + Jim_GetResult(goi->interp), + " or ", + rtos_types[x]->name, NULL); } } return JIM_ERR; } } /* Create it */ - target->rtos = calloc(1,sizeof(struct rtos)); + target->rtos = calloc(1, sizeof(struct rtos)); target->rtos->type = rtos_types[x]; target->rtos->current_threadid = -1; target->rtos->current_thread = 0; @@ -128,10 +120,8 @@ int rtos_create(Jim_GetOptInfo *goi, struct target * target) /* put default thread handler in linux usecase it is overloaded*/ target->rtos->gdb_thread_packet = rtos_thread_packet; - if ( 0 != strcmp( cp, "auto") ) - { - target->rtos->type->create( target ); - } + if (0 != strcmp(cp, "auto")) + target->rtos->type->create(target); return JIM_OK; } @@ -140,7 +130,8 @@ int gdb_thread_packet(struct connection *connection, char *packet, int packet_si { struct target *target = get_target_from_connection(connection); if (target->rtos == NULL) - return rtos_thread_packet(connection, packet, packet_size); /* thread not found*/ + return rtos_thread_packet(connection, packet, packet_size); /* thread not + *found*/ return target->rtos->gdb_thread_packet(connection, packet, packet_size); } /* return -1 if no rtos defined, 0 if rtos and symbol to be asked, 1 if all @@ -171,8 +162,8 @@ int rtos_qsymbol(struct connection *connection, char *packet, int packet_size) hex_to_str(name_str, hex_name_str); symbol_num = 0; - while ((target->rtos->symbols[symbol_num].symbol_name != NULL) - && (0 != strcmp(target->rtos->symbols[symbol_num].symbol_name, name_str))) + while ((target->rtos->symbols[symbol_num].symbol_name != NULL) && + (0 != strcmp(target->rtos->symbols[symbol_num].symbol_name, name_str))) symbol_num++; if (target->rtos->symbols[symbol_num].symbol_name == NULL) { @@ -194,7 +185,8 @@ int rtos_qsymbol(struct connection *connection, char *packet, int packet_size) (1 == target->rtos->type->detect_rtos(target))) { /* Found correct RTOS or not autodetecting */ if (target->rtos_auto_detect == true) - LOG_OUTPUT("Auto-detected RTOS: %s\r\n", target->rtos->type->name); + LOG_OUTPUT("Auto-detected RTOS: %s\r\n", + target->rtos->type->name); symbols_done = 1; } else { /* Auto detecting RTOS and currently not found */ @@ -203,7 +195,8 @@ int rtos_qsymbol(struct connection *connection, char *packet, int packet_size) symbols_done = 1; else { next_symbol_num = 0; - target->rtos->type->get_symbol_list_to_lookup(&target->rtos->symbols); + target->rtos->type->get_symbol_list_to_lookup( + &target->rtos->symbols); } } } @@ -225,82 +218,63 @@ int rtos_qsymbol(struct connection *connection, char *packet, int packet_size) return -1; } - int rtos_thread_packet(struct connection *connection, char *packet, int packet_size) { struct target *target = get_target_from_connection(connection); - if (strstr(packet, "qThreadExtraInfo,")) - { - if ((target->rtos != NULL) && (target->rtos->thread_details != NULL) && (target->rtos->thread_count != 0)) - { + if (strstr(packet, "qThreadExtraInfo,")) { + if ((target->rtos != NULL) && (target->rtos->thread_details != NULL) && + (target->rtos->thread_count != 0)) { threadid_t threadid = 0; int found = -1; - sscanf(packet, "qThreadExtraInfo,%" SCNx64, &threadid ); + sscanf(packet, "qThreadExtraInfo,%" SCNx64, &threadid); - if ((target->rtos != NULL) && (target->rtos->thread_details - != NULL)) { + if ((target->rtos != NULL) && (target->rtos->thread_details != NULL)) { int thread_num; - for (thread_num = 0; thread_num - < target->rtos->thread_count; thread_num++) { - if (target->rtos->thread_details[thread_num].threadid - == threadid) { - if (target->rtos->thread_details[thread_num].exists) { + for (thread_num = 0; thread_num < target->rtos->thread_count; thread_num++) { + if (target->rtos->thread_details[thread_num].threadid == threadid) { + if (target->rtos->thread_details[thread_num].exists) found = thread_num; - } } } } if (found == -1) { - gdb_put_packet(connection, "E01", 3); // thread not found + gdb_put_packet(connection, "E01", 3); /* thread not found */ return ERROR_OK; } - struct thread_detail* detail = &target->rtos->thread_details[found]; + struct thread_detail *detail = &target->rtos->thread_details[found]; int str_size = 0; - if ( detail->display_str != NULL ) - { + if (detail->display_str != NULL) str_size += strlen(detail->display_str); - } - if ( detail->thread_name_str != NULL ) - { + if (detail->thread_name_str != NULL) str_size += strlen(detail->thread_name_str); - } - if ( detail->extra_info_str != NULL ) - { + if (detail->extra_info_str != NULL) str_size += strlen(detail->extra_info_str); - } - char * tmp_str = (char*) malloc( str_size + 7 ); - char* tmp_str_ptr = tmp_str; + char *tmp_str = (char *) malloc(str_size + 7); + char *tmp_str_ptr = tmp_str; - if ( detail->display_str != NULL ) - { - tmp_str_ptr += sprintf( tmp_str_ptr, "%s", detail->display_str ); - } - if ( detail->thread_name_str != NULL ) - { - if ( tmp_str_ptr != tmp_str ) - { - tmp_str_ptr += sprintf( tmp_str_ptr, " : " ); - } - tmp_str_ptr += sprintf( tmp_str_ptr, "%s", detail->thread_name_str ); + if (detail->display_str != NULL) + tmp_str_ptr += sprintf(tmp_str_ptr, "%s", detail->display_str); + if (detail->thread_name_str != NULL) { + if (tmp_str_ptr != tmp_str) + tmp_str_ptr += sprintf(tmp_str_ptr, " : "); + tmp_str_ptr += sprintf(tmp_str_ptr, "%s", detail->thread_name_str); } - if ( detail->extra_info_str != NULL ) - { - if ( tmp_str_ptr != tmp_str ) - { - tmp_str_ptr += sprintf( tmp_str_ptr, " : " ); - } - tmp_str_ptr += sprintf( tmp_str_ptr, " : %s", detail->extra_info_str ); + if (detail->extra_info_str != NULL) { + if (tmp_str_ptr != tmp_str) + tmp_str_ptr += sprintf(tmp_str_ptr, " : "); + tmp_str_ptr += + sprintf(tmp_str_ptr, " : %s", detail->extra_info_str); } assert(strlen(tmp_str) == (size_t) (tmp_str_ptr - tmp_str)); - char * hex_str = (char*) malloc( strlen(tmp_str)*2 +1 ); - str_to_hex( hex_str, tmp_str ); + char *hex_str = (char *) malloc(strlen(tmp_str)*2 + 1); + str_to_hex(hex_str, tmp_str); gdb_put_packet(connection, hex_str, strlen(hex_str)); free(hex_str); @@ -310,11 +284,8 @@ int rtos_thread_packet(struct connection *connection, char *packet, int packet_s } gdb_put_packet(connection, "", 0); return ERROR_OK; - } - else if (strstr(packet, "qSymbol")) - { - if (rtos_qsymbol(connection, packet, packet_size) == 1) - { + } else if (strstr(packet, "qSymbol")) { + if (rtos_qsymbol(connection, packet, packet_size) == 1) { target->rtos_auto_detect = false; target->rtos->type->create(target); target->rtos->type->update_threads(target->rtos); @@ -322,91 +293,64 @@ int rtos_thread_packet(struct connection *connection, char *packet, int packet_s gdb_put_packet(connection, "OK", 2); } return ERROR_OK; - } - else if (strstr(packet, "qfThreadInfo")) - { + } else if (strstr(packet, "qfThreadInfo")) { int i; - if ( ( target->rtos != NULL ) && ( target->rtos->thread_count != 0 ) ) - { + if ((target->rtos != NULL) && (target->rtos->thread_count != 0)) { - char* out_str = (char*) malloc(17 * target->rtos->thread_count + 5); - char* tmp_str = out_str; + char *out_str = (char *) malloc(17 * target->rtos->thread_count + 5); + char *tmp_str = out_str; tmp_str += sprintf(tmp_str, "m"); for (i = 0; i < target->rtos->thread_count; i++) { - if (i != 0) { + if (i != 0) tmp_str += sprintf(tmp_str, ","); - } tmp_str += sprintf(tmp_str, "%016" PRIx64, target->rtos->thread_details[i].threadid); } tmp_str[0] = 0; gdb_put_packet(connection, out_str, strlen(out_str)); - } - else - { + } else gdb_put_packet(connection, "", 0); - } return ERROR_OK; - } - else if (strstr(packet, "qsThreadInfo")) - { + } else if (strstr(packet, "qsThreadInfo")) { gdb_put_packet(connection, "l", 1); return ERROR_OK; - } - else if (strstr(packet, "qAttached")) - { + } else if (strstr(packet, "qAttached")) { gdb_put_packet(connection, "1", 1); return ERROR_OK; - } - else if (strstr(packet, "qOffsets")) - { + } else if (strstr(packet, "qOffsets")) { char offsets[] = "Text=0;Data=0;Bss=0"; gdb_put_packet(connection, offsets, sizeof(offsets)-1); return ERROR_OK; - } - else if (strstr(packet, "qC")) - { - if( target->rtos!=NULL ) - { + } else if (strstr(packet, "qC")) { + if (target->rtos != NULL) { char buffer[15]; int size; size = snprintf(buffer, 15, "QC%08X", (int)target->rtos->current_thread); gdb_put_packet(connection, buffer, size); - } - else - { + } else gdb_put_packet(connection, "QC0", 3); - } return ERROR_OK; - } - else if ( packet[0] == 'T' ) // Is thread alive? - { + } else if (packet[0] == 'T') { /* Is thread alive? */ threadid_t threadid; int found = -1; sscanf(packet, "T%" SCNx64, &threadid); - if ((target->rtos != NULL) && (target->rtos->thread_details - != NULL)) { + if ((target->rtos != NULL) && (target->rtos->thread_details != NULL)) { int thread_num; - for (thread_num = 0; thread_num - < target->rtos->thread_count; thread_num++) { - if (target->rtos->thread_details[thread_num].threadid - == threadid) { - if (target->rtos->thread_details[thread_num].exists) { + for (thread_num = 0; thread_num < target->rtos->thread_count; thread_num++) { + if (target->rtos->thread_details[thread_num].threadid == threadid) { + if (target->rtos->thread_details[thread_num].exists) found = thread_num; - } } } } - if (found != -1) { - gdb_put_packet(connection, "OK", 2); // thread alive - } else { - gdb_put_packet(connection, "E01", 3); // thread not found - } + if (found != -1) + gdb_put_packet(connection, "OK", 2); /* thread alive */ + else + gdb_put_packet(connection, "E01", 3); /* thread not found */ return ERROR_OK; - } - else if ( packet[0] == 'H') // Set current thread ( 'c' for step and continue, 'g' for all other operations ) - { + } else if (packet[0] == 'H') { /* Set current thread ( 'c' for step and continue, 'g' for + * all other operations ) */ if ((packet[1] == 'g') && (target->rtos != NULL)) sscanf(packet, "Hg%16" SCNx64, &target->rtos->current_threadid); gdb_put_packet(connection, "OK", 2); @@ -420,17 +364,16 @@ int rtos_get_gdb_reg_list(struct connection *connection) { struct target *target = get_target_from_connection(connection); int64_t current_threadid = target->rtos->current_threadid; - if ((target->rtos != NULL) && - (current_threadid != -1) && - (current_threadid != 0) && - ((current_threadid != target->rtos->current_thread) || - (target->smp))) /* in smp several current thread are possible */ - { - char * hex_reg_list; - target->rtos->type->get_thread_reg_list( target->rtos, current_threadid, &hex_reg_list ); - - if ( hex_reg_list != NULL ) - { + if ((target->rtos != NULL) && (current_threadid != -1) && + (current_threadid != 0) && + ((current_threadid != target->rtos->current_thread) || + (target->smp))) { /* in smp several current thread are possible */ + char *hex_reg_list; + target->rtos->type->get_thread_reg_list(target->rtos, + current_threadid, + &hex_reg_list); + + if (hex_reg_list != NULL) { gdb_put_packet(connection, hex_reg_list, strlen(hex_reg_list)); free(hex_reg_list); return ERROR_OK; @@ -439,103 +382,84 @@ int rtos_get_gdb_reg_list(struct connection *connection) return ERROR_FAIL; } - - -int rtos_generic_stack_read( struct target * target, const struct rtos_register_stacking* stacking, int64_t stack_ptr, char ** hex_reg_list ) +int rtos_generic_stack_read(struct target *target, + const struct rtos_register_stacking *stacking, + int64_t stack_ptr, + char **hex_reg_list) { int list_size = 0; - char * tmp_str_ptr; + char *tmp_str_ptr; int64_t new_stack_ptr; int i; int retval; - if ( stack_ptr == 0) - { + if (stack_ptr == 0) { LOG_OUTPUT("Error: null stack pointer in thread\r\n"); return -5; } - // Read the stack - uint8_t * stack_data = (uint8_t*) malloc( stacking->stack_registers_size ); + /* Read the stack */ + uint8_t *stack_data = (uint8_t *) malloc(stacking->stack_registers_size); uint32_t address = stack_ptr; - if ( stacking->stack_growth_direction == 1 ) - { - address -= stacking->stack_registers_size; - } - retval = target_read_buffer( target, address, stacking->stack_registers_size, stack_data); - if ( retval != ERROR_OK ) - { + if (stacking->stack_growth_direction == 1) + address -= stacking->stack_registers_size; + retval = target_read_buffer(target, address, stacking->stack_registers_size, stack_data); + if (retval != ERROR_OK) { LOG_OUTPUT("Error reading stack frame from FreeRTOS thread\r\n"); return retval; } -/* - LOG_OUTPUT("Stack Data :"); - for(i = 0; i < stacking->stack_registers_size; i++ ) - { - LOG_OUTPUT("%02X",stack_data[i]); - } - LOG_OUTPUT("\r\n"); -*/ - for( i = 0; i < stacking->num_output_registers; i++ ) - { +#if 0 + LOG_OUTPUT("Stack Data :"); + for (i = 0; i < stacking->stack_registers_size; i++) + LOG_OUTPUT("%02X", stack_data[i]); + LOG_OUTPUT("\r\n"); +#endif + for (i = 0; i < stacking->num_output_registers; i++) list_size += stacking->register_offsets[i].width_bits/8; - } - *hex_reg_list = (char*)malloc( list_size*2 +1 ); + *hex_reg_list = (char *)malloc(list_size*2 + 1); tmp_str_ptr = *hex_reg_list; - new_stack_ptr = stack_ptr - stacking->stack_growth_direction * stacking->stack_registers_size; + new_stack_ptr = stack_ptr - stacking->stack_growth_direction * + stacking->stack_registers_size; if (stacking->stack_alignment != 0) { /* Align new stack pointer to x byte boundary */ new_stack_ptr = (new_stack_ptr & (~((int64_t) stacking->stack_alignment - 1))) + ((stacking->stack_growth_direction == -1) ? stacking->stack_alignment : 0); } - for( i = 0; i < stacking->num_output_registers; i++ ) - { + for (i = 0; i < stacking->num_output_registers; i++) { int j; - for ( j = 0; j < stacking->register_offsets[i].width_bits/8; j++ ) - { - if ( stacking->register_offsets[i].offset == -1 ) - { - tmp_str_ptr += sprintf( tmp_str_ptr, "%02x", 0 ); - } - else if ( stacking->register_offsets[i].offset == -2 ) - { - tmp_str_ptr += sprintf( tmp_str_ptr, "%02x", ((uint8_t*)&new_stack_ptr)[j] ); - } + for (j = 0; j < stacking->register_offsets[i].width_bits/8; j++) { + if (stacking->register_offsets[i].offset == -1) + tmp_str_ptr += sprintf(tmp_str_ptr, "%02x", 0); + else if (stacking->register_offsets[i].offset == -2) + tmp_str_ptr += sprintf(tmp_str_ptr, "%02x", + ((uint8_t *)&new_stack_ptr)[j]); else - { - tmp_str_ptr += sprintf( tmp_str_ptr,"%02x", stack_data[ stacking->register_offsets[i].offset + j ] ); - } + tmp_str_ptr += sprintf(tmp_str_ptr, "%02x", + stack_data[stacking->register_offsets[i].offset + j]); } } -// LOG_OUTPUT("Output register string: %s\r\n", *hex_reg_list); +/* LOG_OUTPUT("Output register string: %s\r\n", *hex_reg_list); */ return ERROR_OK; } -int rtos_try_next( struct target * target ) +int rtos_try_next(struct target *target) { int x; - if ( target->rtos == NULL ) - { + if (target->rtos == NULL) return -1; - } - for (x = 0 ; rtos_types[x] ; x++) { - if (target->rtos->type == rtos_types[x] ) { + for (x = 0; rtos_types[x]; x++) { + if (target->rtos->type == rtos_types[x]) { /* found */ - if ( rtos_types[x+1] != NULL ) - { + if (rtos_types[x+1] != NULL) { target->rtos->type = rtos_types[x+1]; - if ( target->rtos->symbols != NULL ) - { - free( target->rtos->symbols ); - } + if (target->rtos->symbols != NULL) + free(target->rtos->symbols); return 1; - } - else - { - // No more rtos types + } else { + /* No more rtos types */ return 0; } @@ -545,24 +469,23 @@ int rtos_try_next( struct target * target ) } -static void hex_to_str( char* dst, char * hex_src ) +static void hex_to_str(char *dst, char *hex_src) { int src_pos = 0; int dst_pos = 0; - while ( hex_src[src_pos] != '\x00' ) - { + while (hex_src[src_pos] != '\x00') { char hex_char = hex_src[src_pos]; - char hex_digit_val = (hex_char>='a')?hex_char-'a'+10:(hex_char>='A')?hex_char-'A'+10:hex_char-'0'; - if ( 0 == (src_pos & 0x01) ) - { + char hex_digit_val = + (hex_char >= + 'a') ? hex_char-'a'+ + 10 : (hex_char >= 'A') ? hex_char-'A'+10 : hex_char-'0'; + if (0 == (src_pos & 0x01)) { dst[dst_pos] = hex_digit_val; dst[dst_pos+1] = 0; - } - else - { - ((unsigned char*)dst)[dst_pos] <<= 4; - ((unsigned char*)dst)[dst_pos] += hex_digit_val; + } else { + ((unsigned char *)dst)[dst_pos] <<= 4; + ((unsigned char *)dst)[dst_pos] += hex_digit_val; dst_pos++; } src_pos++; @@ -572,21 +495,16 @@ static void hex_to_str( char* dst, char * hex_src ) int str_to_hex(char *hex_dst, char *src) { - char * posptr = hex_dst; + char *posptr = hex_dst; unsigned i; - for( i = 0; i < strlen(src); i++) - { - posptr += sprintf( posptr, "%02x", (unsigned char)src[i] ); - } - return (posptr-hex_dst); + for (i = 0; i < strlen(src); i++) + posptr += sprintf(posptr, "%02x", (unsigned char)src[i]); + return posptr - hex_dst; } - -int rtos_update_threads( struct target* target ) +int rtos_update_threads(struct target *target) { if ((target->rtos != NULL) && (target->rtos->type != NULL)) - { target->rtos->type->update_threads(target->rtos); - } return ERROR_OK; } |