robofsm: Fix homing position bug - wrong units.

diff --git a/src/robofsm/common-states.cc b/src/robofsm/common-states.cc
index a7be794cf6994af295368e961a738d6417ec30c9..2c14bff9adc95637cbf3d2620cbad3beb3ab7cb1 100644 (file)
--- a/src/robofsm/common-states.cc
+++ b/src/robofsm/common-states.cc
@@ -342,7 +342,7 @@ FSM_STATE(go_home)
         switch (FSM_EVENT) {
                 case EV_ENTRY:
                         DBG_PRINT_EVENT("homing");
-                        robot_goto_notrans(HOME_POS_X_M, HOME_POS_Y_M, ARRIVE_FROM(90, 0.5), &tcSlow);
+                        robot_goto_notrans(HOME_POS_X_M, HOME_POS_Y_M, ARRIVE_FROM(DEG2RAD(HOME_POS_ANG_DEG), 0.2), &tcSlow);
                         break;
                 case EV_MOTION_ERROR:
                         DBG_PRINT_EVENT("ERROR: home position is not reachable!");