Paparazzi UAS
v7.0_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
Integrated Navigation System interface. More...
#include "std.h"
#include "math/pprz_geodetic_int.h"
#include "math/pprz_algebra_float.h"
#include "state.h"
Go to the source code of this file.
Functions | |
void | ins_reset_local_origin (void) |
INS local origin reset. More... | |
void | ins_reset_altitude_ref (void) |
INS altitude reference reset. More... | |
void | ins_reset_vertical_pos (void) |
INS vertical position reset. More... | |
void | ins_reset_utm_zone (struct UtmCoor_f *utm) |
INS utm zone reset. More... | |
void | ins_init_origin_i_from_flightplan (struct LtpDef_i *ltp_def) |
initialize the local origin (ltp_def in fixed point) from flight plan position More... | |
Integrated Navigation System interface.
Definition in file ins.h.
void ins_init_origin_i_from_flightplan | ( | struct LtpDef_i * | ltp_def | ) |
initialize the local origin (ltp_def in fixed point) from flight plan position
Definition at line 39 of file ins.c.
References LlaCoor_i::alt, LtpDef_i::hmsl, LlaCoor_i::lat, LlaCoor_i::lon, ltp_def, ltp_def_from_lla_i(), and stateSetLocalOrigin_i().
Referenced by ins_int_init(), ins_module_wrapper_init(), and ins_vectornav_init().
void ins_reset_altitude_ref | ( | void | ) |
INS altitude reference reset.
Reset only vertical reference to the current altitude. Does nothing if not implemented by specific INS algorithm.
Definition at line 65 of file ins.c.
References UtmCoor_f::alt, LlaCoor_i::alt, ekf, ekf2, gps, GpsFixValid, LtpDef_i::hmsl, GpsState::hmsl, ins_altf, ins_float_inv, ins_gp, ins_int, LlaCoor_i::lat, LtpDef_i::lla, lla_int_from_gps(), GpsState::lla_pos, LlaCoor_i::lon, ltp_def, ekf2_t::ltp_def, InsGpsPassthrough::ltp_def, InsInt::ltp_def, ltp_def_from_lla_i(), State::ned_origin_i, inv_state::pos, InsAltFloat::reset_alt_ref, inv_state::speed, InsFloatInv::state, state, stateSetLocalOrigin_i(), stateSetLocalUtmOrigin_f(), State::utm_origin_f, InsInt::vf_reset, and NedCoor_f::z.
Referenced by nav_reset_alt().
void ins_reset_local_origin | ( | void | ) |
INS local origin reset.
Reset horizontal and vertical reference to the current position. Does nothing if not implemented by specific INS algorithm.
INS local origin reset.
Definition at line 55 of file ins.c.
References LlaCoor_i::alt, ecef_int_from_gps(), GpsState::ecef_pos, ekf, ekf2, GpsState::fix, FLOAT_VECT3_ZERO, gps, InsModuleInt::gps, GPS_FIX_3D, GpsFixValid, InsInt::hf_realign, LtpDef_i::hmsl, GpsState::hmsl, ins_altf, ins_float_inv, ins_flow, ins_gp, ins_int, ins_mekf_wind_wrapper_Reset, ins_module, ins_module_reset_local_origin(), LlaCoor_i::lat, LtpDef_i::lla, lla_int_from_gps(), GpsState::lla_pos, LlaCoor_i::lon, ltp_def, ekf2_t::ltp_def, InsFlow::ltp_def, InsGpsPassthrough::ltp_def, InsInt::ltp_def, InsModuleInt::ltp_def, ltp_def_from_ecef_i(), ltp_def_from_lla_i(), InsFlow::ltp_initialized, InsGpsPassthrough::ltp_initialized, InsInt::ltp_initialized, InsModuleInt::ltp_initialized, InsAltFloat::origin_initialized, inv_state::pos, InsAltFloat::reset_alt_ref, inv_state::speed, InsFloatInv::state, stateSetLocalOrigin_i(), stateSetLocalUtmOrigin_f(), utm_float_from_gps(), and InsInt::vf_reset.
Referenced by gps_cb(), ins_alt_float_update_gps(), ins_int_update_gps(), and nav_reset_reference().
void ins_reset_utm_zone | ( | struct UtmCoor_f * | utm | ) |
INS utm zone reset.
Reset UTM zone according the the actual position. Only used with fixedwing firmware. Can be overwritte by specifc INS implementation.
utm | initial utm zone, returns the corrected utm position |
Definition at line 70 of file ins.c.
References gps, GPS_VALID_POS_UTM_BIT, lla_of_utm_f(), stateSetLocalUtmOrigin_f(), utm_of_lla_f(), GpsState::utm_pos, GpsState::valid_fields, UtmCoor_f::zone, and UtmCoor_i::zone.
Referenced by nav_reset_utm_zone().
void ins_reset_vertical_pos | ( | void | ) |
INS vertical position reset.
Reset only vertical position to zero. Does nothing if not implemented by specific INS algorithm.
Definition at line 67 of file ins.c.
References ins_int, and InsInt::vf_reset.