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

change checking of set bit

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-05-12 12:19:03 +02:00
parent 9785136a48
commit 9faab231e7
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
src/px4_connection/src/heartbeat.cpp
View File

@@ -82,17 +82,17 @@ private:
void publish_new_control_mode()
{
auto msg = drone_services::msg::DroneControlMode();
if ((this->control_mode >> CONTROL_ATTITUDE_POS) & 1)
if (this->control_mode & (1 << CONTROL_ATTITUDE_POS))
{
msg.control_mode = CONTROL_MODE_ATTITUDE;
RCLCPP_INFO(this->get_logger(), "set control mode to attitude");
}
else if ((this->control_mode >> CONTROL_VELOCITY_POS) & 1)
else if (this->control_mode & (1 << CONTROL_VELOCITY_POS))
{
msg.control_mode = CONTROL_MODE_VELOCITY;
RCLCPP_INFO(this->get_logger(), "set control mode to velocity");
}
else if ((this->control_mode >> CONTROL_POSITION_POS) & 1)
else if (this->control_mode & (1 << CONTROL_POSITION_POS))
{
msg.control_mode = CONTROL_MODE_POSITION;
RLCPP_INFO(this->get_logger(), "set control mode to position");