robofsm: Add constant for close target value.

diff --git a/src/robofsm/common-states.cc b/src/robofsm/common-states.cc
index ffa357e6337879ed7fc5aeaea687566ef0b4ecb0..e908c758ab2d4991a0b47f02cbce5847a7ae655b 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;