diff --git a/src/modules/fw_mode_manager/figure_eight/FigureEight.cpp b/src/modules/fw_mode_manager/figure_eight/FigureEight.cpp
index f7585f39b4..a995d28543 100644
--- a/src/modules/fw_mode_manager/figure_eight/FigureEight.cpp
+++ b/src/modules/fw_mode_manager/figure_eight/FigureEight.cpp
@@ -105,7 +105,7 @@ FigureEight::FigureEightPatternParameters FigureEight::sanitizeParameters(const
 }
 
 void FigureEight::initializePattern(const matrix::Vector2f &curr_pos_local, const matrix::Vector2f &ground_speed,
-				    const FigureEightPatternParameters &parameters, FigureEightPatternPoints pattern_points)
+				    const FigureEightPatternParameters &parameters, const FigureEightPatternPoints &pattern_points)
 {
 	// Initialize the currently active segment, if it hasn't been active yet, or the pattern has been changed.
 	if ((_current_segment == FigureEightSegment::SEGMENT_UNDEFINED) || (_active_parameters != parameters)) {
diff --git a/src/modules/fw_mode_manager/figure_eight/FigureEight.hpp b/src/modules/fw_mode_manager/figure_eight/FigureEight.hpp
index 297e07942c..fcdb39915c 100644
--- a/src/modules/fw_mode_manager/figure_eight/FigureEight.hpp
+++ b/src/modules/fw_mode_manager/figure_eight/FigureEight.hpp
@@ -140,7 +140,7 @@ private:
 	 * @param[in] pattern_points are the figure of eight pattern points.
 	 */
 	void initializePattern(const matrix::Vector2f &curr_pos_local, const matrix::Vector2f &ground_speed,
-			       const FigureEightPatternParameters &parameters, FigureEightPatternPoints pattern_points);
+			       const FigureEightPatternParameters &parameters, const FigureEightPatternPoints &pattern_points);
 
 	/**
 	 * @brief Calculate figure eight pattern points