diff --git a/tests/testInferenceB.cpp b/tests/testInferenceB.cpp index 3e68780c4..9b8127473 100644 --- a/tests/testInferenceB.cpp +++ b/tests/testInferenceB.cpp @@ -17,10 +17,17 @@ #include +#include +#include +#include +#include +#include #include #include #include -#include +#include +#include +#include #include @@ -54,16 +61,16 @@ TEST( inference, marginals ) /* ************************************************************************* */ TEST( inference, marginals2) { - planarSLAM::Graph fg; + NonlinearFactorGraph fg; SharedDiagonal poseModel(noiseModel::Isotropic::Sigma(3, 0.1)); SharedDiagonal pointModel(noiseModel::Isotropic::Sigma(3, 0.1)); - fg.addPosePrior(X(0), Pose2(), poseModel); - fg.addRelativePose(X(0), X(1), Pose2(1.0,0.0,0.0), poseModel); - fg.addRelativePose(X(1), X(2), Pose2(1.0,0.0,0.0), poseModel); - fg.addBearingRange(X(0), L(0), Rot2(), 1.0, pointModel); - fg.addBearingRange(X(1), L(0), Rot2(), 1.0, pointModel); - fg.addBearingRange(X(2), L(0), Rot2(), 1.0, pointModel); + fg.add(PriorFactor(X(0), Pose2(), poseModel)); + fg.add(BetweenFactor(X(0), X(1), Pose2(1.0,0.0,0.0), poseModel)); + fg.add(BetweenFactor(X(1), X(2), Pose2(1.0,0.0,0.0), poseModel)); + fg.add(BearingRangeFactor(X(0), L(0), Rot2(), 1.0, pointModel)); + fg.add(BearingRangeFactor(X(1), L(0), Rot2(), 1.0, pointModel)); + fg.add(BearingRangeFactor(X(2), L(0), Rot2(), 1.0, pointModel)); Values init; init.insert(X(0), Pose2(0.0,0.0,0.0));