diff --git a/src/modules/mc_pos_control/TranslationControl.cpp b/src/modules/mc_pos_control/TranslationControl.cpp
index 6ea45d4cc2..9453ed1c68 100644
--- a/src/modules/mc_pos_control/TranslationControl.cpp
+++ b/src/modules/mc_pos_control/TranslationControl.cpp
@@ -71,8 +71,8 @@ TranslationControl::TranslationControl()
 	_setParams();
 };
 
-void TranslationControl::updateState(const struct vehicle_local_position_s state, const matrix::Vector3f vel_dot,
-				     const matrix::Matrix<float, 3, 3> R)
+void TranslationControl::updateState(const struct vehicle_local_position_s state, const matrix::Vector3f &vel_dot,
+				     const matrix::Matrix<float, 3, 3> &R)
 {
 	_pos = Data(&state.x);
 	_vel = Data(&state.vx);
diff --git a/src/modules/mc_pos_control/TranslationControl.hpp b/src/modules/mc_pos_control/TranslationControl.hpp
index 4b52f3687a..67c9d0add7 100644
--- a/src/modules/mc_pos_control/TranslationControl.hpp
+++ b/src/modules/mc_pos_control/TranslationControl.hpp
@@ -64,8 +64,8 @@ public:
 
 	~TranslationControl() {};
 
-	void updateState(const struct vehicle_local_position_s state, const matrix::Vector3f vel_dot,
-			 const matrix::Matrix<float, 3, 3> R);
+	void updateState(const struct vehicle_local_position_s state, const matrix::Vector3f &vel_dot,
+			 const matrix::Matrix<float, 3, 3> &R);
 	void updateSetpoint(struct vehicle_local_position_setpoint_s setpoint);
 	void updateConstraints(const Controller::Constraints &constraints);
 	void generateThrustYawSetpoint(const float &dt);