diff --git a/libraries/AP_GPS/AP_GPS_NOVA.cpp b/libraries/AP_GPS/AP_GPS_NOVA.cpp index dc6246c577..86780bdd6b 100644 --- a/libraries/AP_GPS/AP_GPS_NOVA.cpp +++ b/libraries/AP_GPS/AP_GPS_NOVA.cpp @@ -59,13 +59,11 @@ AP_GPS_NOVA::AP_GPS_NOVA(AP_GPS &_gps, AP_GPS::GPS_State &_state, } } -const char* const AP_GPS_NOVA::_initialisation_blob[6] { +const char* const AP_GPS_NOVA::_initialisation_blob[4] { "\r\n\r\nunlogall\r\n", // cleanup enviroment - "log bestposb ontime 0.2 0 nohold\r\n", // get bestpos - "log bestvelb ontime 0.2 0 nohold\r\n", // get bestvel - "log psrdopb onchanged\r\n", // tersus - "log psrdopb ontime 0.2\r\n", // comnav - "log psrdopb\r\n" // poll message, as dop only changes when a sat is dropped/added to the visible list + "log bestposb ontime 0.2 0 nohold\r\n", + "log bestvelb ontime 0.2 0 nohold\r\n", + "log psrdopb ontime 0.2 0 nohold\r\n", }; // Process all bytes available from the stream @@ -213,7 +211,7 @@ AP_GPS_NOVA::process_message(void) state.num_sats = bestposu.svsused; - state.horizontal_accuracy = (float) ((bestposu.latsdev + bestposu.lngsdev)/2); + state.horizontal_accuracy = norm(bestposu.latsdev, bestposu.lngsdev); state.vertical_accuracy = (float) bestposu.hgtsdev; state.have_horizontal_accuracy = true; state.have_vertical_accuracy = true; diff --git a/libraries/AP_GPS/AP_GPS_NOVA.h b/libraries/AP_GPS/AP_GPS_NOVA.h index 1136123b42..3a288d276c 100644 --- a/libraries/AP_GPS/AP_GPS_NOVA.h +++ b/libraries/AP_GPS/AP_GPS_NOVA.h @@ -55,7 +55,7 @@ private: uint8_t _init_blob_index = 0; uint32_t _init_blob_time = 0; - static const char* const _initialisation_blob[6]; + static const char* const _initialisation_blob[4]; uint32_t crc_error_counter = 0;