diff --git a/src/object_detection/src/multiflex_reader.cpp b/src/object_detection/src/multiflex_reader.cpp index 3f47b986..57996f46 100644 --- a/src/object_detection/src/multiflex_reader.cpp +++ b/src/object_detection/src/multiflex_reader.cpp @@ -1,4 +1,4 @@ -\#include +#include #include "rclcpp/rclcpp.hpp" #include "object_detection/msg/multiflex_reading.hpp" @@ -7,9 +7,9 @@ #include #include - // #include +// #include - using terabee::DistanceData; +using terabee::DistanceData; using namespace std::chrono_literals; @@ -71,15 +71,15 @@ private: terabee::DistanceData data = multiflex->getDistance(); // populate message with readings - // auto msg = object_detection::msg::MultiflexReading(); + auto msg = object_detection::msg::MultiflexReading(); for (size_t i = 0; i < data.size(); i++) { - // std::cout << "distance " << data.distance[i] < std::endl; + RCLCPP_INFO(this->get_logger(), "distance %f", data.distance[i]); // msg.distance_data[i] = data.distance[i]; } // publish message - // publisher_->publish(msg); + publisher_->publish(msg); } };