1 /***************************************************************************
2 * Copyright (C) 2011 by Broadcom Corporation *
3 * Evan Hunter - ehunter@broadcom.com *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
27 #include "target/target.h"
28 #include "helper/log.h"
29 #include "server/gdb_server.h"
32 static int64_t current_threadid
= -1;
34 static void hex_to_str( char* dst
, char * hex_src
);
35 static int str_to_hex( char* hex_dst
, char* src
);
39 extern struct rtos_type FreeRTOS_rtos
;
40 extern struct rtos_type ThreadX_rtos
;
41 extern struct rtos_type eCos_rtos
;
43 static struct rtos_type
*rtos_types
[] =
51 int rtos_thread_packet(struct connection
*connection
, char *packet
, int packet_size
);
54 int rtos_create(Jim_GetOptInfo
*goi
, struct target
* target
)
59 if (! goi
->isconfigure
) {
62 Jim_WrongNumArgs(goi
->interp
,
68 Jim_SetResultString(goi
->interp
,
69 target_type_name(target
), -1);
74 free((void *)(target
->rtos
));
76 // e = Jim_GetOpt_String(goi, &cp, NULL);
77 // target->rtos = strdup(cp);
79 Jim_GetOpt_String(goi
, &cp
, NULL
);
80 /* now does target type exist */
82 if ( 0 == strcmp( cp
, "auto") )
84 // auto detection of RTOS
85 target
->rtos_auto_detect
= true;
91 for (x
= 0 ; rtos_types
[x
] ; x
++) {
92 if (0 == strcmp(cp
, rtos_types
[x
]->name
)) {
97 if (rtos_types
[x
] == NULL
) {
98 Jim_SetResultFormatted(goi
->interp
, "Unknown rtos type %s, try one of ", cp
);
99 for (x
= 0 ; rtos_types
[x
] ; x
++) {
100 if (rtos_types
[x
+ 1]) {
101 Jim_AppendStrings(goi
->interp
,
102 Jim_GetResult(goi
->interp
),
106 Jim_AppendStrings(goi
->interp
,
107 Jim_GetResult(goi
->interp
),
109 rtos_types
[x
]->name
,NULL
);
116 target
->rtos
= calloc(1,sizeof(struct rtos
));
117 target
->rtos
->type
= rtos_types
[x
];
118 target
->rtos
->current_thread
= 0;
119 target
->rtos
->symbols
= NULL
;
120 target
->rtos
->target
= target
;
121 /* put default thread handler in linux usecase it is overloaded*/
122 target
->rtos
->gdb_thread_packet
= rtos_thread_packet
;
124 if ( 0 != strcmp( cp
, "auto") )
126 target
->rtos
->type
->create( target
);
132 int gdb_thread_packet(struct connection
*connection
, char *packet
, int packet_size
)
134 struct target
*target
= get_target_from_connection(connection
);
135 if (target
->rtos
== NULL
)
136 return rtos_thread_packet(connection
, packet
, packet_size
); /* thread not found*/
137 return target
->rtos
->gdb_thread_packet(connection
, packet
, packet_size
);
143 int rtos_thread_packet(struct connection
*connection
, char *packet
, int packet_size
)
145 struct target
*target
= get_target_from_connection(connection
);
147 if (strstr(packet
, "qThreadExtraInfo,"))
149 if ((target
->rtos
!= NULL
) && (target
->rtos
->thread_details
!= NULL
) && (target
->rtos
->thread_count
!= 0))
151 threadid_t threadid
= 0;
153 sscanf(packet
, "qThreadExtraInfo,%" SCNx64
, &threadid
);
155 if ((target
->rtos
!= NULL
) && (target
->rtos
->thread_details
158 for (thread_num
= 0; thread_num
159 < target
->rtos
->thread_count
; thread_num
++) {
160 if (target
->rtos
->thread_details
[thread_num
].threadid
162 if (target
->rtos
->thread_details
[thread_num
].exists
) {
169 gdb_put_packet(connection
, "E01", 3); // thread not found
173 struct thread_detail
* detail
= &target
->rtos
->thread_details
[found
];
176 if ( detail
->display_str
!= NULL
)
178 str_size
+= strlen(detail
->display_str
);
180 if ( detail
->thread_name_str
!= NULL
)
182 str_size
+= strlen(detail
->thread_name_str
);
184 if ( detail
->extra_info_str
!= NULL
)
186 str_size
+= strlen(detail
->extra_info_str
);
189 char * tmp_str
= (char*) malloc( str_size
+ 7 );
190 char* tmp_str_ptr
= tmp_str
;
192 if ( detail
->display_str
!= NULL
)
194 tmp_str_ptr
+= sprintf( tmp_str_ptr
, "%s", detail
->display_str
);
196 if ( detail
->thread_name_str
!= NULL
)
198 if ( tmp_str_ptr
!= tmp_str
)
200 tmp_str_ptr
+= sprintf( tmp_str_ptr
, " : " );
202 tmp_str_ptr
+= sprintf( tmp_str_ptr
, "%s", detail
->thread_name_str
);
204 if ( detail
->extra_info_str
!= NULL
)
206 if ( tmp_str_ptr
!= tmp_str
)
208 tmp_str_ptr
+= sprintf( tmp_str_ptr
, " : " );
210 tmp_str_ptr
+= sprintf( tmp_str_ptr
, " : %s", detail
->extra_info_str
);
213 assert(strlen(tmp_str
) ==
214 (size_t) (tmp_str_ptr
- tmp_str
));
216 char * hex_str
= (char*) malloc( strlen(tmp_str
)*2 +1 );
217 str_to_hex( hex_str
, tmp_str
);
219 gdb_put_packet(connection
, hex_str
, strlen(hex_str
));
225 gdb_put_packet(connection
, "", 0);
228 else if (strstr(packet
, "qSymbol"))
230 if ( target
->rtos
!= NULL
)
232 int next_symbol_num
= -1;
233 if (target
->rtos
->symbols
== NULL
)
235 target
->rtos
->type
->get_symbol_list_to_lookup( &target
->rtos
->symbols
);
237 if (0 == strcmp( "qSymbol::", packet
) )
245 char * hex_name_str
= malloc( strlen(packet
));
249 char* found
= strstr( packet
, "qSymbol::" );
252 sscanf(packet
, "qSymbol:%" SCNx64
":%s", &value
, hex_name_str
);
256 // No value returned by GDB - symbol was not found
257 sscanf(packet
, "qSymbol::%s", hex_name_str
);
259 name_str
= (char*) malloc( 1+ strlen(hex_name_str
) / 2 );
261 hex_to_str( name_str
, hex_name_str
);
265 while ( ( target
->rtos
->symbols
[ symbol_num
].symbol_name
!= NULL
) && ( 0 != strcmp( target
->rtos
->symbols
[ symbol_num
].symbol_name
, name_str
) ) )
271 if ( target
->rtos
->symbols
[ symbol_num
].symbol_name
== NULL
)
273 LOG_OUTPUT("ERROR: unknown symbol\r\n");
274 gdb_put_packet(connection
, "OK", 2);
278 target
->rtos
->symbols
[ symbol_num
].address
= value
;
280 next_symbol_num
= symbol_num
+1;
281 free( hex_name_str
);
286 int symbols_done
= 0;
287 if ( target
->rtos
->symbols
[ next_symbol_num
].symbol_name
== NULL
)
289 if ( ( target
->rtos_auto_detect
== false ) ||
290 ( 1 == target
->rtos
->type
->detect_rtos( target
) ) )
292 // Found correct RTOS or not autodetecting
293 if ( target
->rtos_auto_detect
== true )
295 LOG_OUTPUT( "Auto-detected RTOS: %s\r\n",target
->rtos
->type
->name
);
301 // Auto detecting RTOS and currently not found
302 if( 1 != rtos_try_next( target
) )
304 // No more RTOS's to try
310 target
->rtos
->type
->get_symbol_list_to_lookup( &target
->rtos
->symbols
);
317 if ( symbols_done
== 1 )
319 target
->rtos_auto_detect
= false;
320 target
->rtos
->type
->create( target
);
321 target
->rtos
->type
->update_threads(target
->rtos
);
322 // No more symbols needed
323 gdb_put_packet(connection
, "OK", 2);
329 char* symname
= target
->rtos
->symbols
[ next_symbol_num
].symbol_name
;
330 char qsymstr
[] = "qSymbol:";
331 char * opstring
= (char*)malloc(sizeof(qsymstr
)+strlen(symname
)*2+1);
332 char * posptr
= opstring
;
333 posptr
+= sprintf( posptr
, "%s", qsymstr
);
334 str_to_hex( posptr
, symname
);
335 gdb_put_packet(connection
, opstring
, strlen(opstring
));
341 gdb_put_packet(connection
, "OK", 2);
344 else if (strstr(packet
, "qfThreadInfo"))
347 if ( ( target
->rtos
!= NULL
) && ( target
->rtos
->thread_count
!= 0 ) )
350 char* out_str
= (char*) malloc(17 * target
->rtos
->thread_count
+ 5);
351 char* tmp_str
= out_str
;
352 tmp_str
+= sprintf(tmp_str
, "m");
353 for (i
= 0; i
< target
->rtos
->thread_count
; i
++) {
355 tmp_str
+= sprintf(tmp_str
, ",");
357 tmp_str
+= sprintf(tmp_str
, "%016" PRIx64
,
358 target
->rtos
->thread_details
[i
].threadid
);
361 gdb_put_packet(connection
, out_str
, strlen(out_str
));
365 gdb_put_packet(connection
, "", 0);
370 else if (strstr(packet
, "qsThreadInfo"))
372 gdb_put_packet(connection
, "l", 1);
375 else if (strstr(packet
, "qAttached"))
377 gdb_put_packet(connection
, "1", 1);
380 else if (strstr(packet
, "qOffsets"))
382 char offsets
[] = "Text=0;Data=0;Bss=0";
383 gdb_put_packet(connection
, offsets
, sizeof(offsets
)-1);
386 else if (strstr(packet
, "qC"))
388 if( target
->rtos
!=NULL
)
392 size
= snprintf(buffer
, 15, "QC%08X", (int)target
->rtos
->current_thread
);
393 gdb_put_packet(connection
, buffer
, size
);
397 gdb_put_packet(connection
, "QC0", 3);
401 else if ( packet
[0] == 'T' ) // Is thread alive?
405 sscanf(packet
, "T%" SCNx64
, &threadid
);
406 if ((target
->rtos
!= NULL
) && (target
->rtos
->thread_details
409 for (thread_num
= 0; thread_num
410 < target
->rtos
->thread_count
; thread_num
++) {
411 if (target
->rtos
->thread_details
[thread_num
].threadid
413 if (target
->rtos
->thread_details
[thread_num
].exists
) {
420 gdb_put_packet(connection
, "OK", 2); // thread alive
422 gdb_put_packet(connection
, "E01", 3); // thread not found
426 else if ( packet
[0] == 'H') // Set current thread ( 'c' for step and continue, 'g' for all other operations )
428 if ((packet
[1] == 'g') && (target
->rtos
!= NULL
))
429 sscanf(packet
, "Hg%16" SCNx64
, ¤t_threadid
);
430 gdb_put_packet(connection
, "OK", 2);
434 return GDB_THREAD_PACKET_NOT_CONSUMED
;
437 int rtos_get_gdb_reg_list(struct connection
*connection
)
439 struct target
*target
= get_target_from_connection(connection
);
441 if ( ( target
->rtos
!= NULL
) &&
442 ( current_threadid
!= -1 ) &&
443 ( current_threadid
!= 0 ) &&
444 ( current_threadid
!= target
->rtos
->current_thread
) )
447 target
->rtos
->type
->get_thread_reg_list( target
->rtos
, current_threadid
, &hex_reg_list
);
449 if ( hex_reg_list
!= NULL
)
451 gdb_put_packet(connection
, hex_reg_list
, strlen(hex_reg_list
));
461 int rtos_generic_stack_read( struct target
* target
, const struct rtos_register_stacking
* stacking
, int64_t stack_ptr
, char ** hex_reg_list
)
465 int64_t new_stack_ptr
;
471 LOG_OUTPUT("Error: null stack pointer in thread\r\n");
475 uint8_t * stack_data
= (uint8_t*) malloc( stacking
->stack_registers_size
);
476 uint32_t address
= stack_ptr
;
478 if ( stacking
->stack_growth_direction
== 1 )
480 address
-= stacking
->stack_registers_size
;
482 retval
= target_read_buffer( target
, address
, stacking
->stack_registers_size
, stack_data
);
483 if ( retval
!= ERROR_OK
)
485 LOG_OUTPUT("Error reading stack frame from FreeRTOS thread\r\n");
489 LOG_OUTPUT("Stack Data :");
490 for(i = 0; i < stacking->stack_registers_size; i++ )
492 LOG_OUTPUT("%02X",stack_data[i]);
496 for( i
= 0; i
< stacking
->num_output_registers
; i
++ )
498 list_size
+= stacking
->register_offsets
[i
].width_bits
/8;
500 *hex_reg_list
= (char*)malloc( list_size
*2 +1 );
501 tmp_str_ptr
= *hex_reg_list
;
502 new_stack_ptr
= stack_ptr
- stacking
->stack_growth_direction
* stacking
->stack_registers_size
;
503 if (stacking
->stack_alignment
!= 0) {
504 /* Align new stack pointer to x byte boundary */
506 (new_stack_ptr
& (~((int64_t) stacking
->stack_alignment
- 1))) +
507 ((stacking
->stack_growth_direction
== -1) ? stacking
->stack_alignment
: 0);
509 for( i
= 0; i
< stacking
->num_output_registers
; i
++ )
512 for ( j
= 0; j
< stacking
->register_offsets
[i
].width_bits
/8; j
++ )
514 if ( stacking
->register_offsets
[i
].offset
== -1 )
516 tmp_str_ptr
+= sprintf( tmp_str_ptr
, "%02x", 0 );
518 else if ( stacking
->register_offsets
[i
].offset
== -2 )
520 tmp_str_ptr
+= sprintf( tmp_str_ptr
, "%02x", ((uint8_t*)&new_stack_ptr
)[j
] );
524 tmp_str_ptr
+= sprintf( tmp_str_ptr
,"%02x", stack_data
[ stacking
->register_offsets
[i
].offset
+ j
] );
528 // LOG_OUTPUT("Output register string: %s\r\n", *hex_reg_list);
532 int rtos_try_next( struct target
* target
)
536 if ( target
->rtos
== NULL
)
541 for (x
= 0 ; rtos_types
[x
] ; x
++) {
542 if (target
->rtos
->type
== rtos_types
[x
] ) {
544 if ( rtos_types
[x
+1] != NULL
)
546 target
->rtos
->type
= rtos_types
[x
+1];
547 if ( target
->rtos
->symbols
!= NULL
)
549 free( target
->rtos
->symbols
);
555 // No more rtos types
565 static void hex_to_str( char* dst
, char * hex_src
)
570 while ( hex_src
[src_pos
] != '\x00' )
572 char hex_char
= hex_src
[src_pos
];
573 char hex_digit_val
= (hex_char
>='a')?hex_char
-'a'+10:(hex_char
>='A')?hex_char
-'A'+10:hex_char
-'0';
574 if ( 0 == (src_pos
& 0x01) )
576 dst
[dst_pos
] = hex_digit_val
;
581 ((unsigned char*)dst
)[dst_pos
] <<= 4;
582 ((unsigned char*)dst
)[dst_pos
] += hex_digit_val
;
590 static int str_to_hex( char* hex_dst
, char* src
)
592 char * posptr
= hex_dst
;
594 for( i
= 0; i
< strlen(src
); i
++)
596 posptr
+= sprintf( posptr
, "%02x", (unsigned char)src
[i
] );
598 return (posptr
-hex_dst
);
602 int rtos_update_threads( struct target
* target
)
604 if ((target
->rtos
!= NULL
) && (target
->rtos
->type
!= NULL
))
606 target
->rtos
->type
->update_threads(target
->rtos
);
Linking to existing account procedure
If you already have an account and want to add another login method
you
MUST first sign in with your existing account and
then change URL to read
https://review.openocd.org/login/?link
to get to this page again but this time it'll work for linking. Thank you.
SSH host keys fingerprints
1024 SHA256:YKx8b7u5ZWdcbp7/4AeXNaqElP49m6QrwfXaqQGJAOk gerrit-code-review@openocd.zylin.com (DSA)
384 SHA256:jHIbSQa4REvwCFG4cq5LBlBLxmxSqelQPem/EXIrxjk gerrit-code-review@openocd.org (ECDSA)
521 SHA256:UAOPYkU9Fjtcao0Ul/Rrlnj/OsQvt+pgdYSZ4jOYdgs gerrit-code-review@openocd.org (ECDSA)
256 SHA256:A13M5QlnozFOvTllybRZH6vm7iSt0XLxbA48yfc2yfY gerrit-code-review@openocd.org (ECDSA)
256 SHA256:spYMBqEYoAOtK7yZBrcwE8ZpYt6b68Cfh9yEVetvbXg gerrit-code-review@openocd.org (ED25519)
+--[ED25519 256]--+
|=.. |
|+o.. . |
|*.o . . |
|+B . . . |
|Bo. = o S |
|Oo.+ + = |
|oB=.* = . o |
| =+=.+ + E |
|. .=o . o |
+----[SHA256]-----+
2048 SHA256:0Onrb7/PHjpo6iVZ7xQX2riKN83FJ3KGU0TvI0TaFG4 gerrit-code-review@openocd.zylin.com (RSA)