Make release service invalidate position setpoint

This commit is contained in:
Oleg Kalachev
2022-12-15 19:44:10 +03:00
parent 323c1da325
commit 7e3ffc9626

View File

@@ -1036,6 +1036,9 @@ bool release(std_srvs::Trigger::Request& req, std_srvs::Trigger::Response& res)
{
setpoint_timer.stop();
setpoint_type = NONE;
setpoint_position.header.frame_id = "";
setpoint_altitude.header.frame_id = "";
yaw_frame_id = "";
publishState();
res.success = true;
return true;