Odometry autocalibration

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

diff --git a/src/robofsm/robot.c b/src/robofsm/robot.c
index 5aeb5dd432bea727b7432757c731d90291a54d9d..c4fc03463f5da4b07f3b3b1ef2aaf712dd15bad0 100644 (file)
--- a/src/robofsm/robot.c
+++ b/src/robofsm/robot.c
@@ -305,9 +305,9 @@ void robot_calibrate_odometry()
        float b = 0;
        int num = 0;
        while (fgets (line, 10 , file)) {
-               a = atof(line);
+               a += atof(line);
                fgets (line, 10 , file);
-               b = atof(line);
+               b += atof(line);
                num ++;
        }
        fclose (file);