fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-02 05:04:08 +08:00
Code Issues Packages Projects Releases Wiki Activity

FlightTaskAuto: use built in matrix comparison

Browse Source 
which corresponds to fabsf(a(0) - b(0)) < 1e-4f for each element.
This commit is contained in:
Matthias Grob 2024-10-13 16:35:45 +02:00
parent 26845d9746
commit 925e776a00
1 changed files with 1 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/flight_mode_manager/tasks/Auto/FlightTaskAuto.cpp
View File

@ -422,9 +422,7 @@ bool FlightTaskAuto::_evaluateTriplets()
|| (_next_was_valid != _sub_triplet_setpoint.get().next.valid);
if (_triplet_target.isAllFinite()
&& fabsf(_triplet_target(0) - tmp_target(0)) < 0.001f
&& fabsf(_triplet_target(1) - tmp_target(1)) < 0.001f
&& fabsf(_triplet_target(2) - tmp_target(2)) < 0.001f
&& (_triplet_target == tmp_target)
&& !prev_next_validity_changed) {
// Nothing has changed: just keep old waypoints.
triplet_update = false;