NDEVR
API Documentation
se3_ops.h
1// g2o - General Graph Optimization
2// Copyright (C) 2011 H. Strasdat
3// All rights reserved.
4//
5// Redistribution and use in source and binary forms, with or without
6// modification, are permitted provided that the following conditions are
7// met:
8//
9// * Redistributions of source code must retain the above copyright notice,
10// this list of conditions and the following disclaimer.
11// * Redistributions in binary form must reproduce the above copyright
12// notice, this list of conditions and the following disclaimer in the
13// documentation and/or other materials provided with the distribution.
14//
15// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
16// IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
17// TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
18// PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
19// HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
20// SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
21// TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
22// PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
23// LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
24// NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
25// SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26
27#ifndef G2O_MATH_STUFF
28#define G2O_MATH_STUFF
29
30#include <Eigen/Core>
31#include <Eigen/Geometry>
32
33namespace NDEVR
34{
35 using namespace Eigen;
39 inline Matrix3<g_type> skew(const Vector3<g_type>& v);
43 inline Vector3<g_type> deltaR(const Matrix3<g_type>& R);
47 inline Vector2<g_type> project(const Vector3<g_type>&);
51 inline Vector3<g_type> project(const Vector4<g_type>&);
55 inline Vector3<g_type> unproject(const Vector2<g_type>&);
59 inline Vector4<g_type> unproject(const Vector3<g_type>&);
60
61}
62#include "se3_ops.hpp"
63#endif //MATH_STUFF
The primary namespace for the NDEVR SDK.
Vector3< g_type > unproject(const Vector2< g_type > &)
Unprojects a 2D point to 3D by appending z=1.
Definition se3_ops.hpp:69
Vector3< g_type > deltaR(const Matrix3< g_type > &R)
Extracts the rotation vector from a rotation matrix using the Rodrigues formula.
Definition se3_ops.hpp:41
Matrix3< g_type > skew(const Vector3< g_type > &v)
Computes the 3x3 skew-symmetric matrix from a 3D vector.
Definition se3_ops.hpp:28
Vector2< g_type > project(const Vector3< g_type > &)
Projects a 3D point to 2D by dividing by the z component.
Definition se3_ops.hpp:50