commit
dabfd3fa44
|
@ -825,7 +825,7 @@ TEST(Rot3, RQ_derivative) {
|
||||||
const auto R = Rot3::RzRyRx(xyz).matrix();
|
const auto R = Rot3::RzRyRx(xyz).matrix();
|
||||||
const auto num = numericalDerivative11(RQ_proxy, R);
|
const auto num = numericalDerivative11(RQ_proxy, R);
|
||||||
Matrix39 calc;
|
Matrix39 calc;
|
||||||
auto dummy = RQ(R, calc).second;
|
RQ(R, calc).second;
|
||||||
|
|
||||||
const auto err = vec_err.second;
|
const auto err = vec_err.second;
|
||||||
CHECK(assert_equal(num, calc, err));
|
CHECK(assert_equal(num, calc, err));
|
||||||
|
|
|
@ -2563,9 +2563,6 @@ class NonlinearISAM {
|
||||||
//*************************************************************************
|
//*************************************************************************
|
||||||
// Nonlinear factor types
|
// Nonlinear factor types
|
||||||
//*************************************************************************
|
//*************************************************************************
|
||||||
#include <gtsam/geometry/CalibratedCamera.h>
|
|
||||||
#include <gtsam/geometry/StereoPoint2.h>
|
|
||||||
|
|
||||||
#include <gtsam/nonlinear/PriorFactor.h>
|
#include <gtsam/nonlinear/PriorFactor.h>
|
||||||
template <T = {double,
|
template <T = {double,
|
||||||
Vector,
|
Vector,
|
||||||
|
|
Loading…
Reference in New Issue