From 755569ac12825f731ca95daaf26d2311720d45b4 Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Thu, 25 Feb 2016 13:43:39 +0100 Subject: [PATCH] HDOP / VDOP correctly reporting --- src/drivers/gps/ubx.cpp | 12 +++++++++++- 1 file changed, 11 insertions(+), 1 deletion(-) diff --git a/src/drivers/gps/ubx.cpp b/src/drivers/gps/ubx.cpp index 9c3f276ddf..ef5a221600 100644 --- a/src/drivers/gps/ubx.cpp +++ b/src/drivers/gps/ubx.cpp @@ -548,6 +548,17 @@ UBX::payload_rx_init() break; + case UBX_MSG_NAV_DOP: + if (_rx_payload_length != sizeof(ubx_payload_rx_nav_dop_t)) { + _rx_state = UBX_RXMSG_ERROR_LENGTH; + + } else if (!_configured) { + _rx_state = UBX_RXMSG_IGNORE; // ignore if not _configured + + } + + break; + case UBX_MSG_NAV_TIMEUTC: if (_rx_payload_length != sizeof(ubx_payload_rx_nav_timeutc_t)) { _rx_state = UBX_RXMSG_ERROR_LENGTH; @@ -909,7 +920,6 @@ UBX::payload_rx_done(void) _gps_position->vdop = _buf.payload_rx_nav_dop.vDOP * 0.01f; // from cm to m _gps_position->timestamp_variance = hrt_absolute_time(); - warnx("DOOOP!"); ret = 1; break;