mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-21 23:33:57 -04:00
Copter: Jason's bug fix for loiter's set_next_WP_latlon
This commit is contained in:
parent
17cbcd1bf6
commit
95d944f610
@ -440,7 +440,7 @@ loiter_set_pos_from_velocity(int16_t vel_forward_cms, int16_t vel_right_cms, flo
|
||||
// update next_WP location for reporting purposes
|
||||
set_next_WP_latlon(
|
||||
home.lat + loiter_lat_from_home_cm / LATLON_TO_CM,
|
||||
home.lng + loiter_lat_from_home_cm / LATLON_TO_CM * scaleLongUp);
|
||||
home.lng + loiter_lon_from_home_cm / LATLON_TO_CM * scaleLongUp);
|
||||
}
|
||||
|
||||
// loiter_set_target - set loiter's target position from home in cm
|
||||
@ -454,7 +454,7 @@ loiter_set_target(float lat_from_home_cm, float lon_from_home_cm)
|
||||
// update next_WP location for reporting purposes
|
||||
set_next_WP_latlon(
|
||||
home.lat + loiter_lat_from_home_cm / LATLON_TO_CM,
|
||||
home.lng + loiter_lat_from_home_cm / LATLON_TO_CM * scaleLongUp);
|
||||
home.lng + loiter_lon_from_home_cm / LATLON_TO_CM * scaleLongUp);
|
||||
}
|
||||
|
||||
//////////////////////////////////////////////////////////
|
||||
|
Loading…
Reference in New Issue
Block a user