Added Lie check
parent
de3e1c3ed1
commit
2d29076187
|
|
@ -31,6 +31,9 @@
|
||||||
using namespace std;
|
using namespace std;
|
||||||
using namespace gtsam;
|
using namespace gtsam;
|
||||||
|
|
||||||
|
GTSAM_CONCEPT_TESTABLE_INST(Rot3)
|
||||||
|
GTSAM_CONCEPT_LIE_INST(Rot3)
|
||||||
|
|
||||||
static Rot3 R = Rot3::rodriguez(0.1, 0.4, 0.2);
|
static Rot3 R = Rot3::rodriguez(0.1, 0.4, 0.2);
|
||||||
static Point3 P(0.2, 0.7, -2.0);
|
static Point3 P(0.2, 0.7, -2.0);
|
||||||
static double error = 1e-9, epsilon = 0.001;
|
static double error = 1e-9, epsilon = 0.001;
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue