#include <Pose3Upright.h>
Static Public Attributes | |
static const size_t | dimension = 4 |
Protected Attributes | |
Pose2 | T_ |
double | z_ |
Standard Constructors | |
Pose3Upright () | |
Default constructor initializes at origin. More... | |
Pose3Upright (const Pose3Upright &x) | |
Copy constructor. More... | |
Pose3Upright (const Rot2 &bearing, const Point3 &t) | |
Pose3Upright (double x, double y, double z, double theta) | |
Pose3Upright (const Pose2 &pose, double z) | |
Pose3Upright (const Pose3 &fullpose) | |
Down-converts from a full Pose3. More... | |
Testable | |
void | print (const std::string &s="") const |
bool | equals (const Pose3Upright &pose, double tol=1e-9) const |
Standard Interface | |
double | x () const |
double | y () const |
double | z () const |
double | theta () const |
Point2 | translation2 () const |
Point3 | translation () const |
Rot2 | rotation2 () const |
Rot3 | rotation () const |
Pose2 | pose2 () const |
Pose3 | pose () const |
Manifold | |
size_t | dim () const |
Dimensionality of tangent space = 4 DOF. More... | |
Pose3Upright | retract (const Vector &v) const |
Vector | localCoordinates (const Pose3Upright &p2) const |
Local 3D coordinates of Pose3Upright manifold neighborhood around current pose. More... | |
static size_t | Dim () |
Dimensionality of tangent space = 4 DOF - used to autodetect sizes. More... | |
Group | |
Pose3Upright | inverse (OptionalJacobian< 4, 4 > H1={}) const |
inverse transformation with derivatives More... | |
Pose3Upright | compose (const Pose3Upright &p2, OptionalJacobian< 4, 4 > H1={}, OptionalJacobian< 4, 4 > H2={}) const |
compose this transformation onto another (first *this and then p2) More... | |
Pose3Upright | operator* (const Pose3Upright &T) const |
compose syntactic sugar More... | |
Pose3Upright | between (const Pose3Upright &p2, OptionalJacobian< 4, 4 > H1={}, OptionalJacobian< 4, 4 > H2={}) const |
static Pose3Upright | Identity () |
identity for group operation More... | |
Lie Group | |
static Pose3Upright | Expmap (const Vector &xi) |
Exponential map at identity - create a rotation from canonical coordinates. More... | |
static Vector | Logmap (const Pose3Upright &p) |
Log map at identity - return the canonical coordinates of this rotation. More... | |
A 3D Pose with fixed pitch and roll
Definition at line 25 of file Pose3Upright.h.
|
inline |
Default constructor initializes at origin.
Definition at line 39 of file Pose3Upright.h.
|
inline |
Copy constructor.
Definition at line 42 of file Pose3Upright.h.
Definition at line 19 of file Pose3Upright.cpp.
gtsam::Pose3Upright::Pose3Upright | ( | double | x, |
double | y, | ||
double | z, | ||
double | theta | ||
) |
Definition at line 25 of file Pose3Upright.cpp.
gtsam::Pose3Upright::Pose3Upright | ( | const Pose2 & | pose, |
double | z | ||
) |
Definition at line 31 of file Pose3Upright.cpp.
gtsam::Pose3Upright::Pose3Upright | ( | const Pose3 & | fullpose | ) |
Down-converts from a full Pose3.
Definition at line 37 of file Pose3Upright.cpp.
Pose3Upright gtsam::Pose3Upright::between | ( | const Pose3Upright & | p2, |
OptionalJacobian< 4, 4 > | H1 = {} , |
||
OptionalJacobian< 4, 4 > | H2 = {} |
||
) | const |
Return relative pose between p1 and p2, in p1 coordinate frame as well as optionally the derivatives
Definition at line 118 of file Pose3Upright.cpp.
Pose3Upright gtsam::Pose3Upright::compose | ( | const Pose3Upright & | p2, |
OptionalJacobian< 4, 4 > | H1 = {} , |
||
OptionalJacobian< 4, 4 > | H2 = {} |
||
) | const |
compose this transformation onto another (first *this and then p2)
Definition at line 99 of file Pose3Upright.cpp.
|
inlinestatic |
Dimensionality of tangent space = 4 DOF - used to autodetect sizes.
Definition at line 81 of file Pose3Upright.h.
|
inline |
Dimensionality of tangent space = 4 DOF.
Definition at line 84 of file Pose3Upright.h.
bool gtsam::Pose3Upright::equals | ( | const Pose3Upright & | pose, |
double | tol = 1e-9 |
||
) | const |
assert equality up to a tolerance
Definition at line 48 of file Pose3Upright.cpp.
|
static |
Exponential map at identity - create a rotation from canonical coordinates.
Definition at line 152 of file Pose3Upright.cpp.
|
inlinestatic |
identity for group operation
Definition at line 98 of file Pose3Upright.h.
Pose3Upright gtsam::Pose3Upright::inverse | ( | OptionalJacobian< 4, 4 > | H1 = {} | ) | const |
inverse transformation with derivatives
Definition at line 83 of file Pose3Upright.cpp.
Vector gtsam::Pose3Upright::localCoordinates | ( | const Pose3Upright & | p2 | ) | const |
Local 3D coordinates of Pose3Upright manifold neighborhood around current pose.
Definition at line 144 of file Pose3Upright.cpp.
|
static |
Log map at identity - return the canonical coordinates of this rotation.
Definition at line 159 of file Pose3Upright.cpp.
|
inline |
compose syntactic sugar
Definition at line 109 of file Pose3Upright.h.
Pose3 gtsam::Pose3Upright::pose | ( | ) | const |
Definition at line 78 of file Pose3Upright.cpp.
Pose2 gtsam::Pose3Upright::pose2 | ( | ) | const |
Definition at line 73 of file Pose3Upright.cpp.
void gtsam::Pose3Upright::print | ( | const std::string & | s = "" | ) | const |
print with optional string
Definition at line 43 of file Pose3Upright.cpp.
Pose3Upright gtsam::Pose3Upright::retract | ( | const Vector & | v | ) | const |
Retraction from R^4 to Pose3Upright manifold neighborhood around current pose Tangent space parameterization is [x y z theta]
Definition at line 137 of file Pose3Upright.cpp.
Rot3 gtsam::Pose3Upright::rotation | ( | ) | const |
Definition at line 68 of file Pose3Upright.cpp.
Rot2 gtsam::Pose3Upright::rotation2 | ( | ) | const |
Definition at line 63 of file Pose3Upright.cpp.
|
inline |
Definition at line 67 of file Pose3Upright.h.
Point3 gtsam::Pose3Upright::translation | ( | ) | const |
Definition at line 53 of file Pose3Upright.cpp.
Point2 gtsam::Pose3Upright::translation2 | ( | ) | const |
Definition at line 58 of file Pose3Upright.cpp.
|
inline |
Definition at line 64 of file Pose3Upright.h.
|
inline |
Definition at line 65 of file Pose3Upright.h.
|
inline |
Definition at line 66 of file Pose3Upright.h.
|
static |
Definition at line 27 of file Pose3Upright.h.
|
protected |
Definition at line 31 of file Pose3Upright.h.
|
protected |
Definition at line 32 of file Pose3Upright.h.