vf_float.h File Reference

Vertical filter (in float) estimating altitude, velocity and accel bias. More...

This graph shows which files directly or indirectly include this file:

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. More...
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

Detailed Description

Vertical filter (in float) estimating altitude, velocity and accel bias.

Definition in file vf_float.h.

---

Data Structure Documentation

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)

Macro Definition Documentation

#define VFF_STATE_SIZE   3

Definition at line 32 of file vf_float.h.

Function Documentation

void vff_init	(	float	z,
		float	zdot,
		float	bias
	)

Definition at line 71 of file vf_float.c.

References Vff::bias, DefaultPeriodic, Vff::P, register_periodic_telemetry(), send_vff(), vff, VFF_INIT_PXX, VFF_STATE_SIZE, Vff::z, and Vff::zdot.

Referenced by vff_init_zero(), and vff_realign().

Here is the call graph for this function:

Here is the caller graph for this function:

void vff_init_zero

(

void

)

Definition at line 80 of file vf_extended_float.c.

References vff_init().

Referenced by ins_int_init().

Here is the call graph for this function:

Here is the caller graph for this function:

void vff_propagate	(	float	accel,
		float	dt
	)

Propagate the filter in time.

F = [ 1 dt -dt^2/2 0 0 1 -dt 0 0 0 1 0 0 0 0 1 ];

B = [ dt^2/2 dt 0 0]';

Q = [ Qzz 0 0 0 0 Qzdotzdot 0 0 0 0 Qbiasbias 0 0 0 0 0 Qoffoff ];

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 127 of file vf_extended_float.c.

References Vff::bias, VffExtended::bias, DefaultChannel, DefaultDevice, dt, Vff::P, VffExtended::P, Qbiasbias, Qoffoff, send_vffe(), vff, VFF_ACCEL_NOISE, VFF_EXTENDED_ACCEL_NOISE, Vff::z, VffExtended::z, Vff::zdot, VffExtended::zdot, Vff::zdotdot, and VffExtended::zdotdot.

Referenced by ins_int_propagate().

Here is the call graph for this function:

Here is the caller graph for this function:

void vff_realign

(

float

z_meas

)

Definition at line 347 of file vf_extended_float.c.

References vff_init().

Referenced by baro_cb().

Here is the call graph for this function:

Here is the caller graph for this function:

void vff_update

(

float

z_meas

)

Definition at line 189 of file vf_float.c.

References update_z_conf(), and VFF_MEAS_NOISE.

Referenced by baro_cb().

Here is the call graph for this function:

Here is the caller graph for this function:

void vff_update_vz_conf	(	float	vz_meas,
		float	conf
	)

Definition at line 406 of file vf_extended_float.c.

References update_vz_conf().

Referenced by ins_int_update_gps().

Here is the call graph for this function:

Here is the caller graph for this function:

void vff_update_z_conf	(	float	z_meas,
		float	conf
	)

Definition at line 284 of file vf_extended_float.c.

References update_alt_conf(), and update_z_conf().

Referenced by ins_int_update_gps().

Here is the call graph for this function:

Here is the caller graph for this function:

Variable Documentation

struct Vff vff

Definition at line 66 of file vf_extended_float.c.

Referenced by ins_update_from_vff(), send_vff(), send_vffe(), update_alt_conf(), update_baro_conf(), update_offset_conf(), update_vz_conf(), update_z_conf(), vff_init(), and vff_propagate().