Fixed "unused" warnings
parent
1ed07ca4ed
commit
92c9e9c0aa
|
@ -183,12 +183,11 @@ TEST( PinholeCamera, Dproject)
|
||||||
}
|
}
|
||||||
|
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
static Point2 projectInfinity3(const Pose3& pose, const Point2& point2D, const Cal3_S2& cal) {
|
//static Point2 projectInfinity3(const Pose3& pose, const Point2& point2D, const Cal3_S2& cal) {
|
||||||
Point3 point(point2D.x(), point2D.y(), 1.0);
|
// Point3 point(point2D.x(), point2D.y(), 1.0);
|
||||||
return Camera(pose,cal).projectPointAtInfinity(point);
|
// return Camera(pose,cal).projectPointAtInfinity(point);
|
||||||
}
|
//}
|
||||||
|
//
|
||||||
/* ************************************************************************* */
|
|
||||||
//TEST( PinholeCamera, Dproject_Infinity)
|
//TEST( PinholeCamera, Dproject_Infinity)
|
||||||
//{
|
//{
|
||||||
// Matrix Dpose, Dpoint, Dcal;
|
// Matrix Dpose, Dpoint, Dcal;
|
||||||
|
@ -202,7 +201,7 @@ static Point2 projectInfinity3(const Pose3& pose, const Point2& point2D, const C
|
||||||
// CHECK(assert_equal(numerical_point, Dpoint, 1e-7));
|
// CHECK(assert_equal(numerical_point, Dpoint, 1e-7));
|
||||||
// CHECK(assert_equal(numerical_cal, Dcal, 1e-7));
|
// CHECK(assert_equal(numerical_cal, Dcal, 1e-7));
|
||||||
//}
|
//}
|
||||||
|
//
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
static Point2 project4(const Camera& camera, const Point3& point) {
|
static Point2 project4(const Camera& camera, const Point3& point) {
|
||||||
return camera.project2(point);
|
return camera.project2(point);
|
||||||
|
|
|
@ -35,7 +35,7 @@ using namespace boost::assign;
|
||||||
using namespace std;
|
using namespace std;
|
||||||
using namespace gtsam;
|
using namespace gtsam;
|
||||||
|
|
||||||
static const Key _x_=0, _y_=1, _z_=2;
|
static const Key _x_=0, _y_=1;
|
||||||
|
|
||||||
static GaussianBayesNet smallBayesNet = list_of
|
static GaussianBayesNet smallBayesNet = list_of
|
||||||
(GaussianConditional(_x_, (Vector(1) << 9.0), (Matrix(1, 1) << 1.0), _y_, (Matrix(1, 1) << 1.0)))
|
(GaussianConditional(_x_, (Vector(1) << 9.0), (Matrix(1, 1) << 1.0), _y_, (Matrix(1, 1) << 1.0)))
|
||||||
|
|
|
@ -31,7 +31,6 @@ static const Key _A_ = 1;
|
||||||
static const Key _B_ = 2;
|
static const Key _B_ = 2;
|
||||||
static const Key _C_ = 3;
|
static const Key _C_ = 3;
|
||||||
static const Key _D_ = 4;
|
static const Key _D_ = 4;
|
||||||
static const Key _E_ = 5;
|
|
||||||
|
|
||||||
static SymbolicConditional::shared_ptr
|
static SymbolicConditional::shared_ptr
|
||||||
B(new SymbolicConditional(_B_)),
|
B(new SymbolicConditional(_B_)),
|
||||||
|
|
|
@ -14,8 +14,8 @@ using namespace gtsam::symbol_shorthand;
|
||||||
|
|
||||||
const double tol=1e-5;
|
const double tol=1e-5;
|
||||||
const double h = 0.01;
|
const double h = 0.01;
|
||||||
const double deg2rad = M_PI/180.0;
|
|
||||||
|
|
||||||
|
//const double deg2rad = M_PI/180.0;
|
||||||
//Pose3 g1(Rot3::ypr(deg2rad*10.0, deg2rad*20.0, deg2rad*30.0), Point3(100.0, 200.0, 300.0));
|
//Pose3 g1(Rot3::ypr(deg2rad*10.0, deg2rad*20.0, deg2rad*30.0), Point3(100.0, 200.0, 300.0));
|
||||||
Pose3 g1(Rot3(), Point3(100.0, 0.0, 300.0));
|
Pose3 g1(Rot3(), Point3(100.0, 0.0, 300.0));
|
||||||
//LieVector v1((Vector(6) << 0.1, 0.05, 0.02, 10.0, 20.0, 30.0));
|
//LieVector v1((Vector(6) << 0.1, 0.05, 0.02, 10.0, 20.0, 30.0));
|
||||||
|
|
|
@ -35,8 +35,6 @@ using namespace std;
|
||||||
using namespace gtsam;
|
using namespace gtsam;
|
||||||
using boost::shared_ptr;
|
using boost::shared_ptr;
|
||||||
|
|
||||||
const double tol = 1e-4;
|
|
||||||
|
|
||||||
// SETDEBUG("ISAM2 update", true);
|
// SETDEBUG("ISAM2 update", true);
|
||||||
// SETDEBUG("ISAM2 update verbose", true);
|
// SETDEBUG("ISAM2 update verbose", true);
|
||||||
// SETDEBUG("ISAM2 recalculate", true);
|
// SETDEBUG("ISAM2 recalculate", true);
|
||||||
|
|
Loading…
Reference in New Issue