|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
Vertical filter (in float) estimating altitude, velocity and accel bias. More...
Go to the source code of this file.
Data Structures | |
| struct | Vff |
Macros | |
| #define | VFF_STATE_SIZE 3 |
Functions | |
| void | vff_init_zero (void) |
| void | vff_init (float z, float zdot, float bias) |
| void | vff_propagate (float accel, float dt) |
| Propagate the filter in time. | |
| void | vff_update (float z_meas) |
| void | vff_update_z_conf (float z_meas, float conf) |
| void | vff_update_vz_conf (float vz_meas, float conf) |
| void | vff_realign (float z_meas) |
Variables | |
| struct Vff | vff |
Vertical filter (in float) estimating altitude, velocity and accel bias.
Definition in file vf_float.h.
| struct Vff |
Definition at line 34 of file vf_float.h.
| Data Fields | ||
|---|---|---|
| float | bias | accel bias estimate in m/s^2 |
| float | P[VFF_STATE_SIZE][VFF_STATE_SIZE] | covariance matrix |
| float | z | z-position estimate in m (NED, z-down) |
| float | z_meas | last measurement |
| float | zdot | z-velocity estimate in m/s (NED, z-down) |
| float | zdotdot | z-acceleration in m/s^2 (NED, z-down) |
| #define VFF_STATE_SIZE 3 |
Definition at line 32 of file vf_float.h.
|
extern |
Definition at line 71 of file vf_float.c.
References DefaultPeriodic, register_periodic_telemetry(), send_vff(), vff, VFF_INIT_PXX, and VFF_STATE_SIZE.
Referenced by vff_init_zero().
|
extern |
Definition at line 107 of file vf_extended_float.c.
References vff_init(), and vff_init().
Referenced by ins_int_init().
|
extern |
Propagate the filter in time.
F = [ 1 dt -dt^2/2 0 0 0 1 -dt 0 0 0 0 1 0 0 0 0 0 1 0 0 0 0 0 1 ];
B = [ dt^2/2 dt 0 0 0]';
Q = [ Qzz 0 0 0 0 0 Qzdotzdot 0 0 0 0 0 Qbiasbias 0 0 0 0 0 0 Qoffoff 0 0 0 0 0 0 Qobsobs ];
Qzz = VFF_EXTENDED_ACCEL_NOISE * DT_VFILTER * DT_VFILTER / 2. Qzdotzdot = VFF_EXTENDED_ACCEL_NOISE * DT_VFILTER
Xk1 = F * Xk0 + B * accel;
Pk1 = F * Pk0 * F' + Q;
F = [ 1 dt -dt^2/2 0 1 -dt 0 0 1 ];
B = [ dt^2/2 dt 0]';
Q = [ 0.01 0 0 0 0.01 0 0 0 0.001 ];
Xk1 = F * Xk0 + B * accel;
Pk1 = F * Pk0 * F' + Q;
Definition at line 181 of file vf_extended_float.c.
References DefaultChannel, DefaultDevice, Qbiasbias, Qobsobs, Qoffoff, send_vffe(), vff, and VFF_ACCEL_NOISE.
Referenced by ins_int_propagate().
|
extern |
Definition at line 384 of file vf_extended_float.c.
References vff, Vff::z_meas, and VffExtended::z_meas.
Referenced by baro_cb().
|
extern |
Definition at line 189 of file vf_float.c.
References update_z_conf(), VFF_MEAS_NOISE, and Vff::z_meas.
Referenced by baro_cb().
|
extern |
Definition at line 433 of file vf_extended_float.c.
References update_vz_conf(), and update_vz_conf().
Referenced by ins_int_update_gps(), and vel_est_cb().
|
extern |
Definition at line 310 of file vf_extended_float.c.
References update_alt_conf(), update_z_conf(), Vff::z_meas, and VffExtended::z_meas.
Referenced by ins_int_update_gps(), pos_est_cb(), vff_update_agl(), and vff_update_z().
|
extern |
Definition at line 89 of file vf_extended_float.c.
Referenced by ins_update_from_vff(), send_vff(), send_vffe(), update_alt_conf(), update_biased_z_conf(), update_obs_height(), update_vz_conf(), update_vz_conf(), update_z_conf(), vff_init(), vff_init(), vff_propagate(), vff_realign(), vff_update_baro(), vff_update_obs_height(), and vff_update_z().