aqua.h

Go to the documentation of this file.

/*
 * Copyright (c) 2021 Marti Riba Pons
 *
 * SPDX-License-Identifier: Apache-2.0
 */
 
#ifndef ZEPHYR_INCLUDE_ZSL_FUSION_AQUA_H_
#define ZEPHYR_INCLUDE_ZSL_FUSION_AQUA_H_
 
#include <zsl/zsl.h>
#include <zsl/vectors.h>
#include <zsl/matrices.h>
#include <zsl/orientation/quaternions.h>
 
#ifdef __cplusplus
extern "C" {
#endif
 
/* Source:
 * https://res.mdpi.com/sensors/sensors-15-19302/article_deploy/sensors-15-19302.pdf
 */
 
struct zsl_fus_aqua_cfg {
    zsl_real_t alpha;
 
    zsl_real_t beta;
 
    zsl_real_t e_a;
 
    zsl_real_t e_m;
};
 
int zsl_fus_aqua_init(uint32_t freq, void *cfg);
 
int zsl_fus_aqua_feed(struct zsl_vec *a, struct zsl_vec *m,
              struct zsl_vec *g, zsl_real_t *incl, struct zsl_quat *q,
              void *cfg);
 
void zsl_fus_aqua_error(int error);
 
#ifdef __cplusplus
}
#endif
 
#endif /* ZEPHYR_INCLUDE_ZSL_FUSION_AQUA_H_ */
 /* End of algorithms group */