g2o
Loading...
Searching...
No Matches
Functions
se3_ops.hpp File Reference
This graph shows which files directly or indirectly include this file:

Go to the source code of this file.

Functions

Matrix3 skew (const Vector3 &v)
 
Vector3 deltaR (const Matrix3 &R)
 
Vector2 project (const Vector3 &v)
 
Vector3 project (const Vector4 &v)
 
Vector3 unproject (const Vector2 &v)
 
Vector4 unproject (const Vector3 &v)
 

Function Documentation

◆ deltaR()

Vector3 deltaR ( const Matrix3 &  R)

Definition at line 39 of file se3_ops.hpp.

39 {
40 Vector3 v;
41 v(0) = R(2, 1) - R(1, 2);
42 v(1) = R(0, 2) - R(2, 0);
43 v(2) = R(1, 0) - R(0, 1);
44 return v;
45}
VectorN< 3 > Vector3
Definition eigen_types.h:51

Referenced by g2o::SE3Quat::log().

◆ project() [1/2]

Vector2 project ( const Vector3 &  v)

Definition at line 47 of file se3_ops.hpp.

47 {
48 Vector2 res;
49 res(0) = v(0) / v(2);
50 res(1) = v(1) / v(2);
51 return res;
52}
VectorN< 2 > Vector2
Definition eigen_types.h:50

Referenced by g2o::EdgeSim3ProjectXYZ::computeError(), and g2o::EdgeInverseSim3ProjectXYZ::computeError().

◆ project() [2/2]

Vector3 project ( const Vector4 &  v)

Definition at line 54 of file se3_ops.hpp.

54 {
55 Vector3 res;
56 res(0) = v(0) / v(3);
57 res(1) = v(1) / v(3);
58 res(2) = v(2) / v(3);
59 return res;
60}

◆ skew()

Matrix3 skew ( const Vector3 &  v)

Definition at line 27 of file se3_ops.hpp.

27 {
28 Matrix3 m;
29 m.fill(0.);
30 m(0, 1) = -v(2);
31 m(0, 2) = v(1);
32 m(1, 2) = -v(0);
33 m(1, 0) = v(2);
34 m(2, 0) = -v(1);
35 m(2, 1) = v(0);
36 return m;
37}
MatrixN< 3 > Matrix3
Definition eigen_types.h:72

Referenced by g2o::SE3Quat::adj(), g2o::SE3Quat::exp(), and g2o::SE3Quat::log().

◆ unproject() [1/2]

Vector3 unproject ( const Vector2 &  v)

Definition at line 62 of file se3_ops.hpp.

62 {
63 Vector3 res;
64 res(0) = v(0);
65 res(1) = v(1);
66 res(2) = 1;
67 return res;
68}

◆ unproject() [2/2]

Vector4 unproject ( const Vector3 &  v)

Definition at line 70 of file se3_ops.hpp.

70 {
71 Vector4 res;
72 res(0) = v(0);
73 res(1) = v(1);
74 res(2) = v(2);
75 res(3) = 1;
76 return res;
77}
VectorN< 4 > Vector4
Definition eigen_types.h:52