From 015a94e6c4844cbe43609b746fe89c0f62beeedf Mon Sep 17 00:00:00 2001
From: Fabian Reister <fabian.reister@kit.edu>
Date: Fri, 7 Jan 2022 13:37:30 +0100
Subject: [PATCH] server navigator: stopping all threads on stop

---
 source/armarx/navigation/server/Navigator.cpp | 9 +++++++--
 1 file changed, 7 insertions(+), 2 deletions(-)

diff --git a/source/armarx/navigation/server/Navigator.cpp b/source/armarx/navigation/server/Navigator.cpp
index 0473f2ec..57d78b3c 100644
--- a/source/armarx/navigation/server/Navigator.cpp
+++ b/source/armarx/navigation/server/Navigator.cpp
@@ -1039,8 +1039,13 @@ namespace armarx::navigation::server
         ARMARX_INFO << "Stopping.";
 
         pause();
-        // FIXME: send stop event
-        // TODO: Reset own state.
+
+        // stop all threads, including this one
+        stopAllThreads();
+
+        goalReachedMonitor.reset();
+        goalReachedMonitor = std::nullopt;
+
     }
 
     bool
-- 
GitLab