stationary_windowed.h

Go to the documentation of this file.

 
#ifndef INFUSE_SDK_INCLUDE_INFUSE_ALGORITHM_RUNNER_ALGORITHMS_STATIONARY_WINDOWED_H_
#define INFUSE_SDK_INCLUDE_INFUSE_ALGORITHM_RUNNER_ALGORITHMS_STATIONARY_WINDOWED_H_
 
#include <stdint.h>
 
#include <zephyr/toolchain.h>
 
#include <infuse/algorithm_runner/runner.h>
#include <infuse/math/statistics.h>
#include <infuse/zbus/channels.h>
 
#ifdef __cplusplus
extern "C" {
#endif

 
enum {
        ALGORITHM_STATIONARY_WINDOWED_LOG_WINDOW_STD_DEV = BIT(0),
};
 
/* Algorithm runtime state */
struct algorithm_stationary_windowed_data {
        struct statistics_state stats;
        uint32_t window_end;
};

void algorithm_stationary_windowed_fn(const struct zbus_channel *chan,
                                      const struct infuse_algorithm *algorithm, const void *args,
                                      void *data);

#define ALGORITHM_STATIONARY_WINDOWED_DEFINE(name, loggers_, tdfs, window_seconds_, threshold_ug)  \
        static void name##_wrapper(const struct zbus_channel *chan,                                \
                                   const struct infuse_algorithm *algorithm, const void *args)     \
        {                                                                                          \
                static struct algorithm_stationary_windowed_data data;                             \
                algorithm_stationary_windowed_fn(chan, algorithm, args, &data);                    \
        }                                                                                          \
        static struct kv_alg_stationary_windowed_args name##_default_args = {                      \
                .logging =                                                                         \
                        {                                                                          \
                                .loggers = loggers_,                                               \
                                .tdf_mask = tdfs,                                                  \
                        },                                                                         \
                .args =                                                                            \
                        {                                                                          \
                                .window_seconds = window_seconds_,                                 \
                                .std_dev_threshold_ug = threshold_ug,                              \
                        },                                                                         \
        };                                                                                         \
        static const struct infuse_algorithm name = {                                              \
                .fn = name##_wrapper,                                                              \
                .algorithm_id = 0x15F20000,                                                        \
                .zbus_channel = INFUSE_ZBUS_CHAN_IMU_ACC_MAG,                                      \
                .arguments = &name##_default_args,                                                 \
                .arguments_size = sizeof(struct kv_alg_stationary_windowed_args),                  \
                .arguments_kv_key = KV_KEY_ALG_STATIONARY_WINDOWED_ARGS,                           \
        }

 
#ifdef __cplusplus
}
#endif
 
#endif /* INFUSE_SDK_INCLUDE_INFUSE_ALGORITHM_RUNNER_ALGORITHMS_STATIONARY_WINDOWED_H_ */