diff --git a/hubero_ros/src/navigation_ros.cpp b/hubero_ros/src/navigation_ros.cpp
index db618e2b..fec04c9a 100644
--- a/hubero_ros/src/navigation_ros.cpp
+++ b/hubero_ros/src/navigation_ros.cpp
@@ -268,13 +268,6 @@ Vector3 NavigationRos::getVelocityCmd() const {
 	return cmd_vel_;
 }
 
-void NavigationRos::callbackCmdVel(const geometry_msgs::Twist::ConstPtr& msg) {
-	const std::lock_guard<std::mutex> lock(mutex_callback_);
-	cmd_vel_.X(msg->linear.x);
-	cmd_vel_.Y(msg->linear.y);
-	cmd_vel_.Z(msg->angular.z);
-}
-
 // static
 void NavigationRos::setIdealCovariance(boost::array<double, 36>& cov) {
 	// update covariance - note that pose is perfectly known
@@ -285,4 +278,11 @@ void NavigationRos::setIdealCovariance(boost::array<double, 36>& cov) {
 	}
 }
 
+void NavigationRos::callbackCmdVel(const geometry_msgs::Twist::ConstPtr& msg) {
+	const std::lock_guard<std::mutex> lock(mutex_callback_);
+	cmd_vel_.X(msg->linear.x);
+	cmd_vel_.Y(msg->linear.y);
+	cmd_vel_.Z(msg->angular.z);
+}
+
 } // namespace hubero