#include <BearingRangeFactor.h>
Public Types | |
typedef std::shared_ptr< This > | shared_ptr |
![]() | |
using | ArrayNKeys = std::array< Key, NARY_EXPRESSION_SIZE > |
![]() | |
typedef std::shared_ptr< ExpressionFactor< BearingRange< A1, A2 > > > | shared_ptr |
Public Member Functions | |
BearingRangeFactor () | |
Default constructor. More... | |
BearingRangeFactor (Key key1, Key key2, const B &measuredBearing, const R &measuredRange, const SharedNoiseModel &model) | |
Construct from separate bearing and range. More... | |
BearingRangeFactor (Key key1, Key key2, const T &bearingRange, const SharedNoiseModel &model) | |
Construct from BearingRange instance. More... | |
gtsam::NonlinearFactor::shared_ptr | clone () const override |
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 &kf=DefaultKeyFormatter) const override |
print More... | |
~BearingRangeFactor () override | |
![]() | |
virtual Expression< BearingRange< A1, A2 > > | 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 BearingRange< A1, A2 > &measurement, const Expression< BearingRange< A1, A2 > > &expression) | |
std::shared_ptr< GaussianFactor > | linearize (const Values &x) const override |
const BearingRange< A1, A2 > & | 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 BearingRange< A1, A2 > | T |
typedef BearingRangeFactor< A1, A2 > | This |
Additional Inherited Members | |
![]() | |
static const std::size_t | NARY_EXPRESSION_SIZE |
![]() | |
typedef ExpressionFactor< BearingRange< A1, A2 > > | This |
![]() | |
ExpressionFactorN ()=default | |
Default constructor, for serialization. More... | |
ExpressionFactorN (const ArrayNKeys &keys, const SharedNoiseModel &noiseModel, const BearingRange< A1, A2 > &measurement) | |
Constructor takes care of keys, but still need to call initialize. More... | |
![]() | |
ExpressionFactor () | |
ExpressionFactor (const SharedNoiseModel &noiseModel, const BearingRange< A1, A2 > &measurement) | |
Default constructor, for serialization. More... | |
void | initialize (const Expression< BearingRange< A1, A2 > > &expression) |
Initialize with constructor arguments. More... | |
![]() | |
FastVector< int > | dims_ |
dimensions of the Jacobian matrices More... | |
Expression< BearingRange< A1, A2 > > | expression_ |
the expression that is AD enabled More... | |
BearingRange< A1, A2 > | measured_ |
the measurement to be compared with the expression More... | |
![]() | |
static const int | Dim |
Binary factor for a bearing/range measurement
Definition at line 34 of file sam/BearingRangeFactor.h.
|
private |
Definition at line 38 of file sam/BearingRangeFactor.h.
typedef std::shared_ptr<This> gtsam::BearingRangeFactor< A1, A2, B, R >::shared_ptr |
Definition at line 42 of file sam/BearingRangeFactor.h.
|
private |
Definition at line 37 of file sam/BearingRangeFactor.h.
|
private |
Definition at line 39 of file sam/BearingRangeFactor.h.
|
inline |
Default constructor.
Definition at line 45 of file sam/BearingRangeFactor.h.
|
inline |
Construct from BearingRange instance.
Definition at line 48 of file sam/BearingRangeFactor.h.
|
inline |
Construct from separate bearing and range.
Definition at line 55 of file sam/BearingRangeFactor.h.
|
inlineoverride |
Definition at line 61 of file sam/BearingRangeFactor.h.
|
inlineoverride |
Definition at line 64 of file sam/BearingRangeFactor.h.
|
inline |
Definition at line 75 of file sam/BearingRangeFactor.h.
|
inlineoverride |
Definition at line 70 of file sam/BearingRangeFactor.h.
|
inlineoverride |
Definition at line 87 of file sam/BearingRangeFactor.h.