#include <ConcurrentIncrementalSmoother.h>

Inheritance diagram for gtsam::ConcurrentIncrementalSmoother:

Collaboration diagram for gtsam::ConcurrentIncrementalSmoother:

[legend]

Classes
struct	Result

Public Types
typedef std::shared_ptr< ConcurrentIncrementalSmoother >	shared_ptr

typedef ConcurrentSmoother	Base
	typedef for base class

Public Member Functions
	ConcurrentIncrementalSmoother (const ISAM2Params &parameters=ISAM2Params())

	~ConcurrentIncrementalSmoother () override

void	print (const std::string &s="Concurrent Incremental Smoother:\, const KeyFormatter &keyFormatter=DefaultKeyFormatter) const override

bool	equals (const ConcurrentSmoother &rhs, double tol=1e-9) const override

const NonlinearFactorGraph &	getFactors () const

const Values &	getLinearizationPoint () const

const VectorValues &	getDelta () const

Values	calculateEstimate () const

template<class VALUE >
VALUE	calculateEstimate (Key key) const

Result	update (const NonlinearFactorGraph &newFactors=NonlinearFactorGraph(), const Values &newTheta=Values(), const std::optional< FactorIndices > &removeFactorIndices={})

void	presync () override

void	getSummarizedFactors (NonlinearFactorGraph &summarizedFactors, Values &separatorValues) override

void	synchronize (const NonlinearFactorGraph &smootherFactors, const Values &smootherValues, const NonlinearFactorGraph &summarizedFactors, const Values &separatorValues) override

void	postsync () override

Protected Attributes
ISAM2	isam2_
	iSAM2 inference engine

NonlinearFactorGraph	smootherFactors_
	New factors to be added to the smoother during the next update.

Values	smootherValues_
	New variables to be added to the smoother during the next update.

NonlinearFactorGraph	filterSummarizationFactors_
	New filter summarization factors to replace the existing filter summarization during the next update.

Values	separatorValues_
	The linearization points of the separator variables. These should not be changed during optimization.

FactorIndices	filterSummarizationSlots_
	The slots in factor graph that correspond to the current filter summarization factors.

bool	synchronizationUpdatesAvailable_
	Flag indicating the currently stored synchronization updates have not been applied yet.

NonlinearFactorGraph	smootherSummarization_
	A temporary holding place for calculated smoother summarization.

Detailed Description

A Levenberg-Marquardt Batch Smoother that implements the Concurrent Filtering and Smoother interface.

Constructor & Destructor Documentation

◆ ConcurrentIncrementalSmoother()

gtsam::ConcurrentIncrementalSmoother::ConcurrentIncrementalSmoother ( const ISAM2Params & parameters = ISAM2Params() )

inline

Default constructor

◆ ~ConcurrentIncrementalSmoother()

gtsam::ConcurrentIncrementalSmoother::~ConcurrentIncrementalSmoother ( )

inlineoverride

Default destructor

Member Function Documentation

◆ calculateEstimate() [1/2]

Values gtsam::ConcurrentIncrementalSmoother::calculateEstimate ( ) const

inline

Compute the current best estimate of all variables and return a full Values structure. If only a single variable is needed, it may be faster to call calculateEstimate(const KEY&).

◆ calculateEstimate() [2/2]

template<class VALUE >

VALUE gtsam::ConcurrentIncrementalSmoother::calculateEstimate ( Key key ) const

inline

Compute the current best estimate of a single variable. This is generally faster than calling the no-argument version of calculateEstimate if only specific variables are needed.

Parameters

key

Returns

◆ equals()

bool gtsam::ConcurrentIncrementalSmoother::equals	(	const ConcurrentSmoother &	rhs,
		double	tol = `1e-9`
	)		const

overridevirtual

Check if two Concurrent Smoothers are equal

Implements gtsam::ConcurrentSmoother.

◆ getDelta()

const VectorValues& gtsam::ConcurrentIncrementalSmoother::getDelta ( ) const

inline

Access the current set of deltas to the linearization point

◆ getFactors()

const NonlinearFactorGraph& gtsam::ConcurrentIncrementalSmoother::getFactors ( ) const

inline

Access the current set of factors

◆ getLinearizationPoint()

const Values& gtsam::ConcurrentIncrementalSmoother::getLinearizationPoint ( ) const

inline

Access the current linearization point

◆ getSummarizedFactors()

void gtsam::ConcurrentIncrementalSmoother::getSummarizedFactors	(	NonlinearFactorGraph &	summarizedFactors,
		Values &	separatorValues
	)

overridevirtual

Populate the provided containers with factors that constitute the smoother branch summarization needed by the filter.

Parameters

summarizedFactors The summarized factors for the filter branch

Implements gtsam::ConcurrentSmoother.

◆ postsync()

void gtsam::ConcurrentIncrementalSmoother::postsync ( )

overridevirtual

Perform any required operations after the synchronization process finishes. Called by 'synchronize'

Reimplemented from gtsam::ConcurrentSmoother.

◆ presync()

void gtsam::ConcurrentIncrementalSmoother::presync ( )

overridevirtual

Perform any required operations before the synchronization process starts. Called by 'synchronize'

Reimplemented from gtsam::ConcurrentSmoother.

◆ print()

void gtsam::ConcurrentIncrementalSmoother::print ( )

overridevirtual

Implement a GTSAM standard 'print' function

Implements gtsam::ConcurrentSmoother.

◆ synchronize()

void gtsam::ConcurrentIncrementalSmoother::synchronize	(	const NonlinearFactorGraph &	smootherFactors,
		const Values &	smootherValues,
		const NonlinearFactorGraph &	summarizedFactors,
		const Values &	separatorValues
	)

overridevirtual

Apply the new smoother factors sent by the filter, and the updated version of the filter branch summarized factors.

Parameters

smootherFactors	A set of new factors added to the smoother from the filter
smootherValues	Linearization points for any new variables
summarizedFactors	An updated version of the filter branch summarized factors
rootValues	The linearization point of the root variables

Implements gtsam::ConcurrentSmoother.

◆ update()

Result gtsam::ConcurrentIncrementalSmoother::update	(	const NonlinearFactorGraph &	newFactors = `NonlinearFactorGraph()`,
		const Values &	newTheta = `Values()`,
		const std::optional< FactorIndices > &	removeFactorIndices = `{}`
	)

Add new factors and variables to the smoother.

Add new measurements, and optionally new variables, to the smoother. This runs a full step of the ISAM2 algorithm, relinearizing and updating the solution as needed, according to the wildfire and relinearize thresholds.

Parameters

newFactors	The new factors to be added to the smoother
newTheta	Initialization points for new variables to be added to the smoother You must include here all new variables occuring in newFactors (which were not already in the smoother). There must not be any variables here that do not occur in newFactors, and additionally, variables that were already in the system must not be included here.

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

/home/docs/checkouts/readthedocs.org/user_builds/gtsam-jlblanco-docs/checkouts/latest/gtsam_unstable/nonlinear/ConcurrentIncrementalSmoother.h

Classes

Public Types

Public Member Functions

Protected Attributes

Detailed Description

Constructor & Destructor Documentation

◆ ConcurrentIncrementalSmoother()

◆ ~ConcurrentIncrementalSmoother()

Member Function Documentation

◆ calculateEstimate() [1/2]

◆ calculateEstimate() [2/2]

◆ equals()

◆ getDelta()

◆ getFactors()

◆ getLinearizationPoint()

◆ getSummarizedFactors()

◆ postsync()

◆ presync()

◆ print()

◆ synchronize()

◆ update()