UnscentedKalmanSmootherHarness.cpp File Reference

---

Detailed Description

Basic test of UnscentedKalmanSmoother.

Results are output into files as follows:

results/UnscentedKalmanSmootherHarness_actual.out

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

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

results/UnscentedKalmanSmootherHarness_meas.out

Measurement at each time step. Columns are as follows:

• time
• measurement

results/UnscentedKalmanSmootherHarness_filter.out

Predicted state (filtered) 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/UnscentedKalmanSmootherHarness_smooth.out

Predicted state (smoothed) 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.

Note that as the smoothing is performed in a backwards pass, this file has entries in reverse time order.

Results

Results are as follows:

Results

Definition in file UnscentedKalmanSmootherHarness.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 88 of file UnscentedKalmanSmootherHarness.cpp.

---