|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
Paparazzi specific wrapper to run MLKF filter. More...
#include "modules/ahrs/ahrs_float_mlkf_wrapper.h"#include "modules/ahrs/ahrs.h"#include "modules/core/abi.h"#include "state.h"#include "modules/datalink/telemetry.h"#include "mcu_periph/sys_time.h"Go to the source code of this file.
Macros | |
| #define | AHRS_MLKF_IMU_ID ABI_BROADCAST |
| ABI binding for IMU data. | |
| #define | AHRS_MLKF_MAG_ID AHRS_MLKF_IMU_ID |
| ABI binding for magnetometer data. | |
Functions | |
| static void | set_body_state_from_quat (void) |
| Compute body orientation and rates from imu orientation and rates. | |
| static void | send_euler (struct transport_tx *trans, struct link_device *dev) |
| static void | send_bias (struct transport_tx *trans, struct link_device *dev) |
| static void | send_geo_mag (struct transport_tx *trans, struct link_device *dev) |
| static void | send_filter_status (struct transport_tx *trans, struct link_device *dev) |
| static void | gyro_cb (uint8_t sender_id, uint32_t stamp, struct Int32Rates *gyro) |
| static void | accel_cb (uint8_t sender_id, uint32_t stamp, struct Int32Vect3 *accel) |
| static void | mag_cb (uint8_t sender_id, uint32_t stamp, struct Int32Vect3 *mag) |
| static void | aligner_cb (uint8_t sender_id, uint32_t stamp, struct Int32Rates *lp_gyro, struct Int32Vect3 *lp_accel, struct Int32Vect3 *lp_mag) |
| static void | geo_mag_cb (uint8_t sender_id, struct FloatVect3 *h) |
| void | ahrs_mlkf_wrapper_init (void) |
| void | ahrs_float_mlkf_wrapper_enable (uint8_t enable) |
Variables | |
| uint8_t | ahrs_mlkf_enable |
| static uint32_t | ahrs_mlkf_last_stamp |
| static uint8_t | ahrs_mlkf_id = AHRS_COMP_ID_MLKF |
| static abi_event | gyro_ev |
| static abi_event | accel_ev |
| static abi_event | mag_ev |
| static abi_event | aligner_ev |
| static abi_event | geo_mag_ev |
Paparazzi specific wrapper to run MLKF filter.
Definition in file ahrs_float_mlkf_wrapper.c.
| #define AHRS_MLKF_IMU_ID ABI_BROADCAST |
ABI binding for IMU data.
Used for gyro, accel ABI messages.
Definition at line 87 of file ahrs_float_mlkf_wrapper.c.
Referenced by ahrs_mlkf_wrapper_init().
| #define AHRS_MLKF_MAG_ID AHRS_MLKF_IMU_ID |
ABI binding for magnetometer data.
Used for IMU_MAG_INT32 ABI messages.
Definition at line 94 of file ahrs_float_mlkf_wrapper.c.
Referenced by ahrs_mlkf_wrapper_init().
|
static |
Definition at line 133 of file ahrs_float_mlkf_wrapper.c.
References ACCELS_FLOAT_OF_BFP, ahrs_mlkf, ahrs_mlkf_update_accel(), and set_body_state_from_quat().
| void ahrs_float_mlkf_wrapper_enable | ( | uint8_t | enable | ) |
Definition at line 218 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf_enable, STATE_INPUT_ATTITUDE, STATE_INPUT_RATES, and stateSetInputFilter().
Referenced by ahrs_mlkf_wrapper_init().
| void ahrs_mlkf_wrapper_init | ( | void | ) |
Definition at line 192 of file ahrs_float_mlkf_wrapper.c.
References ABI_BROADCAST, accel_cb(), accel_ev, ahrs_float_mlkf_wrapper_enable(), AHRS_MLKF_IMU_ID, ahrs_mlkf_init(), AHRS_MLKF_MAG_ID, AHRS_PRIMARY, aligner_cb(), aligner_ev, DefaultPeriodic, geo_mag_cb(), geo_mag_ev, gyro_cb(), gyro_ev, mag_cb(), mag_ev, register_periodic_telemetry(), send_bias(), send_euler(), send_filter_status(), and send_geo_mag().
|
static |
Definition at line 157 of file ahrs_float_mlkf_wrapper.c.
References ACCELS_FLOAT_OF_BFP, ahrs_mlkf, ahrs_mlkf_align(), MAGS_FLOAT_OF_BFP, RATES_FLOAT_OF_BFP, and set_body_state_from_quat().
|
static |
Definition at line 177 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf, and h().
|
static |
Definition at line 104 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf, ahrs_mlkf_last_stamp, ahrs_mlkf_propagate(), AHRS_MLKF_RUNNING, AHRS_PROPAGATE_FREQUENCY, gyro_cb(), PRINT_CONFIG_MSG(), PRINT_CONFIG_VAR(), RATES_FLOAT_OF_BFP, and set_body_state_from_quat().
|
static |
Definition at line 145 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf, ahrs_mlkf_update_mag(), MAGS_FLOAT_OF_BFP, and set_body_state_from_quat().
|
static |
Definition at line 56 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf, ahrs_mlkf_id, dev, Int32Rates::p, Int32Rates::q, Int32Rates::r, and RATES_BFP_OF_REAL.
|
static |
Definition at line 45 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf, ahrs_mlkf_id, dev, float_eulers_of_quat(), FloatEulers::phi, FloatEulers::psi, and FloatEulers::theta.
|
static |
Definition at line 70 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf, ahrs_mlkf_id, ahrs_mlkf_last_stamp, dev, get_sys_time_usec(), and val.
|
static |
Definition at line 64 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf, ahrs_mlkf_id, and dev.
|
static |
Compute body orientation and rates from imu orientation and rates.
Definition at line 185 of file ahrs_float_mlkf_wrapper.c.
References ahrs_mlkf, stateSetBodyRates_f(), and stateSetNedToBodyQuat_f().
Referenced by accel_cb(), aligner_cb(), gyro_cb(), and mag_cb().
|
static |
Definition at line 98 of file ahrs_float_mlkf_wrapper.c.
| uint8_t ahrs_mlkf_enable |
Definition at line 35 of file ahrs_float_mlkf_wrapper.c.
Referenced by ahrs_float_mlkf_wrapper_enable().
|
static |
Definition at line 37 of file ahrs_float_mlkf_wrapper.c.
Referenced by send_bias(), send_euler(), send_filter_status(), and send_geo_mag().
|
static |
Definition at line 36 of file ahrs_float_mlkf_wrapper.c.
Referenced by gyro_cb(), and send_filter_status().
|
static |
Definition at line 100 of file ahrs_float_mlkf_wrapper.c.
|
static |
Definition at line 101 of file ahrs_float_mlkf_wrapper.c.
|
static |
Definition at line 97 of file ahrs_float_mlkf_wrapper.c.
|
static |
Definition at line 99 of file ahrs_float_mlkf_wrapper.c.