GTSAM
4.0.2
C++ library for smoothing and mapping (SAM)
|
#include <FactorGraph.h>
Public Types | |
typedef FACTOR | FactorType |
factor type | |
typedef std::shared_ptr< FACTOR > | sharedFactor |
Shared pointer to a factor. | |
typedef sharedFactor | value_type |
typedef FastVector< sharedFactor >::iterator | iterator |
typedef FastVector< sharedFactor >::const_iterator | const_iterator |
Protected Member Functions | |
bool | isEqual (const FactorGraph &other) const |
Check exact equality of the factor pointers. Useful for derived ==. | |
Protected Attributes | |
FastVector< sharedFactor > | factors_ |
Standard Constructors | |
FactorGraph () | |
template<typename ITERATOR > | |
FactorGraph (ITERATOR firstFactor, ITERATOR lastFactor) | |
template<class CONTAINER > | |
FactorGraph (const CONTAINER &factors) | |
Constructors | |
virtual | ~FactorGraph ()=default |
template<class DERIVEDFACTOR , typename = IsDerived<DERIVEDFACTOR>> | |
FactorGraph (std::initializer_list< std::shared_ptr< DERIVEDFACTOR >> sharedFactors) | |
Adding Single Factors | |
void | reserve (size_t size) |
template<class DERIVEDFACTOR > | |
IsDerived< DERIVEDFACTOR > | push_back (std::shared_ptr< DERIVEDFACTOR > factor) |
Add a factor directly using a shared_ptr. | |
template<class DERIVEDFACTOR , class... Args> | |
IsDerived< DERIVEDFACTOR > | emplace_shared (Args &&... args) |
Emplace a shared pointer to factor of given type. | |
template<class DERIVEDFACTOR > | |
IsDerived< DERIVEDFACTOR > | push_back (const DERIVEDFACTOR &factor) |
template<class DERIVEDFACTOR > | |
IsDerived< DERIVEDFACTOR > | add (std::shared_ptr< DERIVEDFACTOR > factor) |
add is a synonym for push_back. | |
Adding via iterators | |
template<typename ITERATOR > | |
HasDerivedElementType< ITERATOR > | push_back (ITERATOR firstFactor, ITERATOR lastFactor) |
template<typename ITERATOR > | |
HasDerivedValueType< ITERATOR > | push_back (ITERATOR firstFactor, ITERATOR lastFactor) |
Push back many factors with an iterator (factors are copied) | |
Adding via container | |
template<typename CONTAINER > | |
HasDerivedElementType< CONTAINER > | push_back (const CONTAINER &container) |
template<typename CONTAINER > | |
HasDerivedValueType< CONTAINER > | push_back (const CONTAINER &container) |
Push back non-pointer objects in a container (factors are copied). | |
template<class FACTOR_OR_CONTAINER > | |
void | add (const FACTOR_OR_CONTAINER &factorOrContainer) |
Specialized versions | |
template<class CLIQUE > | |
std::enable_if< std::is_base_of< This, typename CLIQUE::FactorGraphType >::value >::type | push_back (const BayesTree< CLIQUE > &bayesTree) |
template<typename CONTAINER , typename = HasDerivedElementType<CONTAINER>> | |
FactorIndices | add_factors (const CONTAINER &factors, bool useEmptySlots=false) |
Testable | |
virtual void | print (const std::string &s="FactorGraph", const KeyFormatter &formatter=DefaultKeyFormatter) const |
Print out graph to std::cout, with optional key formatter. | |
bool | equals (const This &fg, double tol=1e-9) const |
Check equality up to tolerance. | |
Standard Interface | |
size_t | size () const |
bool | empty () const |
const sharedFactor | at (size_t i) const |
sharedFactor & | at (size_t i) |
const sharedFactor | operator[] (size_t i) const |
sharedFactor & | operator[] (size_t i) |
const_iterator | begin () const |
const_iterator | end () const |
sharedFactor | front () const |
sharedFactor | back () const |
double | error (const HybridValues &values) const |
Modifying Factor Graphs (imperative, discouraged) | |
iterator | begin () |
iterator | end () |
virtual void | resize (size_t size) |
void | remove (size_t i) |
void | replace (size_t index, sharedFactor factor) |
iterator | erase (iterator item) |
iterator | erase (iterator first, iterator last) |
Graph Display | |
void | dot (std::ostream &os, const KeyFormatter &keyFormatter=DefaultKeyFormatter, const DotWriter &writer=DotWriter()) const |
Output to graphviz format, stream version. | |
std::string | dot (const KeyFormatter &keyFormatter=DefaultKeyFormatter, const DotWriter &writer=DotWriter()) const |
Output to graphviz format string. | |
void | saveGraph (const std::string &filename, const KeyFormatter &keyFormatter=DefaultKeyFormatter, const DotWriter &writer=DotWriter()) const |
output to file with graphviz format. | |
Advanced Interface | |
size_t | nrFactors () const |
KeySet | keys () const |
KeyVector | keyVector () const |
bool | exists (size_t idx) const |
A factor graph is a bipartite graph with factor nodes connected to variable nodes. In this class, however, only factor nodes are kept around.
|
inlineprotected |
Default constructor
|
inlineprotected |
Constructor from iterator over factors (shared_ptr or plain objects)
|
inlineexplicitprotected |
Construct from container of factors (shared_ptr or plain objects)
|
virtualdefault |
Default destructor Public and virtual so boost serialization can call it.
|
inline |
Constructor that takes an initializer list of shared pointers. FactorGraph fg = {make_shared<MyFactor>(), ...};
|
inline |
Add a factor or container of factors, including STL collections, BayesTrees, etc.
FactorIndices gtsam::FactorGraph< FACTOR >::add_factors | ( | const CONTAINER & | factors, |
bool | useEmptySlots = false |
||
) |
Add new factors to a factor graph and returns a list of new factor indices, optionally finding and reusing empty factor slots.
|
inline |
Get a specific factor by index (this checks array bounds and may throw an exception, as opposed to operator[] which does not).
|
inline |
Get a specific factor by index (this checks array bounds and may throw an exception, as opposed to operator[] which does not).
|
inline |
Get the last factor
|
inline |
Iterator to beginning of factors.
|
inline |
non-const STL-style begin()
|
inline |
Check if the graph is empty (null factors set by remove() will cause this to return false).
|
inline |
Iterator to end of factors.
|
inline |
non-const STL-style end()
|
inline |
Erase factor and rearrange other factors to take up the empty space
|
inline |
Erase factors and rearrange other factors to take up the empty space
double gtsam::FactorGraph< FACTOR >::error | ( | const HybridValues & | values | ) | const |
Add error for all factors.
|
inline |
MATLAB interface utility: Checks whether a factor index idx exists in the graph and is a live pointer
|
inline |
Get the first factor
KeySet gtsam::FactorGraph< FACTOR >::keys | ( | ) | const |
Potentially slow function to return all keys involved, sorted, as a set
KeyVector gtsam::FactorGraph< FACTOR >::keyVector | ( | ) | const |
Potentially slow function to return all keys involved, sorted, as a vector
size_t gtsam::FactorGraph< FACTOR >::nrFactors | ( | ) | const |
return the number of non-null factors
|
inline |
Get a specific factor by index (this does not check array bounds, as opposed to at() which does).
|
inline |
Get a specific factor by index (this does not check array bounds, as opposed to at() which does).
|
inline |
Add a factor by value, will be copy-constructed (use push_back with a shared_ptr to avoid the copy).
|
inline |
Push back many factors with an iterator over shared_ptr (factors are not copied)
|
inline |
Push back many factors as shared_ptr's in a container (factors are not copied)
|
inline |
Push back a BayesTree as a collection of factors. NOTE: This should be hidden in derived classes in favor of a type-specialized version that calls this templated function.
|
inline |
delete factor without re-arranging indexes by inserting a nullptr pointer
|
inline |
replace a factor by index
|
inline |
Reserve space for the specified number of factors if you know in advance how many there will be (works like FastVector::reserve).
|
inlinevirtual |
Directly resize the number of factors in the graph. If the new size is less than the original, factors at the end will be removed. If the new size is larger than the original, null factors will be appended.
|
inline |
return the number of factors (including any null factors set by remove() ).
|
protected |
concept check, makes sure FACTOR defines print and equals Collection of factors