--- a/targets/plc_debug.c Tue Nov 30 09:52:42 2021 +0100
+++ b/targets/plc_debug.c Wed Dec 01 09:54:02 2021 +0100
@@ -26,18 +26,31 @@
#ifndef TARGET_ONLINE_DEBUG_DISABLE
-#define BUFFER_SIZE %(buffer_size)d
+#define TRACE_BUFFER_SIZE 4096 +#define TRACE_LIST_SIZE 1024 /* Atomically accessed variable for buffer state */
-static long buffer_state = BUFFER_FREE;
+static long trace_buffer_state = BUFFER_FREE; +typedef unsigned int dbgvardsc_index_t; +typedef unsigned short trace_buf_offset_t;
-char debug_buffer[BUFFER_SIZE];
+typedef struct trace_item_s { + dbgvardsc_index_t dbgvardsc_index; +trace_item_t trace_list[TRACE_LIST_SIZE]; +char trace_buffer[TRACE_BUFFER_SIZE]; -static char* buffer_cursor = debug_buffer;
+static trace_item_t *trace_list_collect_cursor = trace_list; +static trace_item_t *trace_list_addvar_cursor = trace_list; +static const trace_item_t *trace_list_end = + &trace_list[TRACE_LIST_SIZE-1]; +static char *trace_buffer_cursor = trace_buffer; +static const char *trace_buffer_end = trace_buffer + TRACE_BUFFER_SIZE; static unsigned int retain_offset = 0;
@@ -101,8 +114,10 @@
/* init local static vars */
#ifndef TARGET_ONLINE_DEBUG_DISABLE
- buffer_cursor = debug_buffer;
- buffer_state = BUFFER_FREE;
+ trace_buffer_cursor = trace_buffer; + trace_list_addvar_cursor = trace_list; + trace_list_collect_cursor = trace_list; + trace_buffer_state = BUFFER_FREE; @@ -125,7 +140,7 @@
void __cleanup_debug(void)
#ifndef TARGET_ONLINE_DEBUG_DISABLE
- buffer_cursor = debug_buffer;
+ trace_buffer_cursor = trace_buffer; @@ -147,30 +162,18 @@
visible_value_p = UnpackVar(dsc, &real_value_p, &flags);
- if(flags & ( __IEC_DEBUG_FLAG | __IEC_RETAIN_FLAG)){
+ if(flags & __IEC_RETAIN_FLAG || + ((flags & __IEC_FORCE_FLAG) && (flags & __IEC_OUTPUT_FLAG))){ USINT size = __get_type_enum_size(dsc->type);
#ifndef TARGET_ONLINE_DEBUG_DISABLE
- if(flags & __IEC_DEBUG_FLAG){
- /* copy visible variable to buffer */;
- /* compute next cursor positon.
- No need to check overflow, as BUFFER_SIZE
- is computed large enough */
- if(__Is_a_string(dsc)){
- /* optimization for strings */
- size = ((STRING*)visible_value_p)->len + 1;
- char* next_cursor = buffer_cursor + size;
- /* copy data to the buffer */
- memcpy(buffer_cursor, visible_value_p, size);
- /* increment cursor according size*/
- buffer_cursor = next_cursor;
+ if((flags & __IEC_FORCE_FLAG) && (flags & __IEC_OUTPUT_FLAG)){ + if(__Is_a_string(dsc)){ + /* optimization for strings */ + size = ((STRING*)visible_value_p)->len + 1; /* re-force real value of outputs (M and Q)*/
- if((flags & __IEC_FORCE_FLAG) && (flags & __IEC_OUTPUT_FLAG)){
- memcpy(real_value_p, visible_value_p, size);
+ memcpy(real_value_p, visible_value_p, size); @@ -236,7 +239,7 @@
if(TryEnterDebugSection()){
long latest_state = AtomicCompareExchange(
@@ -244,74 +247,105 @@
if(latest_state == BUFFER_FREE)
/* Reset buffer cursor */
- buffer_cursor = debug_buffer;
+ trace_buffer_cursor = trace_buffer; + /* Reset trace list cursor */ + trace_list_collect_cursor = trace_list; /* Iterate over all variables to fill debug buffer */
__for_each_variable_do(DebugIterator);
+ while(trace_list_collect_cursor < trace_list_addvar_cursor){ + void *real_value_p = NULL; + void *visible_value_p = NULL; + dbgvardsc_t *dsc = &dbgvardsc[ + trace_list_collect_cursor->dbgvardsc_index]; + visible_value_p = UnpackVar(dsc, &real_value_p, &flags); + /* copy visible variable to buffer */; + if(__Is_a_string(dsc)){ + /* optimization for strings */ + /* assume NULL terminated strings */ + size = ((STRING*)visible_value_p)->len + 1; + size = __get_type_enum_size(dsc->type); + /* compute next cursor positon.*/ + next_cursor = trace_buffer_cursor + size; + /* check for buffer overflow */ + if(next_cursor < trace_buffer_end) + /* copy data to the buffer */ + memcpy(trace_buffer_cursor, visible_value_p, size); + /* stop looping in case of overflow */ + /* increment cursor according size*/ + trace_buffer_cursor = next_cursor; + trace_list_collect_cursor++; * Trigger asynchronous transmission
* (returns immediately) */
InitiateDebugTransfer(); /* size */
- /* when not debugging, do only retain */
- __for_each_variable_do(RetainIterator);
- /* when not debugging, do only retain */
- __for_each_variable_do(RetainIterator);
+ /* when not debugging, do only retain */ + __for_each_variable_do(RetainIterator); #ifndef TARGET_ONLINE_DEBUG_DISABLE
#define __RegisterDebugVariable_case_t(TYPENAME) \
- ((__IEC_##TYPENAME##_t *)varp)->flags |= flags;\
- ((__IEC_##TYPENAME##_t *)varp)->value = *((TYPENAME *)force);\
+ ((__IEC_##TYPENAME##_t *)varp)->flags |= __IEC_FORCE_FLAG;\ + ((__IEC_##TYPENAME##_t *)varp)->value = *((TYPENAME *)force);\ #define __RegisterDebugVariable_case_p(TYPENAME)\
case TYPENAME##_P_ENUM :\
- ((__IEC_##TYPENAME##_p *)varp)->flags |= flags;\
- ((__IEC_##TYPENAME##_p *)varp)->fvalue = *((TYPENAME *)force);\
+ ((__IEC_##TYPENAME##_p *)varp)->flags |= __IEC_FORCE_FLAG;\ + ((__IEC_##TYPENAME##_p *)varp)->fvalue = *((TYPENAME *)force);\ case TYPENAME##_O_ENUM :\
- ((__IEC_##TYPENAME##_p *)varp)->flags |= flags;\
- ((__IEC_##TYPENAME##_p *)varp)->fvalue = *((TYPENAME *)force);\
- *(((__IEC_##TYPENAME##_p *)varp)->value) = *((TYPENAME *)force);\
+ ((__IEC_##TYPENAME##_p *)varp)->flags |= __IEC_FORCE_FLAG;\ + ((__IEC_##TYPENAME##_p *)varp)->fvalue = *((TYPENAME *)force);\ + *(((__IEC_##TYPENAME##_p *)varp)->value) = *((TYPENAME *)force);\ -void RegisterDebugVariable(unsigned int idx, void* force)
+void RegisterDebugVariable(dbgvardsc_index_t idx, void* force) - if(idx < sizeof(dbgvardsc)/sizeof(dbgvardsc_t)){
- unsigned char flags = force ?
- __IEC_DEBUG_FLAG | __IEC_FORCE_FLAG :
- dbgvardsc_t *dsc = &dbgvardsc[idx];
- __ANY(__RegisterDebugVariable_case_t)
- __ANY(__RegisterDebugVariable_case_p)
+ if(idx < sizeof(dbgvardsc)/sizeof(dbgvardsc_t)){ + /* add to trace_list, inc tracelist_addvar_cursor*/ + if(trace_list_addvar_cursor <= trace_list_end){ + trace_list_addvar_cursor->dbgvardsc_index = idx; + trace_list_addvar_cursor++; + dbgvardsc_t *dsc = &dbgvardsc[idx]; + __ANY(__RegisterDebugVariable_case_t) + __ANY(__RegisterDebugVariable_case_p) #define __ResetDebugVariablesIterator_case_t(TYPENAME) \
- ((__IEC_##TYPENAME##_t *)varp)->flags &= ~(__IEC_DEBUG_FLAG|__IEC_FORCE_FLAG);\
+ ((__IEC_##TYPENAME##_t *)varp)->flags &= ~(__IEC_FORCE_FLAG);\ #define __ResetDebugVariablesIterator_case_p(TYPENAME)\
case TYPENAME##_P_ENUM :\
case TYPENAME##_O_ENUM :\
- ((__IEC_##TYPENAME##_p *)varp)->flags &= ~(__IEC_DEBUG_FLAG|__IEC_FORCE_FLAG);\
+ ((__IEC_##TYPENAME##_p *)varp)->flags &= ~(__IEC_FORCE_FLAG);\ void ResetDebugVariablesIterator(dbgvardsc_t *dsc)
@@ -328,6 +362,7 @@
void ResetDebugVariables(void)
+ trace_list_addvar_cursor = trace_list; __for_each_variable_do(ResetDebugVariablesIterator);
@@ -335,7 +370,7 @@
/* atomically mark buffer as free */
@@ -344,8 +379,8 @@
int GetDebugData(unsigned long *tick, unsigned long *size, void **buffer){
int wait_error = WaitDebugData(tick);
- *size = buffer_cursor - debug_buffer;
- *buffer = debug_buffer;
+ *size = trace_buffer_cursor - trace_buffer; + *buffer = trace_buffer;