madgwick.h

Go to the documentation of this file.

/*
 * Copyright (c) 2021 Kevin Townsend
 *
 * SPDX-License-Identifier: Apache-2.0
 */
 
#ifndef ZEPHYR_INCLUDE_ZSL_FUSION_MADGWICK_H_
#define ZEPHYR_INCLUDE_ZSL_FUSION_MADGWICK_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://www.x-io.co.uk/res/doc/madgwick_internal_report.pdf */
 
struct zsl_fus_madg_cfg {
    zsl_real_t beta;
};
 
int zsl_fus_madg_init(uint32_t freq, void *cfg);
 
int zsl_fus_madg_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_madg_error(int error);
 
#ifdef __cplusplus
}
#endif
 
#endif /* ZEPHYR_INCLUDE_ZSL_FUSION_MADGWICK_H_ */
 /* End of algorithms group */