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

Geo: Fix double correcting for negative distance

Browse Source
This commit is contained in:
kamilritz
2020-08-10 22:15:43 +02:00
committed by Julian Kent
parent 6feb28c27d
commit 60388a8b6d
1 changed files with 0 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
geo/geo.cpp
-5
View File
@@ -289,13 +289,8 @@ void create_waypoint_from_line_and_dist(double lat_A, double lon_A, double lat_B
*lat_target = lat_A; *lat_target = lat_A;
*lon_target = lon_A; *lon_target = lon_A;
} else if (dist >= FLT_EPSILON) {
float heading = get_bearing_to_next_waypoint(lat_A, lon_A, lat_B, lon_B);
waypoint_from_heading_and_distance(lat_A, lon_A, heading, dist, lat_target, lon_target);
} else { } else {
float heading = get_bearing_to_next_waypoint(lat_A, lon_A, lat_B, lon_B); float heading = get_bearing_to_next_waypoint(lat_A, lon_A, lat_B, lon_B);
heading = wrap_2pi(heading + M_PI_F);
waypoint_from_heading_and_distance(lat_A, lon_A, heading, dist, lat_target, lon_target); waypoint_from_heading_and_distance(lat_A, lon_A, heading, dist, lat_target, lon_target);
} }
} }