From 509c2b4c67cc6b406cd366dcec6eac4059c6ebc0 Mon Sep 17 00:00:00 2001 From: Duy-Nguyen Ta Date: Mon, 18 Jun 2012 18:12:19 +0000 Subject: [PATCH] wrap LieVector --- gtsam.h | 28 ++++++++++++++++++++++++++++ 1 file changed, 28 insertions(+) diff --git a/gtsam.h b/gtsam.h index 1b9689a77..20f0e7a57 100644 --- a/gtsam.h +++ b/gtsam.h @@ -63,6 +63,34 @@ namespace gtsam { // base //************************************************************************* +class LieVector { + // Standard constructors + LieVector(); + LieVector(Vector v); + + // Standard interface + Vector vector() const; + + // Testable + void print(string s) const; + bool equals(const gtsam::LieVector& expected, double tol) const; + + // Group + static gtsam::LieVector identity(); + gtsam::LieVector inverse() const; + gtsam::LieVector compose(const gtsam::LieVector& p) const; + gtsam::LieVector between(const gtsam::LieVector& l2) const; + + // Manifold + size_t dim() const; + gtsam::LieVector retract(Vector v) const; + Vector localCoordinates(const gtsam::LieVector& t2) const; + + // Lie group + static gtsam::LieVector Expmap(Vector v); + static Vector Logmap(const gtsam::LieVector& p); +}; + //************************************************************************* // geometry //*************************************************************************