testInertialNavFactor_GlobalVelocity.cpp File Reference

Unit test for the InertialNavFactor_GlobalVelocity. More...

#include <iostream>
#include <CppUnitLite/TestHarness.h>
#include <gtsam/navigation/ImuBias.h>
#include <gtsam_unstable/slam/InertialNavFactor_GlobalVelocity.h>
#include <gtsam/geometry/Pose3.h>
#include <gtsam/nonlinear/Values.h>
#include <gtsam/inference/Key.h>
#include <gtsam/base/numericalDerivative.h>
#include <gtsam/base/TestableAssertions.h>

Include dependency graph for testInertialNavFactor_GlobalVelocity.cpp:

Go to the source code of this file.

Functions
static const Vector3	ECEF_omega_earth (0.0, 0.0, 7.292115e-5)
int	main ()
Pose3	predictionErrorPose (const Pose3 &p1, const Vector3 &v1, const imuBias::ConstantBias &b1, const Pose3 &p2, const Vector3 &v2, const InertialNavFactor_GlobalVelocity< Pose3, Vector3, imuBias::ConstantBias > &factor)
Vector	predictionErrorVel (const Pose3 &p1, const Vector3 &v1, const imuBias::ConstantBias &b1, const Pose3 &p2, const Vector3 &v2, const InertialNavFactor_GlobalVelocity< Pose3, Vector3, imuBias::ConstantBias > &factor)
	TEST (InertialNavFactor_GlobalVelocity, Constructor)
	TEST (InertialNavFactor_GlobalVelocity, Equals)
	TEST (InertialNavFactor_GlobalVelocity, Predict)
	TEST (InertialNavFactor_GlobalVelocity, ErrorPosVel)
	TEST (InertialNavFactor_GlobalVelocity, ErrorRot)
	TEST (InertialNavFactor_GlobalVelocity, ErrorRotPosVel)
	TEST (InertialNavFactor_GlobalVelocity, Jacobian)
	TEST (InertialNavFactor_GlobalVelocity, ConstructorWithTransform)
	TEST (InertialNavFactor_GlobalVelocity, EqualsWithTransform)
	TEST (InertialNavFactor_GlobalVelocity, PredictWithTransform)
	TEST (InertialNavFactor_GlobalVelocity, ErrorPosVelWithTransform)
	TEST (InertialNavFactor_GlobalVelocity, ErrorRotWithTransform)
	TEST (InertialNavFactor_GlobalVelocity, ErrorRotPosVelWithTransform)
	TEST (InertialNavFactor_GlobalVelocity, JacobianWithTransform)
static const Vector3	world_g (0.0, 0.0, 9.81)
static const Vector3	world_rho (0.0,-1.5724e-05, 0.0)

Variables
static const Vector3	world_omega_earth
Rot3	world_R_ECEF (0.31686, 0.51505, 0.79645, 0.85173,-0.52399, 0, 0.41733, 0.67835,-0.60471)

Detailed Description

Unit test for the InertialNavFactor_GlobalVelocity.

Author

Vadim Indelman, Stephen Williams

Definition in file testInertialNavFactor_GlobalVelocity.cpp.

Function Documentation

static const Vector3 ECEF_omega_earth ( 0.  0, 0.  0, 7.292115e-  5  )

static

int main

(

void

)

Definition at line 703 of file testInertialNavFactor_GlobalVelocity.cpp.

Pose3 predictionErrorPose	(	const Pose3 &	p1,
		const Vector3 &	v1,
		const imuBias::ConstantBias &	b1,
		const Pose3 &	p2,
		const Vector3 &	v2,
		const InertialNavFactor_GlobalVelocity< Pose3, Vector3, imuBias::ConstantBias > &	factor
	)

Definition at line 41 of file testInertialNavFactor_GlobalVelocity.cpp.

Vector predictionErrorVel	(	const Pose3 &	p1,
		const Vector3 &	v1,
		const imuBias::ConstantBias &	b1,
		const Pose3 &	p2,
		const Vector3 &	v2,
		const InertialNavFactor_GlobalVelocity< Pose3, Vector3, imuBias::ConstantBias > &	factor
	)

Definition at line 47 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		Constructor
	)

Definition at line 53 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		Equals
	)

Definition at line 72 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		Predict
	)

Definition at line 95 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		ErrorPosVel
	)

Definition at line 128 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		ErrorRot
	)

Definition at line 160 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		ErrorRotPosVel
	)

Definition at line 193 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		Jacobian
	)

• VADIM - START ************************************************************************* */* VADIM - END ************************************************************************* */

Definition at line 261 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		ConstructorWithTransform
	)

Definition at line 370 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		EqualsWithTransform
	)

Definition at line 392 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		PredictWithTransform
	)

Definition at line 419 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		ErrorPosVelWithTransform
	)

Definition at line 458 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		ErrorRotWithTransform
	)

Definition at line 496 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		ErrorRotPosVelWithTransform
	)

Definition at line 537 of file testInertialNavFactor_GlobalVelocity.cpp.

TEST	(	InertialNavFactor_GlobalVelocity	,
		JacobianWithTransform
	)

Definition at line 588 of file testInertialNavFactor_GlobalVelocity.cpp.

static const Vector3 world_g ( 0.  0, 0.  0, 9.  81  )

static

static const Vector3 world_rho ( 0.  0, -1.5724e-  05, 0.  0  )

static

Variable Documentation

const Vector3 world_omega_earth

static

Initial value:

= world_R_ECEF.matrix()
    * ECEF_omega_earth

Definition at line 37 of file testInertialNavFactor_GlobalVelocity.cpp.

Rot3 world_R_ECEF(0.31686, 0.51505, 0.79645, 0.85173,-0.52399, 0, 0.41733, 0.67835,-0.60471)