Inheritance diagram for gtsam::ShonanAveraging3:

Collaboration diagram for gtsam::ShonanAveraging3:

Public Types
using	Sparse = Eigen::SparseMatrix< double >

using	Parameters = ShonanAveragingParameters< d >

using	Rot = typename Parameters::Rot

using	Measurements = std::vector< BinaryMeasurement< Rot > >

Public Member Functions
	ShonanAveraging3 (const Measurements &measurements, const Parameters &parameters=Parameters())

	ShonanAveraging3 (std::string g2oFile, const Parameters &parameters=Parameters())

	ShonanAveraging3 (const BetweenFactorPose3s &factors, const Parameters &parameters=Parameters())

std::vector< BinaryMeasurement< T > >	maybeRobust (const std::vector< BinaryMeasurement< T >> &measurements, bool useRobustModel=false) const

Query properties
size_t	nrUnknowns () const
	Return number of unknowns.

size_t	numberMeasurements () const
	Return number of measurements.

const BinaryMeasurement< Rot > &	measurement (size_t k) const
	k^th binary measurement

Measurements	makeNoiseModelRobust (const Measurements &measurements, double k=1.345) const

const Rot &	measured (size_t k) const
	k^th measurement, as a Rot.

const KeyVector &	keys (size_t k) const
	Keys for k^th measurement, as a vector of Key values.

Basic API
double	cost (const Values &values) const

Values	initializeRandomly (std::mt19937 &rng) const

Values	initializeRandomly () const
	Random initialization for wrapper, fixed random seed.

std::pair< Values, double >	run (const Values &initialEstimate, size_t pMin=d, size_t pMax=10) const

Matrix API (advanced use, debugging)
Sparse	D () const
	Sparse version of D.

Matrix	denseD () const
	Dense version of D.

Sparse	Q () const
	Sparse version of Q.

Matrix	denseQ () const
	Dense version of Q.

Sparse	L () const
	Sparse version of L.

Matrix	denseL () const
	Dense version of L.

Sparse	computeLambda (const Matrix &S) const
	Version that takes pxdN Stiefel manifold elements.

Matrix	computeLambda_ (const Values &values) const
	Dense versions of computeLambda for wrapper/testing.

Matrix	computeLambda_ (const Matrix &S) const
	Dense versions of computeLambda for wrapper/testing.

Sparse	computeA (const Values &values) const
	Compute A matrix whose Eigenvalues we will examine.

Sparse	computeA (const Matrix &S) const
	Version that takes pxdN Stiefel manifold elements.

Matrix	computeA_ (const Values &values) const
	Dense version of computeA for wrapper/testing.

double	computeMinEigenValue (const Values &values, Vector *minEigenVector=nullptr) const

double	computeMinEigenValueAP (const Values &values, Vector *minEigenVector=nullptr) const

Values	roundSolutionS (const Matrix &S) const
	Project pxdN Stiefel manifold matrix S to Rot3^N.

Matrix	riemannianGradient (size_t p, const Values &values) const
	Calculate the riemannian gradient of F(values) at values.

Values	initializeWithDescent (size_t p, const Values &values, const Vector &minEigenVector, double minEigenValue, double gradienTolerance=1e-2, double preconditionedGradNormTolerance=1e-4) const

static Matrix	StiefelElementMatrix (const Values &values)
	Project to pxdN Stiefel manifold.

static VectorValues	TangentVectorValues (size_t p, const Vector &v)
	Create a VectorValues with eigenvector v_i.

static Values	LiftwithDescent (size_t p, const Values &values, const Vector &minEigenVector)

Advanced API
Sparse	computeLambda (const Values &values) const

NonlinearFactorGraph	buildGraphAt (size_t p) const

Values	initializeRandomlyAt (size_t p, std::mt19937 &rng) const

Values	initializeRandomlyAt (size_t p) const
	Version of initializeRandomlyAt with fixed random seed.

double	costAt (size_t p, const Values &values) const

std::pair< double, Vector >	computeMinEigenVector (const Values &values) const

bool	checkOptimality (const Values &values) const

std::shared_ptr< LevenbergMarquardtOptimizer >	createOptimizerAt (size_t p, const Values &initial) const

Values	tryOptimizingAt (size_t p, const Values &initial) const

Values	projectFrom (size_t p, const Values &values) const

Values	roundSolution (const Values &values) const

static Values	LiftTo (size_t p, const Values &values)
	Lift Values of type T to SO(p)

Member Function Documentation

◆ buildGraphAt()

NonlinearFactorGraph gtsam::ShonanAveraging< d >::buildGraphAt ( size_t p ) const

inherited

Build graph for SO(p)

Parameters

p	the dimensionality of the rotation manifold to optimize over

◆ checkOptimality()

bool gtsam::ShonanAveraging< d >::checkOptimality ( const Values & values ) const

inherited

Check optimality

Parameters

values should be of type SOn

◆ computeLambda()

Sparse gtsam::ShonanAveraging< d >::computeLambda ( const Values & values ) const

inherited

Given an estimated local minimum Yopt for the (possibly lifted) relaxation, this function computes and returns the block-diagonal elements of the corresponding Lagrange multiplier.

◆ computeMinEigenValue()

double gtsam::ShonanAveraging< d >::computeMinEigenValue	(	const Values &	values,
		Vector *	minEigenVector = `nullptr`
	)		const

inherited

Compute minimum eigenvalue for optimality check.

Parameters

values should be of type SOn

◆ computeMinEigenValueAP()

double gtsam::ShonanAveraging< d >::computeMinEigenValueAP	(	const Values &	values,
		Vector *	minEigenVector = `nullptr`
	)		const

inherited

Compute minimum eigenvalue with accelerated power method.

Parameters

values should be of type SOn

◆ computeMinEigenVector()

std::pair<double, Vector> gtsam::ShonanAveraging< d >::computeMinEigenVector ( const Values & values ) const

inherited

Compute minimum eigenvalue for optimality check.

Parameters

values should be of type SOn

Returns: minEigenVector and minEigenValue

◆ cost()

double gtsam::ShonanAveraging< d >::cost ( const Values & values ) const

inherited

Calculate cost for SO(3) Values should be of type Rot3

◆ costAt()

double gtsam::ShonanAveraging< d >::costAt	(	size_t	p,
		const Values &	values
	)		const

inherited

Calculate cost for SO(p) Values should be of type SO(p)

◆ createOptimizerAt()

std::shared_ptr<LevenbergMarquardtOptimizer> gtsam::ShonanAveraging< d >::createOptimizerAt	(	size_t	p,
		const Values &	initial
	)		const

inherited

Try to create optimizer at SO(p)

Parameters

p	the dimensionality of the rotation manifold to optimize over
initial	initial SO(p) values

Returns: lm optimizer

◆ initializeRandomly()

Values gtsam::ShonanAveraging< d >::initializeRandomly ( std::mt19937 & rng ) const

inherited

Initialize randomly at SO(d)

Parameters

rng	random number generator Example: std::mt19937 rng(42); Values initial = initializeRandomly(rng, p);

◆ initializeRandomlyAt()

Values gtsam::ShonanAveraging< d >::initializeRandomlyAt	(	size_t	p,
		std::mt19937 &	rng
	)		const

inherited

Create initial Values of type SO(p)

Parameters

p	the dimensionality of the rotation manifold
rng	random number generator

◆ initializeWithDescent()

Values gtsam::ShonanAveraging< d >::initializeWithDescent	(	size_t	p,
		const Values &	values,
		const Vector &	minEigenVector,
		double	minEigenValue,
		double	gradienTolerance = `1e-2`,
		double	preconditionedGradNormTolerance = `1e-4`
	)		const

inherited

Given some values at p-1, return new values at p, by doing a line search along the descent direction, computed from the minimum eigenvector at p-1.

Parameters

values	should be of type SO(p-1)
minEigenVector	corresponding to minEigenValue at level p-1

Returns: values of type SO(p)

◆ LiftwithDescent()

static Values gtsam::ShonanAveraging< d >::LiftwithDescent	(	size_t	p,
		const Values &	values,
		const Vector &	minEigenVector
	)

staticinherited

Lift up the dimension of values in type SO(p-1) with descent direction provided by minEigenVector and return new values in type SO(p)

◆ makeNoiseModelRobust()

Measurements gtsam::ShonanAveraging< d >::makeNoiseModelRobust	(	const Measurements &	measurements,
		double	k = `1.345`
	)		const

inlineinherited

Update factors to use robust Huber loss.

Parameters

measurements	Vector of BinaryMeasurements.
k	Huber noise model threshold.

◆ maybeRobust()

std::vector<BinaryMeasurement<T> > gtsam::ShonanAveraging< d >::maybeRobust	(	const std::vector< BinaryMeasurement< T >> &	measurements,
		bool	useRobustModel = `false`
	)		const

inlineinherited

Helper function to convert measurements to robust noise model if flag is set.

Template Parameters

T	the type of measurement, e.g. Rot3.

Parameters

measurements	vector of BinaryMeasurements of type T.
useRobustModel	flag indicating whether use robust noise model instead.

◆ projectFrom()

Values gtsam::ShonanAveraging< d >::projectFrom	(	size_t	p,
		const Values &	values
	)		const

inherited

Project from SO(p) to Rot2 or Rot3 Values should be of type SO(p)

◆ roundSolution()

Values gtsam::ShonanAveraging< d >::roundSolution ( const Values & values ) const

inherited

Project from SO(p)^N to Rot2^N or Rot3^N Values should be of type SO(p)

◆ run()

std::pair<Values, double> gtsam::ShonanAveraging< d >::run	(	const Values &	initialEstimate,
		size_t	pMin = `d`,
		size_t	pMax = `10`
	)		const

inherited

Optimize at different values of p until convergence.

Parameters

initial	initial Rot3 values
pMin	value of p to start Riemanian staircase at (default: d).
pMax	maximum value of p to try (default: 10)

Returns: (Rot3 values, minimum eigenvalue)

◆ tryOptimizingAt()

Values gtsam::ShonanAveraging< d >::tryOptimizingAt	(	size_t	p,
		const Values &	initial
	)		const

inherited

Try to optimize at SO(p)

Parameters

p	the dimensionality of the rotation manifold to optimize over
initial	initial SO(p) values

Returns: SO(p) values

The documentation for this class was generated from the following file:

/home/docs/checkouts/readthedocs.org/user_builds/gtsam-jlblanco-docs/checkouts/latest/gtsam/sfm/ShonanAveraging.h

Public Types

Public Member Functions

Matrix API (advanced use, debugging)

Advanced API

Member Function Documentation

◆ buildGraphAt()

◆ checkOptimality()

◆ computeLambda()

◆ computeMinEigenValue()

◆ computeMinEigenValueAP()

◆ computeMinEigenVector()

◆ cost()

◆ costAt()

◆ createOptimizerAt()

◆ initializeRandomly()

◆ initializeRandomlyAt()

◆ initializeWithDescent()

◆ LiftwithDescent()

◆ makeNoiseModelRobust()

◆ maybeRobust()

◆ projectFrom()

◆ roundSolution()

◆ run()

◆ tryOptimizingAt()