mirror of https://github.com/ArduPilot/ardupilot
AP_Mount: fixed longitude subtraction
This commit is contained in:
parent
51a3bc170b
commit
86e8731fc5
|
@ -185,7 +185,7 @@ bool AP_Mount_Backend::calc_angle_to_location(const struct Location &target, Vec
|
|||
if (!AP::ahrs().get_position(current_loc)) {
|
||||
return false;
|
||||
}
|
||||
const float GPS_vector_x = (target.lng-current_loc.lng)*cosf(ToRad((current_loc.lat+target.lat)*0.00000005f))*0.01113195f;
|
||||
const float GPS_vector_x = Location::diff_longitude(target.lng,current_loc.lng)*cosf(ToRad((current_loc.lat+target.lat)*0.00000005f))*0.01113195f;
|
||||
const float GPS_vector_y = (target.lat-current_loc.lat)*0.01113195f;
|
||||
int32_t target_alt_cm = 0;
|
||||
if (!target.get_alt_cm(Location::AltFrame::ABOVE_HOME, target_alt_cm)) {
|
||||
|
@ -217,4 +217,4 @@ bool AP_Mount_Backend::calc_angle_to_location(const struct Location &target, Vec
|
|||
return true;
|
||||
}
|
||||
|
||||
#endif // HAL_MOUNT_ENABLED
|
||||
#endif // HAL_MOUNT_ENABLED
|
||||
|
|
Loading…
Reference in New Issue