RoverPositionController: remove some unused stuff

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

src/lib/l1/ECL_L1_Pos_Controller.cpp

@@ -48,12 +48,6 @@
 
 using matrix::Vector2f;
 
-float ECL_L1_Pos_Controller::switch_distance(float wp_radius)
-{
-	/* following [2], switching on L1 distance */
-	return math::min(wp_radius, _L1_distance);
-}
-
 void
 ECL_L1_Pos_Controller::navigate_waypoints(const Vector2f &vector_A, const Vector2f &vector_B,
 		const Vector2f &vector_curr_position, const Vector2f &ground_speed_vector)

src/lib/l1/ECL_L1_Pos_Controller.hpp

@@ -97,17 +97,6 @@ public:
 	 */
 	float crosstrack_error() { return _crosstrack_error; }
 
-	/**
-	 * Get the switch distance
-	 *
-	 * This is the distance at which the system will
-	 * switch to the next waypoint. This depends on the
-	 * period and damping
-	 *
-	 * @param waypoint_switch_radius The switching radius the waypoint has set.
-	 */
-	float switch_distance(float waypoint_switch_radius);
-
 	/**
 	 * Navigate between two waypoints
 	 *