diff --git a/src/drivers/gps/ubx.cpp b/src/drivers/gps/ubx.cpp index 08044afcf8..9c3f276ddf 100644 --- a/src/drivers/gps/ubx.cpp +++ b/src/drivers/gps/ubx.cpp @@ -237,12 +237,6 @@ UBX::configure(unsigned &baudrate) return 1; } - configure_message_rate(UBX_MSG_NAV_DOP, 1); - - if (wait_for_ack(UBX_MSG_CFG_MSG, UBX_CONFIG_TIMEOUT, true) < 0) { - return 1; - } - configure_message_rate(UBX_MSG_NAV_VELNED, 1); if (wait_for_ack(UBX_MSG_CFG_MSG, UBX_CONFIG_TIMEOUT, true) < 0) { @@ -250,6 +244,12 @@ UBX::configure(unsigned &baudrate) } } + configure_message_rate(UBX_MSG_NAV_DOP, 1); + + if (wait_for_ack(UBX_MSG_CFG_MSG, UBX_CONFIG_TIMEOUT, true) < 0) { + return 1; + } + configure_message_rate(UBX_MSG_NAV_SVINFO, (_satellite_info != nullptr) ? 5 : 0); if (wait_for_ack(UBX_MSG_CFG_MSG, UBX_CONFIG_TIMEOUT, true) < 0) {