#include <BearingRange.h>
Public Types | |
enum | { dimB = traits<B>::dimension } |
enum | { dimR = traits<R>::dimension } |
enum | { dimension = dimB + dimR } |
Public Member Functions | |
Standard Constructors | |
BearingRange () | |
BearingRange (const B &b, const R &r) | |
Testable | |
void | print (const std::string &str="") const |
bool | equals (const BearingRange< A1, A2 > &m2, double tol=1e-8) const |
Private Types | |
enum | { NeedsToAlign = (sizeof(B) % 16) == 0 || (sizeof(R) % 16) == 0 } |
Private Attributes | |
B | bearing_ |
R | range_ |
Standard Interface | |
const B & | bearing () const |
Return bearing measurement. More... | |
const R & | range () const |
Return range measurement. More... | |
static BearingRange | Measure (const A1 &a1, const A2 &a2, OptionalJacobian< dimension, traits< A1 >::dimension > H1=boost::none, OptionalJacobian< dimension, traits< A2 >::dimension > H2=boost::none) |
Prediction function that stacks measurements. More... | |
static B | MeasureBearing (const A1 &a1, const A2 &a2) |
Predict bearing. More... | |
static R | MeasureRange (const A1 &a1, const A2 &a2) |
Predict range. More... | |
Manifold | |
typedef Eigen::Matrix< double, dimension, 1 > | TangentVector |
typedef OptionalJacobian< dimension, dimension > | ChartJacobian |
size_t | dim () const |
BearingRange | retract (const TangentVector &xi) const |
Retract delta to manifold. More... | |
TangentVector | localCoordinates (const BearingRange &other) const |
Compute the coordinates in the tangent space. More... | |
static size_t | Dim () |
Advanced Interface | |
class | boost::serialization::access |
template<class ARCHIVE > | |
void | serialize (ARCHIVE &ar, const unsigned int) |
Serialization function. More... | |
Bearing-Range product for a particular A1,A2 combination will use the functors above to create a similar functor of type A1*A2 -> pair<Bearing::return_type,Range::return_type> For example BearingRange<Pose2,Point2>(pose,point) will return pair<Rot2,double> and BearingRange<Pose3,Point3>(pose,point) will return pair<Unit3,double>
Definition at line 50 of file BearingRange.h.
typedef OptionalJacobian<dimension, dimension> gtsam::BearingRange< A1, A2, B, R >::ChartJacobian |
Definition at line 126 of file BearingRange.h.
typedef Eigen::Matrix<double, dimension, 1> gtsam::BearingRange< A1, A2, B, R >::TangentVector |
Definition at line 125 of file BearingRange.h.
anonymous enum |
Enumerator | |
---|---|
dimB |
Definition at line 56 of file BearingRange.h.
anonymous enum |
Enumerator | |
---|---|
dimR |
Definition at line 57 of file BearingRange.h.
anonymous enum |
Enumerator | |
---|---|
dimension |
Definition at line 58 of file BearingRange.h.
|
private |
Enumerator | |
---|---|
NeedsToAlign |
Definition at line 161 of file BearingRange.h.
|
inline |
Definition at line 63 of file BearingRange.h.
|
inline |
Definition at line 64 of file BearingRange.h.
|
inline |
Return bearing measurement.
Definition at line 71 of file BearingRange.h.
|
inlinestatic |
Definition at line 122 of file BearingRange.h.
|
inline |
Definition at line 123 of file BearingRange.h.
|
inline |
Definition at line 113 of file BearingRange.h.
|
inline |
Compute the coordinates in the tangent space.
Definition at line 136 of file BearingRange.h.
|
inlinestatic |
Prediction function that stacks measurements.
Definition at line 77 of file BearingRange.h.
|
inlinestatic |
Predict bearing.
Definition at line 95 of file BearingRange.h.
|
inlinestatic |
Predict range.
Definition at line 100 of file BearingRange.h.
|
inline |
Definition at line 108 of file BearingRange.h.
|
inline |
Return range measurement.
Definition at line 74 of file BearingRange.h.
|
inline |
Retract delta to manifold.
Definition at line 129 of file BearingRange.h.
|
inlineprivate |
Serialization function.
Definition at line 151 of file BearingRange.h.
|
friend |
Definition at line 156 of file BearingRange.h.
|
private |
Definition at line 52 of file BearingRange.h.
|
private |
Definition at line 53 of file BearingRange.h.