diff --git a/source/armarx/navigation/server/Navigator.cpp b/source/armarx/navigation/server/Navigator.cpp
index 2647904798c3a8e337cb9e5a1648ecdd810893c5..e43dfa69a63dd9af6a0fd1a30d4740a2463b85e8 100644
--- a/source/armarx/navigation/server/Navigator.cpp
+++ b/source/armarx/navigation/server/Navigator.cpp
@@ -728,15 +728,19 @@ namespace armarx::navigation::server
 
         // scene update
         {
+            ARMARX_DEBUG << "Updating scene";
+
             const Duration duration =
                 armarx::core::time::StopWatch::measure([&]() { updateScene(); });
 
-            ARMARX_VERBOSE << deactivateSpam(0.2) << "Scene update: " << duration.toSecondsDouble()
-                           << "s.";
+            ARMARX_VERBOSE << deactivateSpam(0.2) << "Scene update: " << duration.toMilliSecondsDouble()
+                           << "ms.";
         }
 
         // local planner update
         {
+            ARMARX_DEBUG << "Local planner update";
+
             const Duration duration = armarx::core::time::StopWatch::measure(
                 [&]()
                 {
@@ -748,16 +752,18 @@ namespace armarx::navigation::server
                     }
                 });
             ARMARX_VERBOSE << deactivateSpam(0.2)
-                           << "Local planner update: " << duration.toSecondsDouble() << "s.";
+                           << "Local planner update: " << duration.toMilliSecondsDouble() << "ms.";
         }
 
         // monitor update
         {
+            ARMARX_DEBUG << "Monitor update";
+
             const Duration duration =
                 armarx::core::time::StopWatch::measure([&]() { updateMonitor(); });
 
             ARMARX_VERBOSE << deactivateSpam(0.2)
-                           << "Monitor update: " << duration.toSecondsDouble() << "s.";
+                           << "Monitor update: " << duration.toMilliSecondsDouble() << "ms.";
         }
     }
 
diff --git a/source/armarx/navigation/trajectory_control/TrajectoryFollowingController.cpp b/source/armarx/navigation/trajectory_control/TrajectoryFollowingController.cpp
index b5ef2b45173b69b1ca7612697d6fa772e4f7acf8..17431d8ea90a87028c6ca66b410bd748c6e41231 100644
--- a/source/armarx/navigation/trajectory_control/TrajectoryFollowingController.cpp
+++ b/source/armarx/navigation/trajectory_control/TrajectoryFollowingController.cpp
@@ -11,6 +11,7 @@
 
 #include <RobotAPI/libraries/core/MultiDimPIDController.h>
 
+#include "armarx/navigation/core/basic_types.h"
 #include <armarx/navigation/core/Trajectory.h>
 #include <armarx/navigation/core/types.h>
 #include <armarx/navigation/trajectory_control/TrajectoryController.h>