diff --git a/src/problem/problem.cpp b/src/problem/problem.cpp index c7b35c78394971965bf2f15476209dad3d2206c1..f2d41a420415f8b0f9fb3ac9f6b5e286036c1160 100644 --- a/src/problem/problem.cpp +++ b/src/problem/problem.cpp @@ -175,6 +175,7 @@ ProblemPtr Problem::autoSetup(ParamsServer &_server) // Prior std::string prior_mode = _server.getParam<std::string>("problem/prior/mode"); + WOLF_TRACE("Prior mode: ", prior_mode); if (prior_mode == "nothing") { problem->setPriorOptions(prior_mode); @@ -188,8 +189,9 @@ ProblemPtr Problem::autoSetup(ParamsServer &_server) } else { + WOLF_TRACE("Prior mode: ", prior_mode); problem->setPriorOptions(prior_mode, - _server.getParam<double>("problem/prior/timestamp"), + _server.getParam<double>("problem/prior/time_tolerance"), _server.getParam<Eigen::VectorXd>("problem/prior/state")); }