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

add only sending setpoint when new setpoint has arrived

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-05-15 15:33:58 +02:00
parent 1dc9234400
commit 7d316ce740
1 changed files with 5 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
src/px4_connection/src/px4_controller.cpp
View File

@@ -382,10 +382,10 @@ private:
}
else
{
// if (!new_setpoint)
// {
// return;
// }
if (!new_setpoint)
{
return;
}
if (current_control_mode == CONTROL_MODE_VELOCITY)
{
RCLCPP_INFO(this->get_logger(), "velocity %f %f %f", velocity[0], velocity[1], velocity[2]);
@@ -396,7 +396,7 @@ private:
RCLCPP_INFO(this->get_logger(), "position %f %f %f", position[0], position[1], position[2]);
send_position_setpoint();
}
// new_setpoint = false;
new_setpoint = false;
}
}
}