UnscentedKalmanFilterHarness.cpp File Reference

---

Detailed Description

Basic test of UnscentedKalmanFilter.

Results are output into files as follows:

results/UnscentedKalmanFilterHarness_actual.out

Actual state of the robot at each time. Columns are as follows:

• time
• x coordinate
• y coordinate
• orientation (radians)

results/UnscentedKalmanFilterHarness_meas.out

Measurement at each time step. Columns are as follows:

• time
• measurement

results/UnscentedKalmanFilterHarness_pred.out

Predicted state at each time step. Columns are as follows:

• time
• mean x coordinate
• mean y coordinate
• mean orientation
• The remaining columns give the covariance matrix between the above state variables.

Results

Results are as follows:

Results, c.f. BFL Tutorial Figures 3.2 and 3.3

Definition in file UnscentedKalmanFilterHarness.cpp.

Go to the source code of this file.

Defines
#define	SYSTEM_SIZE   5
#define	SYSTEM_NOISE_SIZE   2
#define	MEAS_SIZE   1
#define	MEAS_NOISE_SIZE   1
#define	ACTUAL_SIZE   3
#define	STEPS   250
Functions
int	main (int argc, const char *argv)
	Run tests.

---

Function Documentation

int main	(	int	argc,
		const char *	argv
	)

Run tests.

Definition at line 73 of file UnscentedKalmanFilterHarness.cpp.

---