Skip to content

Commit

Permalink
[ahrs] float_cmpl: fix 3dfix check
Browse files Browse the repository at this point in the history
  • Loading branch information
flixr committed Apr 15, 2015
1 parent d0ddcc7 commit 115040a
Showing 1 changed file with 1 addition and 1 deletion.
2 changes: 1 addition & 1 deletion sw/airborne/subsystems/ahrs/ahrs_float_cmpl.c
Expand Up @@ -409,7 +409,7 @@ void ahrs_fc_update_gps(struct GpsState *gps_s)

#if AHRS_USE_GPS_HEADING && USE_GPS
//got a 3d fix, ground speed > 0.5 m/s and course accuracy is better than 10deg
if (3dfix && gps_s->gspeed >= 500 &&
if (gps_s->fix == GPS_FIX_3D && gps_s->gspeed >= 500 &&
gps_s->cacc <= RadOfDeg(10 * 1e7)) {

// gps_s->course is in rad * 1e7, we need it in rad
Expand Down

0 comments on commit 115040a

Please sign in to comment.