#include <RangeFactor.h>
Public Member Functions | |
gtsam::NonlinearFactor::shared_ptr | clone () const override |
Vector | evaluateError (const A1 &a1, const A2 &a2, Matrix &H1, Matrix &H2) const |
Vector | evaluateError (const A1 &a1, const A2 &a2, OptionalMatrixType H1=OptionalNone, OptionalMatrixType H2=OptionalNone) const |
Expression< T > | expression (const typename Base::ArrayNKeys &keys) const override |
void | print (const std::string &s="", const KeyFormatter &keyFormatter=DefaultKeyFormatter) const override |
RangeFactorWithTransform () | |
RangeFactorWithTransform (Key key1, Key key2, T measured, const SharedNoiseModel &model, const A1 &body_T_sensor) | |
~RangeFactorWithTransform () override | |
![]() | |
virtual Expression< typename Range< A1, A1 >::result_type > | expression (const ArrayNKeys &keys) const |
![]() | |
gtsam::NonlinearFactor::shared_ptr | clone () const override |
bool | equals (const NonlinearFactor &f, double tol) const override |
equals relies on Testable traits being defined for T More... | |
ExpressionFactor (const SharedNoiseModel &noiseModel, const typename Range< A1, A1 >::result_type &measurement, const Expression< typename Range< A1, A1 >::result_type > &expression) | |
std::shared_ptr< GaussianFactor > | linearize (const Values &x) const override |
const typename Range< A1, A1 >::result_type & | measured () const |
void | print (const std::string &s="", const KeyFormatter &keyFormatter=DefaultKeyFormatter) const override |
print relies on Testable traits being defined for T More... | |
virtual Vector | unwhitenedError (const Values &x, OptionalMatrixVecType H=nullptr) const =0 |
Vector | unwhitenedError (const Values &x, OptionalMatrixVecType H=nullptr) const override |
Vector | unwhitenedError (const Values &x, std::vector< Matrix > &H) const |
~ExpressionFactor () override | |
Destructor. More... | |
Private Types | |
typedef ExpressionFactorN< T, A1, A2 > | Base |
typedef RangeFactorWithTransform< A1, A2 > | This |
Private Attributes | |
A1 | body_T_sensor_ |
The pose of the sensor in the body frame. More... | |
Additional Inherited Members | |
![]() | |
using | ArrayNKeys = std::array< Key, NARY_EXPRESSION_SIZE > |
![]() | |
typedef std::shared_ptr< ExpressionFactor< typename Range< A1, A1 >::result_type > > | shared_ptr |
![]() | |
static const std::size_t | NARY_EXPRESSION_SIZE |
![]() | |
typedef ExpressionFactor< typename Range< A1, A1 >::result_type > | This |
![]() | |
ExpressionFactorN ()=default | |
Default constructor, for serialization. More... | |
ExpressionFactorN (const ArrayNKeys &keys, const SharedNoiseModel &noiseModel, const typename Range< A1, A1 >::result_type &measurement) | |
Constructor takes care of keys, but still need to call initialize. More... | |
![]() | |
ExpressionFactor () | |
ExpressionFactor (const SharedNoiseModel &noiseModel, const typename Range< A1, A1 >::result_type &measurement) | |
Default constructor, for serialization. More... | |
void | initialize (const Expression< typename Range< A1, A1 >::result_type > &expression) |
Initialize with constructor arguments. More... | |
![]() | |
FastVector< int > | dims_ |
dimensions of the Jacobian matrices More... | |
Expression< typename Range< A1, A1 >::result_type > | expression_ |
the expression that is AD enabled More... | |
typename Range< A1, A1 >::result_type | measured_ |
the measurement to be compared with the expression More... | |
![]() | |
static const int | Dim |
Binary factor for a range measurement, with a transform applied
Definition at line 104 of file sam/RangeFactor.h.
|
private |
Definition at line 107 of file sam/RangeFactor.h.
|
private |
Definition at line 106 of file sam/RangeFactor.h.
|
inline |
Definition at line 113 of file sam/RangeFactor.h.
|
inline |
Definition at line 115 of file sam/RangeFactor.h.
|
inlineoverride |
Definition at line 122 of file sam/RangeFactor.h.
|
inlineoverride |
Definition at line 125 of file sam/RangeFactor.h.
|
inline |
Definition at line 154 of file sam/RangeFactor.h.
|
inline |
Definition at line 140 of file sam/RangeFactor.h.
|
inlineoverride |
Definition at line 131 of file sam/RangeFactor.h.
|
inlineoverride |
print contents
Definition at line 159 of file sam/RangeFactor.h.
|
private |
The pose of the sensor in the body frame.
Definition at line 109 of file sam/RangeFactor.h.