testNonlinearEquality.cpp File Reference

#include <tests/simulated2DConstraints.h>
#include <gtsam/nonlinear/PriorFactor.h>
#include <gtsam/slam/ProjectionFactor.h>
#include <gtsam/nonlinear/NonlinearEquality.h>
#include <gtsam/nonlinear/NonlinearFactorGraph.h>
#include <gtsam/nonlinear/LevenbergMarquardtOptimizer.h>
#include <gtsam/linear/GaussianBayesNet.h>
#include <gtsam/inference/Symbol.h>
#include <gtsam/geometry/Point2.h>
#include <gtsam/geometry/Pose2.h>
#include <gtsam/geometry/Point3.h>
#include <gtsam/geometry/Pose3.h>
#include <gtsam/geometry/Cal3_S2.h>
#include <gtsam/geometry/PinholeCamera.h>
#include <CppUnitLite/TestHarness.h>

Include dependency graph for testNonlinearEquality.cpp:

Go to the source code of this file.

Typedefs
typedef NonlinearEquality< Pose2 >	PoseNLE
typedef PriorFactor< Pose2 >	PosePrior
typedef boost::shared_ptr< PoseNLE >	shared_poseNLE

Functions
int	main ()
	TEST (NonlinearEquality, linearization)
	TEST (NonlinearEquality, linearization_pose)
	TEST (NonlinearEquality, linearization_fail)
	TEST (NonlinearEquality, linearization_fail_pose)
	TEST (NonlinearEquality, linearization_fail_pose_origin)
	TEST (NonlinearEquality, error)
	TEST (NonlinearEquality, equals)
	TEST (NonlinearEquality, allow_error_pose)
	TEST (NonlinearEquality, allow_error_optimize)
	TEST (NonlinearEquality, allow_error_optimize_with_factors)
	TEST (testNonlinearEqualityConstraint, unary_basics)
	TEST (testNonlinearEqualityConstraint, unary_linearization)
	TEST (testNonlinearEqualityConstraint, unary_simple_optimization)
	TEST (testNonlinearEqualityConstraint, odo_basics)
	TEST (testNonlinearEqualityConstraint, odo_linearization)
	TEST (testNonlinearEqualityConstraint, odo_simple_optimize)
	TEST (testNonlinearEqualityConstraint, two_pose)
	TEST (testNonlinearEqualityConstraint, map_warp)
	TEST (testNonlinearEqualityConstraint, stereo_constrained)

Variables
static SharedDiagonal	hard_model = noiseModel::Constrained::All(2)
static Symbol	key ('x', 1)
static SharedDiagonal	soft_model = noiseModel::Isotropic::Sigma(2, 1.0)
static const double	tol = 1e-5

Typedef Documentation

typedef NonlinearEquality<Pose2> PoseNLE

Definition at line 43 of file testNonlinearEquality.cpp.

typedef PriorFactor<Pose2> PosePrior

Definition at line 42 of file testNonlinearEquality.cpp.

typedef boost::shared_ptr<PoseNLE> shared_poseNLE

Definition at line 44 of file testNonlinearEquality.cpp.

Function Documentation

int main

(

void

)

Definition at line 583 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		linearization
	)

Definition at line 49 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		linearization_pose
	)

Definition at line 65 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		linearization_fail
	)

Definition at line 80 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		linearization_fail_pose
	)

Definition at line 94 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		linearization_fail_pose_origin
	)

Definition at line 109 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		error
	)

Definition at line 124 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		equals
	)

Definition at line 144 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		allow_error_pose
	)

Definition at line 163 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		allow_error_optimize
	)

Definition at line 192 of file testNonlinearEquality.cpp.

TEST	(	NonlinearEquality	,
		allow_error_optimize_with_factors
	)

Definition at line 219 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		unary_basics
	)

Definition at line 257 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		unary_linearization
	)

Definition at line 282 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		unary_simple_optimization
	)

Definition at line 305 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		odo_basics
	)

Definition at line 338 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		odo_linearization
	)

Definition at line 366 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		odo_simple_optimize
	)

Definition at line 394 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		two_pose
	)

Definition at line 431 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		map_warp
	)

Definition at line 473 of file testNonlinearEquality.cpp.

TEST	(	testNonlinearEqualityConstraint	,
		stereo_constrained
	)

Definition at line 518 of file testNonlinearEquality.cpp.

Variable Documentation

SharedDiagonal hard_model = noiseModel::Constrained::All(2)

static

Definition at line 253 of file testNonlinearEquality.cpp.

Symbol key('x', 1)

static

SharedDiagonal soft_model = noiseModel::Isotropic::Sigma(2, 1.0)

static

Definition at line 254 of file testNonlinearEquality.cpp.

const double tol = 1e-5

static

Definition at line 40 of file testNonlinearEquality.cpp.