Add dedicated STOMP publisher marker

Author: sjahr

doc/how_to_guides/planner_cost_functions/config/cost_fn_config.rviz

@@ -153,6 +153,20 @@ Visualization Manager:
       Trajectory Topic: /display_planned_path
       Use Sim Time: false
       Value: true
+    - Class: rviz_default_plugins/MarkerArray
+      Enabled: true
+      Name: MarkerArray
+      Namespaces:
+        Path: true
+        Sphere: true
+        Text: true
+      Topic:
+        Depth: 5
+        Durability Policy: Volatile
+        History Policy: Keep All
+        Reliability Policy: Reliable
+        Value: /stomp_visualization
+      Value: true
     - Class: rviz_default_plugins/MarkerArray
       Enabled: true
       Name: MarkerArray