robofsm: Robot est. position initialized to starting position.

diff --git a/src/robofsm/robot.c b/src/robofsm/robot.c
index 833ca4146727247882ef71d3d1e8373dfb65244e..9f1c93850804825e3fccf0bb670262b7e7976e9b 100644 (file)
--- a/src/robofsm/robot.c
+++ b/src/robofsm/robot.c
@@ -157,7 +157,7 @@ int robot_init()
                ul_loginf("We are BLUE!\n");
        }
 
-       robot_set_est_pos_trans(1, 1, DEG2RAD(0));
+       robot_set_est_pos_trans(ROBOT_START_X_M, ROBOT_START_Y_M, DEG2RAD(ROBOT_START_ANGLE_DEG));
 
        robot.ignore_hokuyo = false;
        robot.map = ShmapInit(1);