Odometry calibration

[eurobot/public.git] / src / robofsm / robot.c

diff --git a/src/robofsm/robot.c b/src/robofsm/robot.c
index e49f2690cd2d8c4cd5d55b4f5fe1a68b3923515c..5aeb5dd432bea727b7432757c731d90291a54d9d 100644 (file)
--- a/src/robofsm/robot.c
+++ b/src/robofsm/robot.c
@@ -31,6 +31,7 @@ UL_LOG_CUST(ulogd_robot); /* Log domain name = ulogd + name of the file */
 
 #define MOTION_CONTROL_INIT_ONLY
 #include "motion-control.h"
+#include "robot.h"
 
 /* Global definition of robot structure */
 struct robot robot;
@@ -317,4 +318,6 @@ void robot_calibrate_odometry()
        }
        robot.odo_cal_a = a / num;
        robot.odo_cal_b = b / num;
+       printf("calibrated value left: %f\n",robot.odo_cal_a);
+       printf("calibrated value right: %f\n",robot.odo_cal_b);
 }