diff --git a/drone_sensors/src/height_sensor.cpp b/drone_sensors/src/height_sensor.cpp index 73a61275..56fed3d4 100644 --- a/drone_sensors/src/height_sensor.cpp +++ b/drone_sensors/src/height_sensor.cpp @@ -34,6 +34,7 @@ private: char *readdata = new char[1]; serial_port.read(readdata, 1); auto message = std_msgs::msg::String(); + RCLCPP_INFO(this->get_logger(), "data: %s", readdata); if (readdata[0] == 0x54) // 0x54 = T (from the user manual) { @@ -61,7 +62,7 @@ private: } else { - RCLCPP_INFO(this->get_logger(), "Serial port opened"); + RCLCPP_INFO(this->get_logger(), "Serial port opened on /dev/ttyACM0"); } serial_port.close();