scaling width of circle mode to make it more round.

This commit is contained in:
Jason Short 2011-11-13 23:09:42 -08:00
parent 687d0eda98
commit 2ad1294514

View File

@ -1456,7 +1456,7 @@ static void update_nav_wp()
if (circle_angle > 6.28318531)
circle_angle -= 6.28318531;
target_WP.lng = next_WP.lng + (g.loiter_radius * cos(1.57 - circle_angle));
target_WP.lng = next_WP.lng + (g.loiter_radius * cos(1.57 - circle_angle) * scaleLongUp);
target_WP.lat = next_WP.lat + (g.loiter_radius * sin(1.57 - circle_angle));
// calc the lat and long error to the target