Remove todo, change velocity visualization upper limit

source/armarx/navigation/local_planning/TimedElasticBands.cpp

@@ -116,8 +116,6 @@ namespace armarx::navigation::local_planning
 
         try
         {
-            // TODO (SALt): free goal velocity is not respected inside homotopy planner
-            ARMARX_VERBOSE << "Plan to dest: " << planToDest << ", freeGoal Vel: " << !planToDest;
             hcp_->plan(start, end, &velocity_start, !planToDest);
         }
         catch (std::exception& e)

source/armarx/navigation/server/introspection/ArvizIntrospector.cpp

@@ -172,7 +172,7 @@ namespace armarx::navigation::server
 
         simox::ColorMap cm = simox::color::cmaps::inferno();
         cm.set_vmin(0);
-        cm.set_vmax(1);
+        cm.set_vmax(0.6);
 
         for (size_t i = 0; i < trajectory.points().size() - 1; i++)
         {