Fixed status logic bug

Author: Siddhartha Srinivasa

src/prpy/planning/vectorfield.py

@@ -155,12 +155,12 @@ def TerminateMove():
             if position_deviation > position_tolerance:
                 raise PlanningError('Deviated from straight line constraint.')
 
-            if distance_moved > distance:
-                return Status.CACHE_AND_CONTINUE
-
             if distance_moved > max_distance:
                 return Status.TERMINATE
 
+            if distance_moved > distance:
+                return Status.CACHE_AND_CONTINUE
+
             return Status.CONTINUE
 
         return self.FollowVectorField(robot, vf_straightline,