fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-21 21:03:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

GPS driver: Populate HDOP / VDOP fields

Browse Source
This commit is contained in:
Lorenz Meier
2016-02-25 13:45:34 +01:00
parent 9b5c9b0c8a
commit 56c95dc9c8
3 changed files with 11 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/gps/ashtech.cpp
+3 -1
View File
@@ -269,7 +269,7 @@ int ASHTECH::handle_message(int len)
double ashtech_time __attribute__((unused)) = 0.0, lat = 0.0, lon = 0.0, alt = 0.0;
int num_of_sv __attribute__((unused)) = 0, fix_quality = 0;
double track_true = 0.0, ground_speed = 0.0 , age_of_corr __attribute__((unused)) = 0.0;
double hdop __attribute__((unused)) = 99.9, vdop __attribute__((unused)) = 99.9, pdop __attribute__((unused)) = 99.9,
double hdop = 99.9, vdop = 99.9, pdop __attribute__((unused)) = 99.9,
tdop __attribute__((unused)) = 99.9, vertic_vel = 0.0;
char ns = '?', ew = '?';
@@ -338,6 +338,8 @@ int ASHTECH::handle_message(int len)
_gps_position->lat = static_cast<int>((int(lat * 0.01) + (lat * 0.01 - int(lat * 0.01)) * 100.0 / 60.0) * 10000000);
_gps_position->lon = static_cast<int>((int(lon * 0.01) + (lon * 0.01 - int(lon * 0.01)) * 100.0 / 60.0) * 10000000);
_gps_position->alt = static_cast<int>(alt * 1000);
_gps_position->hdop = (float)hdop / 100.0f;
_gps_position->vdop = (float)vdop / 100.0f;
_rate_count_lat_lon++;
if (coordinatesFound < 3) {