robofsm: Add very slow trajectory constraints.

diff --git a/src/robofsm/sick-day.cc b/src/robofsm/sick-day.cc
index 609b6ae8e9863e6cc0ebced31621f554d1883268..4e18b80b2eac0073c27e233f53734845077d2ed0 100644 (file)
--- a/src/robofsm/sick-day.cc
+++ b/src/robofsm/sick-day.cc
@@ -58,6 +58,11 @@ FSM_STATE(init)
                        tcSlow.maxacc = 0.2;
                         tcSlow.maxomega = 0.2;
 
+                        tcVerySlow = trajectoryConstraintsDefault;
+                        tcVerySlow.maxv = 0.05;
+                        tcVerySlow.maxacc = 0.05;
+                        tcVerySlow.maxomega = 0.5;
+
                        FSM_TRANSITION(wait_for_start);
                        break;
                default: