diff --git a/config/config.yaml b/config/config.yaml
index cb1f77a4e39657b5e449de81e32f5be84e6e976e..c76d53ac80ced11a3c979cb46f130ec73fe82a3b 100644
--- a/config/config.yaml
+++ b/config/config.yaml
@@ -3,7 +3,7 @@ panda_mqtt_connector:
   robot_speed_factor: .7
   robot_planning_mode: "fluid_path" # "fluid_path" or "cartesian_path"
   default_trajectory: "<none>"      # "square" or "circle", everything else is ignored
-  data_publish_rate: 50.0           # publish every x'th robot state message
+  data_publish_rate: 100.0          # publication frequency of the robot state message
   topics:
     robotConfig: "robotconfig"
     trajectory: "trajectory"
@@ -40,3 +40,9 @@ panda_mqtt_connector:
     - position: "0.4 -0.4 0.3"
       orientation: "1 1 0 0"
       work: "20000"
+    - position: "0.4 -0.4 0.3" # stay at the position for a while longer
+      orientation: "1 1 0 0"
+      work: "20000"
+    - position: "0.4 0.4 0.3"  # move into the safety zone again to print the line in the plot
+      orientation: "1 1 0 0"
+      work: "20000"