diff --git a/examples/tests/testPlanarSLAMExample_lago.cpp b/examples/tests/testPlanarSLAMExample_lago.cpp index 6f115003c..ba604ee18 100644 --- a/examples/tests/testPlanarSLAMExample_lago.cpp +++ b/examples/tests/testPlanarSLAMExample_lago.cpp @@ -168,6 +168,7 @@ void getSymbolicSubgraph(vector& keysInBinary, void getDeltaThetaAndNoise(NonlinearFactor::shared_ptr factor, Vector& deltaTheta, noiseModel::Diagonal::shared_ptr& model_deltaTheta){ + td::cout << "TODO: improve computation of noise model" << std::endl; boost::shared_ptr< BetweenFactor > pose2Between = boost::dynamic_pointer_cast< BetweenFactor >(factor); if (!pose2Between) throw std::invalid_argument("buildOrientationGraph: invalid between factor!"); deltaTheta = (Vector(1) << pose2Between->measured().theta());