FWPositionControl: navigateWaypoints: remove check for switchDistance…

… acceptance if behind/in front of waypoints

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>

src/modules/fw_pos_control/FixedwingPositionControl.cpp

@@ -2865,16 +2865,12 @@ void FixedwingPositionControl::navigateWaypoints(const Vector2f &waypoint_A, con
 		}
 
 	} else if ((vector_A_to_B.dot(vector_A_to_vehicle) < -FLT_EPSILON)) {
-		// we are in front of waypoint A, fly directly to it until we are within switch distance.
-		if (vector_A_to_vehicle.norm() > _npfg.switchDistance(500.0f)) {
-			path_tangent = -vector_A_to_vehicle;
-		}
+		// we are in front of waypoint A, fly directly to it
+		path_tangent = -vector_A_to_vehicle;
 
 	} else if (vector_B_to_A.dot(vector_B_to_vehicle) < -FLT_EPSILON) {
-		// we are behind waypoint B, fly directly to it until we are within switch distance.
-		if (vector_B_to_vehicle.norm() > _npfg.switchDistance(500.0f)) {
-			path_tangent = -vector_B_to_vehicle;
-		}
+		// we are behind waypoint B, fly directly to it
+		path_tangent = -vector_B_to_vehicle;
 	}
 
 	// track the line segment