|
gtsam
3.2.1
gtsam
|
|
gtsam
3.2.1
gtsam
|
A Gaussian density.
It is implemented as a GaussianConditional without parents. The negative log-probability is given by \( |Rx - d|^2 \) with \( \Lambda = \Sigma^{-1} = R^T R \) and \( \mu = R^{-1} d \)
Inheritance diagram for gtsam::GaussianDensity:Public Member Functions | |
| GaussianDensity () | |
| default constructor needed for serialization | |
| GaussianDensity (const GaussianConditional &conditional) | |
| Copy constructor from GaussianConditional. | |
| GaussianDensity (Key key, const Vector &d, const Matrix &R, const SharedDiagonal &noiseModel=SharedDiagonal()) | |
| constructor using d, R | |
| void | print (const std::string &="GaussianDensity", const KeyFormatter &formatter=DefaultKeyFormatter) const |
| print | |
| Vector | mean () const |
| Mean \( \mu = R^{-1} d \). | |
| Matrix | covariance () const |
| Covariance matrix \( \Sigma = (R^T R)^{-1} \). | |
| Public Member Functions inherited from gtsam::GaussianConditional | |
| GaussianConditional () | |
| default constructor needed for serialization | |
| GaussianConditional (Key key, const Vector &d, const Matrix &R, const SharedDiagonal &sigmas=SharedDiagonal()) | |
| constructor with no parents |Rx-d| | |
| GaussianConditional (Key key, const Vector &d, const Matrix &R, Key name1, const Matrix &S, const SharedDiagonal &sigmas=SharedDiagonal()) | |
| constructor with only one parent |Rx+Sy-d| | |
| GaussianConditional (Key key, const Vector &d, const Matrix &R, Key name1, const Matrix &S, Key name2, const Matrix &T, const SharedDiagonal &sigmas=SharedDiagonal()) | |
| constructor with two parents |Rx+Sy+Tz-d| | |
| template<typename TERMS > | |
| GaussianConditional (const TERMS &terms, size_t nrFrontals, const Vector &d, const SharedDiagonal &sigmas=SharedDiagonal()) | |
| Constructor with arbitrary number of frontals and parents. More... | |
| template<typename KEYS > | |
| GaussianConditional (const KEYS &keys, size_t nrFrontals, const VerticalBlockMatrix &augmentedMatrix, const SharedDiagonal &sigmas=SharedDiagonal()) | |
| Constructor with arbitrary number keys, and where the augmented matrix is given all together instead of in block terms. More... | |
| bool | equals (const GaussianFactor &cg, double tol=1e-9) const |
| equals function | |
| constABlock | get_R () const |
| Return a view of the upper-triangular R block of the conditional. | |
| constABlock | get_S () const |
| Get a view of the parent blocks. More... | |
| constABlock | get_S (const_iterator variable) const |
| Get a view of the S matrix for the variable pointed to by the given key iterator. | |
| const constBVector | get_d () const |
| Get a view of the r.h.s. More... | |
| VectorValues | solve (const VectorValues &parents) const |
Solves a conditional Gaussian and writes the solution into the entries of x for each frontal variable of the conditional. More... | |
| VectorValues | solveOtherRHS (const VectorValues &parents, const VectorValues &rhs) const |
| void | solveTransposeInPlace (VectorValues &gy) const |
| Performs transpose backsubstition in place on values. | |
| void | scaleFrontalsBySigma (VectorValues &gy) const |
Scale the values in gy according to the sigmas for the frontal variables in this conditional. More... | |
| Public Member Functions inherited from gtsam::JacobianFactor | |
| JacobianFactor (const GaussianFactor &gf) | |
| Convert from other GaussianFactor. | |
| JacobianFactor (const JacobianFactor &jf) | |
| Copy constructor. | |
| JacobianFactor (const HessianFactor &hf) | |
| Conversion from HessianFactor (does Cholesky to obtain Jacobian matrix) | |
| JacobianFactor () | |
| default constructor for I/O | |
| JacobianFactor (const Vector &b_in) | |
| Construct Null factor. | |
| JacobianFactor (Key i1, const Matrix &A1, const Vector &b, const SharedDiagonal &model=SharedDiagonal()) | |
| Construct unary factor. | |
| JacobianFactor (Key i1, const Matrix &A1, Key i2, const Matrix &A2, const Vector &b, const SharedDiagonal &model=SharedDiagonal()) | |
| Construct binary factor. | |
| JacobianFactor (Key i1, const Matrix &A1, Key i2, const Matrix &A2, Key i3, const Matrix &A3, const Vector &b, const SharedDiagonal &model=SharedDiagonal()) | |
| Construct ternary factor. | |
| template<typename TERMS > | |
| JacobianFactor (const TERMS &terms, const Vector &b, const SharedDiagonal &model=SharedDiagonal()) | |
| Construct an n-ary factor. More... | |
| template<typename KEYS > | |
| JacobianFactor (const KEYS &keys, const VerticalBlockMatrix &augmentedMatrix, const SharedDiagonal &sigmas=SharedDiagonal()) | |
| Constructor with arbitrary number keys, and where the augmented matrix is given all together instead of in block terms. More... | |
| JacobianFactor (const GaussianFactorGraph &graph, boost::optional< const Ordering & > ordering=boost::none, boost::optional< const VariableSlots & > variableSlots=boost::none) | |
| Build a dense joint factor from all the factors in a factor graph. More... | |
| virtual | ~JacobianFactor () |
| Virtual destructor. | |
| virtual GaussianFactor::shared_ptr | clone () const |
| Clone this JacobianFactor. | |
| Vector | unweighted_error (const VectorValues &c) const |
| Vector | error_vector (const VectorValues &c) const |
| (A*x-b) | |
| virtual double | error (const VectorValues &c) const |
| (A*x-b)/sigma | |
| virtual Matrix | augmentedInformation () const |
| 0.5*(A*x-b)'D(A*x-b) More... | |
| virtual Matrix | information () const |
| Return the non-augmented information matrix represented by this GaussianFactor. | |
| virtual VectorValues | hessianDiagonal () const |
| Return the diagonal of the Hessian for this factor. | |
| virtual void | hessianDiagonal (double *d) const |
| Return the diagonal of the Hessian for this factor (raw memory version) | |
| virtual std::map< Key, Matrix > | hessianBlockDiagonal () const |
| Return the block diagonal of the Hessian for this factor. | |
| virtual std::pair< Matrix, Vector > | jacobian () const |
| Returns (dense) A,b pair associated with factor, bakes in the weights. | |
| std::pair< Matrix, Vector > | jacobianUnweighted () const |
| Returns (dense) A,b pair associated with factor, does not bake in weights. | |
| virtual Matrix | augmentedJacobian () const |
| Return (dense) matrix associated with factor. More... | |
| Matrix | augmentedJacobianUnweighted () const |
| Return (dense) matrix associated with factor. More... | |
| const VerticalBlockMatrix & | matrixObject () const |
| Return the full augmented Jacobian matrix of this factor as a VerticalBlockMatrix object. More... | |
| VerticalBlockMatrix & | matrixObject () |
| Mutable access to the full augmented Jacobian matrix of this factor as a VerticalBlockMatrix object. More... | |
| virtual GaussianFactor::shared_ptr | negate () const |
| Construct the corresponding anti-factor to negate information stored stored in this factor. More... | |
| virtual bool | empty () const |
| Check if the factor is empty. More... | |
| bool | isConstrained () const |
| is noise model constrained ? | |
| virtual DenseIndex | getDim (const_iterator variable) const |
| Return the dimension of the variable pointed to by the given key iterator todo: Remove this in favor of keeping track of dimensions with variables? | |
| size_t | rows () const |
| return the number of rows in the corresponding linear system | |
| size_t | cols () const |
| return the number of columns in the corresponding linear system | |
| const SharedDiagonal & | get_model () const |
| get a copy of model | |
| SharedDiagonal & | get_model () |
| get a copy of model (non-const version) | |
| const constBVector | getb () const |
| Get a view of the r.h.s. More... | |
| constABlock | getA (const_iterator variable) const |
| Get a view of the A matrix for the variable pointed to by the given key iterator. | |
| constABlock | getA () const |
| Get a view of the A matrix, not weighted by noise. | |
| BVector | getb () |
| Get a view of the r.h.s. More... | |
| ABlock | getA (iterator variable) |
| Get a view of the A matrix for the variable pointed to by the given key iterator (non-const version) | |
| ABlock | getA () |
| Get a view of the A matrix. | |
| Vector | operator* (const VectorValues &x) const |
| Return A*x. | |
| void | transposeMultiplyAdd (double alpha, const Vector &e, VectorValues &x) const |
| x += A'*e. More... | |
| void | multiplyHessianAdd (double alpha, const VectorValues &x, VectorValues &y) const |
| y += alpha * A'*A*x | |
| void | multiplyHessianAdd (double alpha, const double *x, double *y, std::vector< size_t > keys) const |
| y += alpha * A'*A*x | |
| void | multiplyHessianAdd (double alpha, const double *x, double *y) const |
| y += alpha * A'*A*x | |
| VectorValues | gradientAtZero () const |
| A'*b for Jacobian. | |
| virtual void | gradientAtZero (double *d) const |
| A'*b for Jacobian, eta for Hessian (raw memory version) | |
| JacobianFactor | whiten () const |
| Return a whitened version of the factor, i.e. More... | |
| std::pair< boost::shared_ptr < GaussianConditional > , boost::shared_ptr < JacobianFactor > > | eliminate (const Ordering &keys) |
| Eliminate the requested variables. More... | |
| void | setModel (bool anyConstrained, const Vector &sigmas) |
| set noiseModel correctly | |
| boost::shared_ptr < GaussianConditional > | splitConditional (size_t nrFrontals) |
| splits a pre-factorized factor into a conditional, and changes the current factor to be the remaining component. More... | |
| Public Member Functions inherited from gtsam::GaussianFactor | |
| GaussianFactor () | |
| Default constructor creates empty factor. | |
| template<typename CONTAINER > | |
| GaussianFactor (const CONTAINER &keys) | |
| Construct from container of keys. More... | |
| virtual | ~GaussianFactor () |
| Destructor. | |
| Public Member Functions inherited from gtsam::Factor | |
| Key | front () const |
| First key. | |
| Key | back () const |
| Last key. | |
| const_iterator | find (Key key) const |
| find | |
| const FastVector< Key > & | keys () const |
| Access the factor's involved variable keys. | |
| const_iterator | begin () const |
| Iterator at beginning of involved variable keys. | |
| const_iterator | end () const |
| Iterator at end of involved variable keys. | |
| size_t | size () const |
| void | print (const std::string &s="Factor", const KeyFormatter &formatter=DefaultKeyFormatter) const |
| print | |
| void | printKeys (const std::string &s="Factor", const KeyFormatter &formatter=DefaultKeyFormatter) const |
| print only keys | |
| FastVector< Key > & | keys () |
| iterator | begin () |
| Iterator at beginning of involved variable keys. | |
| iterator | end () |
| Iterator at end of involved variable keys. | |
| Public Member Functions inherited from gtsam::Conditional< JacobianFactor, GaussianConditional > | |
| size_t | nrFrontals () const |
| return the number of frontals | |
| size_t | nrParents () const |
| return the number of parents | |
| Key | firstFrontalKey () const |
| Convenience function to get the first frontal key. | |
| Frontals | frontals () const |
| return a view of the frontal keys | |
| Parents | parents () const |
| return a view of the parent keys | |
| JacobianFactor::const_iterator | beginFrontals () const |
| Iterator pointing to first frontal key. More... | |
| JacobianFactor::const_iterator | endFrontals () const |
| Iterator pointing past the last frontal key. More... | |
| JacobianFactor::const_iterator | beginParents () const |
| Iterator pointing to the first parent key. More... | |
| JacobianFactor::const_iterator | endParents () const |
| Iterator pointing past the last parent key. More... | |
| size_t & | nrFrontals () |
| Mutable version of nrFrontals. | |
| JacobianFactor::iterator | beginFrontals () |
| Mutable iterator pointing to first frontal key. More... | |
| JacobianFactor::iterator | endFrontals () |
| Mutable iterator pointing past the last frontal key. More... | |
| JacobianFactor::iterator | beginParents () |
| Mutable iterator pointing to the first parent key. More... | |
| JacobianFactor::iterator | endParents () |
| Mutable iterator pointing past the last parent key. More... | |
Static Public Member Functions | |
| static GaussianDensity | FromMeanAndStddev (Key key, const Vector &mean, const double &sigma) |
| Construct using a mean and variance. | |
| Static Public Member Functions inherited from gtsam::GaussianConditional | |
| template<typename ITERATOR > | |
| static shared_ptr | Combine (ITERATOR firstConditional, ITERATOR lastConditional) |
| Combine several GaussianConditional into a single dense GC. More... | |
Public Types | |
|
typedef boost::shared_ptr < GaussianDensity > | shared_ptr |
| Public Types inherited from gtsam::GaussianConditional | |
| typedef GaussianConditional | This |
| Typedef to this class. | |
| typedef boost::shared_ptr< This > | shared_ptr |
| shared_ptr to this class | |
| typedef JacobianFactor | BaseFactor |
| Typedef to our factor base class. | |
|
typedef Conditional < BaseFactor, This > | BaseConditional |
| Typedef to our conditional base class. | |
| Public Types inherited from gtsam::JacobianFactor | |
| typedef JacobianFactor | This |
| Typedef to this class. | |
| typedef GaussianFactor | Base |
| Typedef to base class. | |
| typedef boost::shared_ptr< This > | shared_ptr |
| shared_ptr to this class | |
| typedef VerticalBlockMatrix::Block | ABlock |
|
typedef VerticalBlockMatrix::constBlock | constABlock |
| typedef ABlock::ColXpr | BVector |
| typedef constABlock::ConstColXpr | constBVector |
| Public Types inherited from gtsam::GaussianFactor | |
| typedef GaussianFactor | This |
| This class. | |
| typedef boost::shared_ptr< This > | shared_ptr |
| shared_ptr to this class | |
| typedef Factor | Base |
| Our base class. | |
| Public Types inherited from gtsam::Factor | |
| typedef FastVector< Key >::iterator | iterator |
| Iterator over keys. | |
|
typedef FastVector< Key > ::const_iterator | const_iterator |
| Const iterator over keys. | |
| Public Types inherited from gtsam::Conditional< JacobianFactor, GaussianConditional > | |
|
typedef boost::iterator_range < typename JacobianFactor::const_iterator > | Frontals |
| View of the frontal keys (call frontals()) | |
|
typedef boost::iterator_range < typename JacobianFactor::const_iterator > | Parents |
| View of the separator keys (call parents()) | |
Additional Inherited Members | |
| Protected Member Functions inherited from gtsam::JacobianFactor | |
| template<typename TERMS > | |
| void | fillTerms (const TERMS &terms, const Vector &b, const SharedDiagonal &noiseModel) |
| Internal function to fill blocks and set dimensions. | |
| Protected Member Functions inherited from gtsam::Factor | |
| Factor () | |
| Default constructor for I/O. | |
| template<typename CONTAINER > | |
| Factor (const CONTAINER &keys) | |
| Construct factor from container of keys. More... | |
| template<typename ITERATOR > | |
| Factor (ITERATOR first, ITERATOR last) | |
| Construct factor from iterator keys. More... | |
| bool | equals (const This &other, double tol=1e-9) const |
| check equality | |
| Protected Member Functions inherited from gtsam::Conditional< JacobianFactor, GaussianConditional > | |
| Conditional () | |
| Empty Constructor to make serialization possible. | |
| Conditional (size_t nrFrontals) | |
| Constructor. | |
| void | print (const std::string &s="Conditional", const KeyFormatter &formatter=DefaultKeyFormatter) const |
| print with optional formatter | |
| bool | equals (const This &c, double tol=1e-9) const |
| check equality | |
| Static Protected Member Functions inherited from gtsam::Factor | |
| template<typename CONTAINER > | |
| static Factor | FromKeys (const CONTAINER &keys) |
| Construct factor from container of keys. More... | |
| template<typename ITERATOR > | |
| static Factor | FromIterators (ITERATOR first, ITERATOR last) |
| Construct factor from iterator keys. More... | |
| Protected Attributes inherited from gtsam::JacobianFactor | |
| VerticalBlockMatrix | Ab_ |
| noiseModel::Diagonal::shared_ptr | model_ |
| Protected Attributes inherited from gtsam::Factor | |
| FastVector< Key > | keys_ |
| The keys involved in this factor. | |
| Protected Attributes inherited from gtsam::Conditional< JacobianFactor, GaussianConditional > | |
| size_t | nrFrontals_ |
| The first nrFrontal variables are frontal and the rest are parents. More... | |
1.8.6 
