|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
Paparazzi specific wrapper to run floating point complementary filter. More...
#include "modules/ahrs/ahrs_float_cmpl_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_FC_IMU_ID ABI_BROADCAST |
| ABI binding for IMU data. | |
| #define | AHRS_FC_MAG_ID AHRS_FC_IMU_ID |
| ABI binding for magnetometer data. | |
| #define | AHRS_FC_GPS_ID GPS_MULTI_ID |
| ABI binding for gps data. | |
Functions | |
| static void | compute_body_orientation_and_rates (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_euler_int (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) |
| static void | gps_cb (uint8_t sender_id, uint32_t stamp, struct GpsState *gps_s) |
| void | ahrs_fc_wrapper_init (void) |
| void | ahrs_float_cmpl_wrapper_enable (uint8_t enable) |
Variables | |
| uint8_t | ahrs_fc_enable |
| if TRUE with push the estimation results to the state interface | |
| static uint32_t | ahrs_fc_last_stamp |
| static uint8_t | ahrs_fc_id = AHRS_COMP_ID_FC |
| 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 |
| static abi_event | gps_ev |
Paparazzi specific wrapper to run floating point complementary filter.
Definition in file ahrs_float_cmpl_wrapper.c.
| #define AHRS_FC_GPS_ID GPS_MULTI_ID |
ABI binding for gps data.
Used for GPS ABI messages.
Definition at line 121 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_fc_wrapper_init().
| #define AHRS_FC_IMU_ID ABI_BROADCAST |
ABI binding for IMU data.
Used for gyro and accel ABI messages.
Definition at line 107 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_fc_wrapper_init().
| #define AHRS_FC_MAG_ID AHRS_FC_IMU_ID |
ABI binding for magnetometer data.
Used for IMU_MAG_INT32 ABI messages.
Definition at line 114 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_fc_wrapper_init().
|
static |
Definition at line 161 of file ahrs_float_cmpl_wrapper.c.
References ACCELS_FLOAT_OF_BFP, ahrs_fc, ahrs_fc_update_accel(), PRINT_CONFIG_MSG(), and PRINT_CONFIG_VAR().
| void ahrs_fc_wrapper_init | ( | void | ) |
Definition at line 260 of file ahrs_float_cmpl_wrapper.c.
References ABI_BROADCAST, accel_cb(), accel_ev, AHRS_FC_GPS_ID, AHRS_FC_IMU_ID, ahrs_fc_init(), AHRS_FC_MAG_ID, ahrs_float_cmpl_wrapper_enable(), AHRS_PRIMARY, aligner_cb(), aligner_ev, DefaultPeriodic, geo_mag_cb(), geo_mag_ev, gps_cb(), gps_ev, gyro_cb(), gyro_ev, mag_cb(), mag_ev, register_periodic_telemetry(), send_bias(), send_euler(), send_euler_int(), send_filter_status(), and send_geo_mag().
| void ahrs_float_cmpl_wrapper_enable | ( | uint8_t | enable | ) |
Definition at line 288 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc_enable, STATE_INPUT_ATTITUDE, STATE_INPUT_RATES, and stateSetInputFilter().
Referenced by ahrs_fc_wrapper_init().
|
static |
Definition at line 211 of file ahrs_float_cmpl_wrapper.c.
References ACCELS_FLOAT_OF_BFP, ahrs_fc, ahrs_fc_align(), compute_body_orientation_and_rates(), MAGS_FLOAT_OF_BFP, and RATES_FLOAT_OF_BFP.
Referenced by ahrs_dcm_wrapper_init(), ahrs_fc_wrapper_init(), ahrs_finv_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_madgwick_wrapper_init(), ahrs_mlkf_wrapper_init(), ins_float_invariant_wrapper_init(), ins_flow_init(), and ins_mekf_wind_wrapper_init().
|
static |
Compute body orientation and rates from imu orientation and rates.
Definition at line 254 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc, stateSetBodyRates_f(), and stateSetNedToBodyQuat_f().
Referenced by aligner_cb(), gps_cb(), and gyro_cb().
|
static |
Definition at line 231 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_fc_wrapper_init(), ahrs_finv_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_mlkf_wrapper_init(), ins_float_invariant_wrapper_init(), and ins_mekf_wind_wrapper_init().
Definition at line 236 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc_update_gps(), and compute_body_orientation_and_rates().
Referenced by ahrs_dcm_wrapper_init(), ahrs_fc_wrapper_init(), ahrs_icq_wrapper_init(), gps_cb(), gps_cb(), gps_init(), ins_alt_float_init(), ins_ekf2_init(), ins_float_invariant_wrapper_init(), ins_flow_init(), ins_gps_passthrough_init(), ins_int_init(), ins_mekf_wind_wrapper_init(), ins_module_wrapper_init(), ins_xsens700_init(), ins_xsens_init(), intermcu_init(), and target_pos_init().
|
static |
Definition at line 132 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc, ahrs_fc_last_stamp, ahrs_fc_propagate(), AHRS_FC_RUNNING, AHRS_PROPAGATE_FREQUENCY, compute_body_orientation_and_rates(), gyro_cb(), PRINT_CONFIG_MSG(), PRINT_CONFIG_VAR(), and RATES_FLOAT_OF_BFP.
|
static |
Definition at line 186 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc, ahrs_fc_update_mag(), MAGS_FLOAT_OF_BFP, PRINT_CONFIG_MSG(), and PRINT_CONFIG_VAR().
Referenced by ahrs_dcm_wrapper_init(), ahrs_fc_wrapper_init(), ahrs_finv_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_mlkf_wrapper_init(), filter_1euro_imu_init(), ins_ekf2_init(), ins_float_invariant_wrapper_init(), and ins_mekf_wind_wrapper_init().
|
static |
Definition at line 58 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc, ahrs_fc_id, dev, Int32Rates::p, Int32Rates::q, Int32Rates::r, and RATES_BFP_OF_REAL.
Referenced by ahrs_fc_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_mlkf_wrapper_init(), and ins_flow_init().
|
static |
Definition at line 47 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc, ahrs_fc_id, dev, float_eulers_of_quat(), FloatEulers::phi, FloatEulers::psi, and FloatEulers::theta.
Referenced by ahrs_fc_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_mlkf_wrapper_init(), ahrs_vectornav_wrapper_init(), ins_flow_init(), and ins_mekf_wind_wrapper_init().
|
static |
Definition at line 66 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc, ahrs_fc_id, dev, EULERS_BFP_OF_REAL, float_eulers_of_quat(), Int32Eulers::phi, Int32Eulers::psi, and Int32Eulers::theta.
Referenced by ahrs_fc_wrapper_init().
|
static |
Definition at line 90 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc, ahrs_fc_id, ahrs_fc_last_stamp, dev, get_sys_time_usec(), and val.
Referenced by ahrs_dcm_wrapper_init(), ahrs_fc_wrapper_init(), ahrs_finv_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_madgwick_wrapper_init(), ahrs_mlkf_wrapper_init(), ins_ekf2_init(), ins_ext_pose_init(), ins_float_invariant_wrapper_init(), ins_flow_init(), and ins_mekf_wind_wrapper_init().
|
static |
Definition at line 84 of file ahrs_float_cmpl_wrapper.c.
References ahrs_fc, ahrs_fc_id, and dev.
Referenced by ahrs_fc_wrapper_init(), ahrs_finv_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_mlkf_wrapper_init(), and ins_flow_init().
|
static |
Definition at line 125 of file ahrs_float_cmpl_wrapper.c.
| uint8_t ahrs_fc_enable |
if TRUE with push the estimation results to the state interface
Definition at line 35 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_float_cmpl_wrapper_enable().
|
static |
Definition at line 38 of file ahrs_float_cmpl_wrapper.c.
Referenced by send_bias(), send_euler(), send_euler_int(), send_filter_status(), and send_geo_mag().
|
static |
Definition at line 37 of file ahrs_float_cmpl_wrapper.c.
Referenced by gyro_cb(), and send_filter_status().
|
static |
Definition at line 127 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_dcm_wrapper_init(), ahrs_fc_wrapper_init(), ahrs_finv_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_madgwick_wrapper_init(), ahrs_mlkf_wrapper_init(), ins_float_invariant_wrapper_init(), ins_flow_init(), and ins_mekf_wind_wrapper_init().
|
static |
Definition at line 128 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_fc_wrapper_init(), ahrs_finv_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_mlkf_wrapper_init(), ins_float_invariant_wrapper_init(), and ins_mekf_wind_wrapper_init().
|
static |
Definition at line 129 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_dcm_wrapper_init(), ahrs_fc_wrapper_init(), ahrs_icq_wrapper_init(), gps_init(), ins_alt_float_init(), ins_ekf2_init(), ins_float_invariant_wrapper_init(), ins_flow_init(), ins_gps_passthrough_init(), ins_int_init(), ins_mekf_wind_wrapper_init(), ins_module_wrapper_init(), ins_xsens700_init(), ins_xsens_init(), intermcu_init(), and target_pos_init().
|
static |
Definition at line 124 of file ahrs_float_cmpl_wrapper.c.
|
static |
Definition at line 126 of file ahrs_float_cmpl_wrapper.c.
Referenced by ahrs_dcm_wrapper_init(), ahrs_fc_wrapper_init(), ahrs_finv_wrapper_init(), ahrs_icq_wrapper_init(), ahrs_mlkf_wrapper_init(), filter_1euro_imu_init(), ins_ekf2_init(), ins_float_invariant_wrapper_init(), ins_mekf_wind_wrapper_init(), and mag_calib_ukf_init().