diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2015-01-07 18:19:23 +0100 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2015-01-11 11:03:56 +0100 |
commit | 172dbf37070e2dccadc8779d6e0926d3f8d60706 (patch) | |
tree | 3f95531b4bdc372c55c2e23d165a9bec8bb682e4 /src/modules/systemlib/perf_counter.c | |
parent | 4712c75dea935b5709c944b31ae670dd6879f2e9 (diff) | |
download | px4-firmware-172dbf37070e2dccadc8779d6e0926d3f8d60706.tar.gz px4-firmware-172dbf37070e2dccadc8779d6e0926d3f8d60706.tar.bz2 px4-firmware-172dbf37070e2dccadc8779d6e0926d3f8d60706.zip |
Performance counters: Add option to set otherwise estimated time interval
Diffstat (limited to 'src/modules/systemlib/perf_counter.c')
-rw-r--r-- | src/modules/systemlib/perf_counter.c | 40 |
1 files changed, 40 insertions, 0 deletions
diff --git a/src/modules/systemlib/perf_counter.c b/src/modules/systemlib/perf_counter.c index 350c74d8a..4d62db0ee 100644 --- a/src/modules/systemlib/perf_counter.c +++ b/src/modules/systemlib/perf_counter.c @@ -273,6 +273,46 @@ perf_end(perf_counter_t handle) } void +perf_set(perf_counter_t handle, int64_t elapsed) +{ + if (handle == NULL) + return; + + switch (handle->type) { + case PC_ELAPSED: { + struct perf_ctr_elapsed *pce = (struct perf_ctr_elapsed *)handle; + + if (elapsed < 0) { + pce->event_overruns++; + } else { + + pce->event_count++; + pce->time_total += elapsed; + + if ((pce->time_least > (uint64_t)elapsed) || (pce->time_least == 0)) + pce->time_least = elapsed; + + if (pce->time_most < (uint64_t)elapsed) + pce->time_most = elapsed; + + // maintain mean and variance of the elapsed time in seconds + // Knuth/Welford recursive mean and variance of update intervals (via Wikipedia) + float dt = elapsed / 1e6f; + float delta_intvl = dt - pce->mean; + pce->mean += delta_intvl / pce->event_count; + pce->M2 += delta_intvl * (dt - pce->mean); + + pce->time_start = 0; + } + } + break; + + default: + break; + } +} + +void perf_cancel(perf_counter_t handle) { if (handle == NULL) |