diff --git a/src/modules/mc_pos_control/PositionControl.cpp b/src/modules/mc_pos_control/PositionControl.cpp
index ee492f8c3ac28b135465cde4c47b5555deff5d40..3dec5711d4a0c82fbd73edbf883b3dcbbdc5b5d3 100644
--- a/src/modules/mc_pos_control/PositionControl.cpp
+++ b/src/modules/mc_pos_control/PositionControl.cpp
@@ -243,10 +243,10 @@ void PositionControl::_velocityController(const float &dt)
 
 	}
 
-	/* Satureate thrust setpoint in D-direction */
+	/* Saturate thrust setpoint in D-direction */
 	_thr_sp(2) = math::constrain(thrust_desired_D, uMin, uMax);
 
-	if (_thr_sp(0) + _thr_sp(1)  > FLT_EPSILON) {
+	if (fabsf(_thr_sp(0)) + fabsf(_thr_sp(1))  > FLT_EPSILON) {
 
 		/* Thrust setpoints in NE-direction is already provided. Only
 		 * scaling is required.