diff --git a/Software/Core/Src/main.c b/Software/Core/Src/main.c index 35a5f1e..3cbfac3 100644 --- a/Software/Core/Src/main.c +++ b/Software/Core/Src/main.c @@ -136,6 +136,15 @@ void loop_1kHz() { // overwrite oldest history entry with new value and reset counter wss_flanks_history[signal->channel][oldest_hist_idx] = wss_flanks[signal->channel]; wss_flanks[signal->channel] = 0; + // add new counter to avg + wss_flanks_avg[signal->channel] += wss_flanks_history[signal->channel][oldest_hist_idx]; + // increase / wrap around index + wss_flanks_history_idx[signal->channel]++; + if(wss_flanks_history_idx[signal->channel] >= WSS_HISTORY_SIZE) { + wss_flanks_history_idx[signal->channel] = 0; + } + // value = wss_flanks_avg[signal->channel] * (1000 / pktinfo->period / WSS_HISTORY_SIZE); + value = wss_flanks_avg[signal->channel]; break; default: