From 9f66fa20becfb4048bb10dbb3b086e5fddc16da2 Mon Sep 17 00:00:00 2001 From: Andrew Melim Date: Mon, 6 Feb 2012 14:05:59 +0000 Subject: [PATCH] Added CalibratedCamera to gtsam.h --- gtsam.h | 22 ++++++++++++++++++++++ 1 file changed, 22 insertions(+) diff --git a/gtsam.h b/gtsam.h index d73fd563b..c17906df1 100644 --- a/gtsam.h +++ b/gtsam.h @@ -207,6 +207,28 @@ class Pose3 { gtsam::Rot3 rotation() const; }; +class CalibratedCamera { + + CalibratedCamera(); + CalibratedCamera(const gtsam::Pose3& pose); + CalibratedCamera(const Vector& v); + + void print(string s) const; + bool equals(const gtsam::Pose3& pose, double tol) const; + + gtsam::Pose3 pose() const; + + gtsam::CalibratedCamera compose(const gtsam::CalibratedCamera& c) const; + gtsam::CalibratedCamera inverse() const; + gtsam::CalibratedCamera level(const gtsam::Pose2& pose2, double height); + gtsam::CalibratedCamera retract(const Vector& d) const; + Vector localCoordinates(const gtsam::CalibratedCamera& T2) const; + + gtsam::Point2 project(const gtsam::Point3& point) const; + static gtsam::Point2 project_to_camera(const gtsam::Point3& cameraPoint); +}; + + //************************************************************************* // inference //*************************************************************************