Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Beacon: use get_distance_NE instead of location_diff

This commit is contained in:
Pierre Kancir 2019-04-08 15:16:19 +02:00 committed by Tom Pittenger
parent 78ce60aa95
commit d6277390f4
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_Beacon/AP_Beacon_SITL.cpp
View File

@ -97,8 +97,8 @@ void AP_Beacon_SITL::update(void)
break; break;
} }
Vector2f beac_diff = location_diff(beacon_origin, beacon_loc); const Vector2f beac_diff = beacon_origin.get_distance_NE(beacon_loc);
Vector2f veh_diff = location_diff(beacon_origin, current_loc); const Vector2f veh_diff = beacon_origin.get_distance_NE(current_loc);
Vector3f veh_pos3d(veh_diff.x, veh_diff.y, (current_loc.alt - beacon_origin.alt)*1.0e-2f); Vector3f veh_pos3d(veh_diff.x, veh_diff.y, (current_loc.alt - beacon_origin.alt)*1.0e-2f);
Vector3f beac_pos3d(beac_diff.x, beac_diff.y, (beacon_origin.alt - beacon_loc.alt)*1.0e-2f); Vector3f beac_pos3d(beac_diff.x, beac_diff.y, (beacon_origin.alt - beacon_loc.alt)*1.0e-2f);