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) {
|
||||
Point3 point(point2D.x(), point2D.y(), 1.0);
|
||||
return Camera(pose,cal).projectPointAtInfinity(point);
|
||||
}
|
||||
|
||||
/* ************************************************************************* */
|
||||
//static Point2 projectInfinity3(const Pose3& pose, const Point2& point2D, const Cal3_S2& cal) {
|
||||
// Point3 point(point2D.x(), point2D.y(), 1.0);
|
||||
// return Camera(pose,cal).projectPointAtInfinity(point);
|
||||
//}
|
||||
//
|
||||
//TEST( PinholeCamera, Dproject_Infinity)
|
||||
//{
|
||||
// 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_cal, Dcal, 1e-7));
|
||||
//}
|
||||
|
||||
//
|
||||
/* ************************************************************************* */
|
||||
static Point2 project4(const Camera& camera, const Point3& point) {
|
||||
return camera.project2(point);
|
||||
|
|
|
@ -35,7 +35,7 @@ using namespace boost::assign;
|
|||
using namespace std;
|
||||
using namespace gtsam;
|
||||
|
||||
static const Key _x_=0, _y_=1, _z_=2;
|
||||
static const Key _x_=0, _y_=1;
|
||||
|
||||
static GaussianBayesNet smallBayesNet = list_of
|
||||
(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 _C_ = 3;
|
||||
static const Key _D_ = 4;
|
||||
static const Key _E_ = 5;
|
||||
|
||||
static SymbolicConditional::shared_ptr
|
||||
B(new SymbolicConditional(_B_)),
|
||||
|
|
|
@ -14,8 +14,8 @@ using namespace gtsam::symbol_shorthand;
|
|||
|
||||
const double tol=1e-5;
|
||||
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(), Point3(100.0, 0.0, 300.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 boost::shared_ptr;
|
||||
|
||||
const double tol = 1e-4;
|
||||
|
||||
// SETDEBUG("ISAM2 update", true);
|
||||
// SETDEBUG("ISAM2 update verbose", true);
|
||||
// SETDEBUG("ISAM2 recalculate", true);
|
||||
|
|
Loading…
Reference in New Issue