GTSAM  4.0.2
C++ library for smoothing and mapping (SAM)
Public Types | List of all members
gtsam::CalibratedCamera Class Reference

#include <CalibratedCamera.h>

Inheritance diagram for gtsam::CalibratedCamera:
Inheritance graph
[legend]
Collaboration diagram for gtsam::CalibratedCamera:
Collaboration graph
[legend]

Public Types

enum  { dimension = 6 }
 
typedef Rot3 Rotation
 
typedef Point3 Translation
 
typedef Point2 Measurement
 
typedef Point2Vector MeasurementVector
 

Derivatives

static Matrix26 Dpose (const Point2 &pn, double d)
 
static Matrix23 Dpoint (const Point2 &pn, double d, const Matrix3 &Rt)
 

Static functions

static Pose3 LevelPose (const Pose2 &pose2, double height)
 
static Pose3 LookatPose (const Point3 &eye, const Point3 &target, const Point3 &upVector)
 

Testable

bool equals (const PinholeBase &camera, double tol=1e-9) const
 assert equality up to a tolerance
 

Standard Interface

const Pose3pose () const
 return pose, constant version
 
const Rot3rotation () const
 get rotation
 
const Point3translation () const
 get translation
 
const Pose3getPose (OptionalJacobian< 6, 6 > H) const
 return pose, with derivative
 

Transformations and measurement functions

std::pair< Point2, bool > projectSafe (const Point3 &pw) const
 Project a point into the image and check depth.
 
Point2 project2 (const Point3 &point, OptionalJacobian< 2, 6 > Dpose={}, OptionalJacobian< 2, 3 > Dpoint={}) const
 
Point2 project2 (const Unit3 &point, OptionalJacobian< 2, 6 > Dpose={}, OptionalJacobian< 2, 2 > Dpoint={}) const
 
static Point2 Project (const Point3 &pc, OptionalJacobian< 2, 3 > Dpoint={})
 
static Point2 Project (const Unit3 &pc, OptionalJacobian< 2, 2 > Dpoint={})
 
static Point3 BackprojectFromCamera (const Point2 &p, const double depth, OptionalJacobian< 3, 2 > Dpoint={}, OptionalJacobian< 3, 1 > Ddepth={})
 backproject a 2-dimensional point to a 3-dimensional point at given depth
 

Advanced interface

static std::pair< size_t, size_t > translationInterval ()
 

Standard Constructors

 CalibratedCamera ()
 default constructor
 
 CalibratedCamera (const Pose3 &pose)
 construct with pose
 

Named Constructors

static CalibratedCamera Create (const Pose3 &pose, OptionalJacobian< dimension, 6 > H1={})
 
static CalibratedCamera Level (const Pose2 &pose2, double height)
 
static CalibratedCamera Lookat (const Point3 &eye, const Point3 &target, const Point3 &upVector)
 

Advanced Constructors

 CalibratedCamera (const Vector &v)
 construct from vector
 

Manifold

CalibratedCamera retract (const Vector &d) const
 move a cameras pose according to d
 
Vector localCoordinates (const CalibratedCamera &T2) const
 Return canonical coordinate.
 
void print (const std::string &s="CalibratedCamera") const override
 print
 
size_t dim () const
 
static size_t Dim ()
 

Transformations and measurement functions

Point2 project (const Point3 &point, OptionalJacobian< 2, 6 > Dcamera={}, OptionalJacobian< 2, 3 > Dpoint={}) const
 
Point3 backproject (const Point2 &pn, double depth, OptionalJacobian< 3, 6 > Dresult_dpose={}, OptionalJacobian< 3, 2 > Dresult_dp={}, OptionalJacobian< 3, 1 > Dresult_ddepth={}) const
 backproject a 2-dimensional point to a 3-dimensional point at given depth
 
double range (const Point3 &point, OptionalJacobian< 1, 6 > Dcamera={}, OptionalJacobian< 1, 3 > Dpoint={}) const
 
double range (const Pose3 &pose, OptionalJacobian< 1, 6 > Dcamera={}, OptionalJacobian< 1, 6 > Dpose={}) const
 
double range (const CalibratedCamera &camera, OptionalJacobian< 1, 6 > H1={}, OptionalJacobian< 1, 6 > H2={}) const
 

Detailed Description

A Calibrated camera class [R|-R't], calibration K=I. If calibration is known, it is more computationally efficient to calibrate the measurements rather than try to predict in pixels.

Member Typedef Documentation

◆ Measurement

Some classes template on either PinholeCamera or StereoCamera, and this typedef informs those classes what "project" returns.

◆ Rotation

Pose Concept requirements

Member Function Documentation

◆ dim()

size_t gtsam::CalibratedCamera::dim ( ) const
inline

◆ Dim()

static size_t gtsam::CalibratedCamera::Dim ( )
inlinestatic

◆ Dpoint()

static Matrix23 gtsam::PinholeBase::Dpoint ( const Point2 pn,
double  d,
const Matrix3 &  Rt 
)
staticprotectedinherited

Calculate Jacobian with respect to point

Parameters
pnprojection in normalized coordinates
ddisparity (inverse depth)
Rttransposed rotation matrix

◆ Dpose()

static Matrix26 gtsam::PinholeBase::Dpose ( const Point2 pn,
double  d 
)
staticprotectedinherited

Calculate Jacobian with respect to pose

Parameters
pnprojection in normalized coordinates
ddisparity (inverse depth)

◆ Level()

static CalibratedCamera gtsam::CalibratedCamera::Level ( const Pose2 pose2,
double  height 
)
static

Create a level camera at the given 2D pose and height

Parameters
pose2specifies the location and viewing direction
heightspecifies the height of the camera (along the positive Z-axis) (theta 0 = looking in direction of positive X axis)

◆ LevelPose()

static Pose3 gtsam::PinholeBase::LevelPose ( const Pose2 pose2,
double  height 
)
staticinherited

Create a level pose at the given 2D pose and height

Parameters
Kthe calibration
pose2specifies the location and viewing direction (theta 0 = looking in direction of positive X axis)
heightcamera height

◆ Lookat()

static CalibratedCamera gtsam::CalibratedCamera::Lookat ( const Point3 eye,
const Point3 target,
const Point3 upVector 
)
static

Create a camera at the given eye position looking at a target point in the scene with the specified up direction vector.

Parameters
eyespecifies the camera position
targetthe point to look at
upVectorspecifies the camera up direction vector, doesn't need to be on the image plane nor orthogonal to the viewing axis

◆ LookatPose()

static Pose3 gtsam::PinholeBase::LookatPose ( const Point3 eye,
const Point3 target,
const Point3 upVector 
)
staticinherited

Create a camera pose at the given eye position looking at a target point in the scene with the specified up direction vector.

Parameters
eyespecifies the camera position
targetthe point to look at
upVectorspecifies the camera up direction vector, doesn't need to be on the image plane nor orthogonal to the viewing axis

◆ Project() [1/2]

static Point2 gtsam::PinholeBase::Project ( const Point3 pc,
OptionalJacobian< 2, 3 >  Dpoint = {} 
)
staticinherited

Project from 3D point in camera coordinates into image Does not throw a CheiralityException, even if pc behind image plane

Parameters
pcpoint in camera coordinates

◆ Project() [2/2]

static Point2 gtsam::PinholeBase::Project ( const Unit3 pc,
OptionalJacobian< 2, 2 >  Dpoint = {} 
)
staticinherited

Project from 3D point at infinity in camera coordinates into image Does not throw a CheiralityException, even if pc behind image plane

Parameters
pcpoint in camera coordinates

◆ project()

Point2 gtsam::CalibratedCamera::project ( const Point3 point,
OptionalJacobian< 2, 6 >  Dcamera = {},
OptionalJacobian< 2, 3 >  Dpoint = {} 
) const
Deprecated:
Use project2, which is more consistently named across Pinhole cameras

◆ project2() [1/2]

Point2 gtsam::PinholeBase::project2 ( const Point3 point,
OptionalJacobian< 2, 6 >  Dpose = {},
OptionalJacobian< 2, 3 >  Dpoint = {} 
) const
inherited

Project point into the image Throws a CheiralityException if point behind image plane iff GTSAM_THROW_CHEIRALITY_EXCEPTION

Parameters
point3D point in world coordinates
Returns
the intrinsic coordinates of the projected point

◆ project2() [2/2]

Point2 gtsam::PinholeBase::project2 ( const Unit3 point,
OptionalJacobian< 2, 6 >  Dpose = {},
OptionalJacobian< 2, 2 >  Dpoint = {} 
) const
inherited

Project point at infinity into the image Throws a CheiralityException if point behind image plane iff GTSAM_THROW_CHEIRALITY_EXCEPTION

Parameters
point3D point in world coordinates
Returns
the intrinsic coordinates of the projected point

◆ range() [1/3]

double gtsam::CalibratedCamera::range ( const Point3 point,
OptionalJacobian< 1, 6 >  Dcamera = {},
OptionalJacobian< 1, 3 >  Dpoint = {} 
) const
inline

Calculate range to a landmark

Parameters
point3D location of landmark
Returns
range (double)

◆ range() [2/3]

double gtsam::CalibratedCamera::range ( const Pose3 pose,
OptionalJacobian< 1, 6 >  Dcamera = {},
OptionalJacobian< 1, 6 >  Dpose = {} 
) const
inline

Calculate range to another pose

Parameters
poseOther SO(3) pose
Returns
range (double)

◆ range() [3/3]

double gtsam::CalibratedCamera::range ( const CalibratedCamera camera,
OptionalJacobian< 1, 6 >  H1 = {},
OptionalJacobian< 1, 6 >  H2 = {} 
) const
inline

Calculate range to another camera

Parameters
cameraOther camera
Returns
range (double)

◆ translationInterval()

static std::pair<size_t, size_t> gtsam::PinholeBase::translationInterval ( )
inlinestaticinherited

Return the start and end indices (inclusive) of the translation component of the exponential map parameterization

Returns
a pair of [start, end] indices into the tangent space vector

The documentation for this class was generated from the following file: