diff --git a/source/armarx/navigation/server/monitoring/GoalReachedMonitor.cpp b/source/armarx/navigation/server/monitoring/GoalReachedMonitor.cpp index bb7e134b08c23e8260e1f4a438b681fd963801a6..923eeb12ad41e6fef8b0ed7116b00c420139f0ce 100644 --- a/source/armarx/navigation/server/monitoring/GoalReachedMonitor.cpp +++ b/source/armarx/navigation/server/monitoring/GoalReachedMonitor.cpp @@ -42,8 +42,6 @@ namespace armarx::navigation::server ARMARX_DEBUG << "Orientation goal reached"; } - std::unique_lock lock{ - scene.platformVelocityMtx}; // thread-safe access to scene.platformVelocity if (not scene.platformVelocity.has_value()) { @@ -55,8 +53,6 @@ namespace armarx::navigation::server const bool angularVelocityLow = scene.platformVelocity->angular.norm() < config.angularVelTh; - lock.unlock(); - const bool velocityLow = linearVelocityLow and angularVelocityLow; if (velocityLow)