GTSAM
4.0.2
C++ library for smoothing and mapping (SAM)
|
#include <InvDepthCamera3.h>
Standard Constructors | |
InvDepthCamera3 () | |
InvDepthCamera3 (const Pose3 &pose, const std::shared_ptr< CALIBRATION > &k) | |
Standard Interface | |
virtual | ~InvDepthCamera3 () |
Pose3 & | pose () |
return pose | |
const std::shared_ptr< CALIBRATION > & | calibration () const |
return calibration | |
void | print (const std::string &s="") const |
print | |
gtsam::Point2 | project (const Vector5 &pw, double rho, OptionalJacobian< 2, 6 > H1={}, OptionalJacobian< 2, 5 > H2={}, OptionalJacobian< 2, 1 > H3={}) const |
std::pair< Vector5, double > | backproject (const gtsam::Point2 &pi, const double depth) const |
static gtsam::Point3 | invDepthTo3D (const Vector5 &pw, double rho) |
A pinhole camera class that has a Pose3 and a Calibration.
|
inline |
default constructor
|
inline |
constructor with pose and calibration
|
inline |
backproject a 2-dimensional point to an Inverse Depth landmark useful for point initialization
|
inlinestatic |
Convert an inverse depth landmark to cartesian Point3
pw | first five parameters (x,y,z,theta,phi) of inv depth landmark |
inv | inverse depth |
|
inline |
project a point from world InvDepth parameterization to the image
pw | is a point in the world coordinate |
H1 | is the jacobian w.r.t. [pose3 calibration] |
H2 | is the jacobian w.r.t. inv_depth_landmark |