diff --git a/sw/airborne/modules/ins/ins_xsens.c b/sw/airborne/modules/ins/ins_xsens.c index 7f76caa8dc9..8f098f8e2e9 100644 --- a/sw/airborne/modules/ins/ins_xsens.c +++ b/sw/airborne/modules/ins/ins_xsens.c @@ -210,7 +210,7 @@ void handle_ins_msg( void) { gps.ned_vel.z = (int16_t)(ins_vz * 100); gps.gspeed = (uint16_t)(sqrt(ins_vx*ins_vx + ins_vy*ins_vy) * 100); - EstimatorSetAtt(ins_phi, ((float)gps.course) / 1e7, ins_theta); + EstimatorSetAtt(ins_phi, ((float)gps.course / 1e7), ins_theta); // EstimatorSetAlt(ins_z); estimator_update_state_gps(); reset_gps_watchdog();