aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_AHRS : Prevent EKF starting if GPS sats less than AHRS_GPS_MINSATS

Browse Source
This commit is contained in:
priseborough 2014-09-23 19:32:20 +10:00 committed by Andrew Tridgell
parent f99f5759f5
commit 7370e07c8d
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_AHRS/AP_AHRS_NavEKF.cpp
View File

@ -58,8 +58,8 @@ void AP_AHRS_NavEKF::update(void)
_dcm_attitude(roll, pitch, yaw);
if (!ekf_started) {
// if we have a GPS lock we can start the EKF
if (get_gps().status() >= AP_GPS::GPS_OK_FIX_3D) {
// if we have a GPS lock and more than 6 satellites, we can start the EKF
if (get_gps().status() >= AP_GPS::GPS_OK_FIX_3D && get_gps().num_sats() >= _gps_minsats) {
if (start_time_ms == 0) {
start_time_ms = hal.scheduler->millis();
}