diff --git a/gtsam/geometry/tests/testCal3Bundler.cpp b/gtsam/geometry/tests/testCal3Bundler.cpp index 6e62d4be0..905605b55 100644 --- a/gtsam/geometry/tests/testCal3Bundler.cpp +++ b/gtsam/geometry/tests/testCal3Bundler.cpp @@ -28,6 +28,13 @@ GTSAM_CONCEPT_MANIFOLD_INST(Cal3Bundler) static Cal3Bundler K(500, 1e-3, 1e-3, 1000, 2000); static Point2 p(2,3); +/* ************************************************************************* */ +TEST( Cal3Bundler, vector) +{ + Cal3Bundler K; + CHECK(assert_equal((Vector(3)<<1,0,0),K.vector())); +} + /* ************************************************************************* */ TEST( Cal3Bundler, uncalibrate) { @@ -36,7 +43,7 @@ TEST( Cal3Bundler, uncalibrate) double g = v[0]*(1+v[1]*r+v[2]*r*r) ; Point2 expected (1000+g*p.x(), 2000+g*p.y()) ; Point2 actual = K.uncalibrate(p); - CHECK(assert_equal(actual,expected)); + CHECK(assert_equal(expected,actual)); } TEST( Cal3Bundler, calibrate )