diff --git a/sw/airborne/modules/gps/gps_ubx.c b/sw/airborne/modules/gps/gps_ubx.c
index 1ec63c9000..3344286094 100644
--- a/sw/airborne/modules/gps/gps_ubx.c
+++ b/sw/airborne/modules/gps/gps_ubx.c
@@ -184,17 +184,13 @@ static void gps_ubx_parse_nav_pvt(void)
   gps_ubx.state.lla_pos.alt = UBX_NAV_PVT_height(gps_ubx.msg_buf);
   SetBit(gps_ubx.state.valid_fields, GPS_VALID_POS_LLA_BIT);
 
-  // Copy heading if valid
-  uint8_t headVehValid      = bit_is_set(flags, 5);
-  if (headVehValid) {
-    // Ublox gives I4 heading in 1e-5 degrees, apparenty from 0 to 360 degrees (not -180 to 180)
-    // I4 max = 2^31 = 214 * 1e5 * 100 < 360 * 1e7: overflow on angles over 214 deg -> casted to -214 deg
-    // solution: First to radians, and then scale to 1e-7 radians
-    // First x 10 for loosing less resolution, then to radians, then multiply x 10 again
-    gps_ubx.state.course    = (RadOfDeg(UBX_NAV_PVT_headMot(gps_ubx.msg_buf) * 10)) * 10;
-    SetBit(gps_ubx.state.valid_fields, GPS_VALID_COURSE_BIT);
-    gps_ubx.state.cacc      = (RadOfDeg(UBX_NAV_PVT_headAcc(gps_ubx.msg_buf) * 10)) * 10;
-  }
+  // Ublox gives I4 heading in 1e-5 degrees, apparenty from 0 to 360 degrees (not -180 to 180)
+  // I4 max = 2^31 = 214 * 1e5 * 100 < 360 * 1e7: overflow on angles over 214 deg -> casted to -214 deg
+  // solution: First to radians, and then scale to 1e-7 radians
+  // First x 10 for loosing less resolution, then to radians, then multiply x 10 again
+  gps_ubx.state.course    = (RadOfDeg(UBX_NAV_PVT_headMot(gps_ubx.msg_buf) * 10)) * 10;
+  SetBit(gps_ubx.state.valid_fields, GPS_VALID_COURSE_BIT);
+  gps_ubx.state.cacc      = (RadOfDeg(UBX_NAV_PVT_headAcc(gps_ubx.msg_buf) * 10)) * 10;
 
   // Copy HMSL and ground speed
   gps_ubx.state.hmsl        = UBX_NAV_PVT_hMSL(gps_ubx.msg_buf);