Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 00:28:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Math: fixed float rounding in location_offset()

Browse Source 
this prevents rounding of positions in the rover code
This commit is contained in:
Andrew Tridgell 2013-09-16 11:38:55 +10:00
parent 3e24ff1b07
commit 84ed2141a0
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_Math/location.cpp
View File

@ -133,8 +133,8 @@ void location_update(struct Location &loc, float bearing, float distance)
void location_offset(struct Location &loc, float ofs_north, float ofs_east)
{
if (ofs_north != 0 || ofs_east != 0) {
float dlat = ofs_north * LOCATION_SCALING_FACTOR_INV;
float dlng = (ofs_east * LOCATION_SCALING_FACTOR_INV) / longitude_scale(loc);
int32_t dlat = ofs_north * LOCATION_SCALING_FACTOR_INV;
int32_t dlng = (ofs_east * LOCATION_SCALING_FACTOR_INV) / longitude_scale(loc);
loc.lat += dlat;
loc.lng += dlng;
}