Fix trajectory evaluation velocity unit

source/armarx/navigation/core/Trajectory.cpp

@@ -711,7 +711,7 @@ namespace armarx::navigation::core
         math::LinearInterpolatedPose ip(lower->pose.matrix(), lower[1].pose.matrix(), 0, 1, true);
 
         const Eigen::Vector3f distance = lower[1].pose.translation() - lower->pose.translation();
-        const float speed = distance.norm() / 1000 / dT.toSecondsDouble();
+        const float speed = distance.norm() / dT.toSecondsDouble();
 
         return {static_cast<core::Pose>(ip.Get(t)), speed};
     }