robofsm: Add constant for close target value.

diff --git a/src/robofsm/common-states.cc b/src/robofsm/common-states.cc
index 78b543b2c03f91236b850967bd0f924535c55af0..178183c3899a3e67f70cea43f4fc9d128329178c 100644 (file)
--- a/src/robofsm/common-states.cc
+++ b/src/robofsm/common-states.cc
@@ -62,10 +62,11 @@ bool goal_is_in_playground(double goalx, double goaly)
 /* Check if the new point is close to the robot */
 bool close_goal(double goalx, double goaly)
 {
+        const double close = 0.5;
         double x, y, phi;
         robot_get_est_pos(&x, &y, &phi);
 
-        if ((abs(goalx - x) < 0.5) && (abs(goaly - y) < 0.5) )
+        if ((abs(goalx - x) < close) && (abs(goaly - y) < close) )
                 return true;
         else
                 return false;