debug stuff

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.";
         }
     }
 

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>