diff --git a/include/core/sensor/sensor_pose.h b/include/core/sensor/sensor_pose.h index c303e3cfb8c9f8e2aae62ff4355642064bf75314..33b692296cb947b5c71e4571c41f5a996ad76375 100644 --- a/include/core/sensor/sensor_pose.h +++ b/include/core/sensor/sensor_pose.h @@ -32,23 +32,18 @@ WOLF_STRUCT_PTR_TYPEDEFS(ParamsSensorPose); struct ParamsSensorPose : public ParamsSensorBase { Eigen::VectorXd std_noise; - // double std_p = 1; // m - // double std_o = 1; // rad + ParamsSensorPose() = default; ParamsSensorPose(const YAML::Node& _input_node): ParamsSensorBase(_input_node) { std_noise = _input_node["std_noise"].as<Eigen::VectorXd>(); - // std_p = _input_node["std_p"].as<double>(); - // std_o = _input_node["std_o"].as<double>(); } ~ParamsSensorPose() override = default; std::string print() const override { return ParamsSensorBase::print() + "\n" - + "std_p: " + toString(std_noise) + "\n"; - // + "std_p: " + toString(std_p) + "\n" - // + "std_o: " + toString(std_o) + "\n"; + + "std_noise: " + toString(std_noise) + "\n"; } }; diff --git a/src/processor/processor_diff_drive.cpp b/src/processor/processor_diff_drive.cpp index 9c4a4e6926e1699f3faf4686952636873046783f..269a65b44c5e9f4b68f699d79df64883d151f4b2 100644 --- a/src/processor/processor_diff_drive.cpp +++ b/src/processor/processor_diff_drive.cpp @@ -29,7 +29,6 @@ #include "core/processor/processor_diff_drive.h" #include "core/sensor/sensor_diff_drive.h" -//#include "core/feature/feature_motion.h" #include "core/feature/feature_diff_drive.h" #include "core/factor/factor_diff_drive.h"