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

AP_Devo_Telem: fixed to check for have_position

Browse Source
This commit is contained in:
Andrew Tridgell 2018-04-24 09:47:18 +10:00
parent aa53832a70
commit da5df5ca20
1 changed files with 2 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
libraries/AP_Devo_Telem/AP_Devo_Telem.cpp
View File

@ -82,16 +82,9 @@ void AP_DEVO_Telem::send_frames(uint8_t control_mode)
}
const AP_GPS &gps = AP::gps();
Location loc;
if (gps.status() >= (enum AP_GPS::GPS_Status)GPS_FIX_TYPE_3D_FIX) {
#if 0
// GPS version, tested, working
Location loc = gps.location();
#else
// AHRS version, untested
Location loc;
_ahrs.get_position(loc);
#endif
if (_ahrs.get_position(loc)) {
devoPacket.lat = gpsDdToDmsFormat(loc.lat);
devoPacket.lon = gpsDdToDmsFormat(loc.lng);
devoPacket.speed = (int16_t)(gps.ground_speed() * DEVO_SPEED_FACTOR * 100.0f); // * 100 for cm