diff --git a/src/state_block/prior.cpp b/src/state_block/prior.cpp index 40fcb72e3094627316aa77f57b5afa7c8b11bb0e..781d5ebe3813caa10092b91ec59e701765c915a5 100644 --- a/src/state_block/prior.cpp +++ b/src/state_block/prior.cpp @@ -29,7 +29,7 @@ namespace wolf Priors::Priors(const YAML::Node& priors_node) { - WOLF_INFO("Priors: \n", priors_node); + WOLF_INFO("Priors..."); if (not priors_node.IsMap()) { throw std::runtime_error("Priors: constructor with a non-map yaml node"); @@ -38,6 +38,7 @@ Priors::Priors(const YAML::Node& priors_node) { this->emplace(prior_pair.first.as<char>(), Prior(prior_pair.second)); } + WOLF_INFO("Exiting priors constructor"); } Prior::Prior(const std::string& _type, @@ -53,6 +54,7 @@ Prior::Prior(const std::string& _type, Prior::Prior(const YAML::Node& prior_node) { + WOLF_INFO("Prior...\n", prior_node); type_ = prior_node["type"].as<std::string>(); state_ = prior_node["state"].as<Eigen::VectorXd>(); mode_ = prior_node["mode"].as<std::string>(); @@ -68,7 +70,9 @@ Prior::Prior(const YAML::Node& prior_node) else drift_std_ = Eigen::VectorXd(0); + WOLF_INFO("checking"); check(); + WOLF_INFO("Exiting prior constructor"); } void Prior::check() const diff --git a/test/gtest_sensor_base.cpp b/test/gtest_sensor_base.cpp index 0771d6b26f12945177e4616e889fc6b6f4850ccc..2607d430bd2a101783b16ea8ce34f4c218008d70 100644 --- a/test/gtest_sensor_base.cpp +++ b/test/gtest_sensor_base.cpp @@ -441,6 +441,7 @@ TEST(SensorBase, factory) // create sensor auto S = FactorySensor::create("SensorDummyPoia3d", 3, server.getNode()); + WOLF_INFO("created"); // noise ASSERT_MATRIX_APPROX(S->computeNoiseCov(vector0),