sem/5g_drone_ROS2
1
0
Fork 0
Code Issues 1 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

extra print

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-03-03 14:26:09 +01:00
parent 4f530da21d
commit 9e5f2363f6
1 changed files with 2 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
drone_sensors/src/height_sensor.cpp
View File

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