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

fix posctl heading hold

Browse Source
This commit is contained in:
Mark Whitehorn
2015-06-05 22:45:07 +02:00
committed by Lorenz Meier
parent e5e4db1923
commit 1f3c5d00e4
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp
+2 -2
View File
@@ -912,8 +912,8 @@ void FixedwingPositionControl::get_waypoint_heading_distance(float heading, floa
if (flag_init) {
// on init set first waypoint to momentary position
waypoint_prev.lat = _global_pos.lat;
waypoint_prev.lon = _global_pos.lon;
waypoint_prev.lat = _global_pos.lat - cos(heading) * (double)(HDG_HOLD_SET_BACK_DIST) / 1e6;
waypoint_prev.lon = _global_pos.lon - sin(heading) * (double)(HDG_HOLD_SET_BACK_DIST) / 1e6;
} else {
/*
for previous waypoint use the one still in front of us but shift it such that it is