mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-04-14 10:07:39 +08:00
send acknowledgement after receiving vehicle wind cmd
This commit is contained in:
parent
741ea6b707
commit
22c2878cf8
@ -571,7 +571,12 @@ void EKF2::Run()
|
||||
const float wind_direction_accuracy_rad = math::radians(vehicle_command.param4);
|
||||
_ekf.resetWindToExternalObservation(vehicle_command.param1, wind_direction_rad, vehicle_command.param2,
|
||||
wind_direction_accuracy_rad);
|
||||
command_ack.result = vehicle_command_ack_s::VEHICLE_CMD_RESULT_ACCEPTED;
|
||||
#else
|
||||
command_ack.result = vehicle_command_ack_s::VEHICLE_CMD_RESULT_UNSUPPORTED;
|
||||
#endif // CONFIG_EKF2_WIND
|
||||
command_ack.timestamp = hrt_absolute_time();
|
||||
_vehicle_command_ack_pub.publish(command_ack);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user