Parcourir la source

fix(grpc_BS):change arrived judgement condition.

sunjiacheng il y a 3 ans
Parent
commit
19e75c6f30
1 fichiers modifiés avec 2 ajouts et 2 suppressions
  1. 2 2
      src/driver/driver_cloud_grpc_client_BS/fsm_unit.cpp

+ 2 - 2
src/driver/driver_cloud_grpc_client_BS/fsm_unit.cpp

@@ -370,7 +370,7 @@ void FSMUnit::arriveCheckLoop_Timeout(void)
         deltaY = localPositionNextY - localPositionY;
         distance = sqrt(deltaX*deltaX + deltaY*deltaY);
 
-        if(distance < 2.0 && currentSpeed < 0.1)
+        if(distance <= 5.0 && currentSpeed < 0.1)
         {
             waitingStationArrived = true;
         }
@@ -399,7 +399,7 @@ void FSMUnit::arriveCheckLoop_Timeout(void)
         deltaY = localPositionNextY - localPositionY;
         distance = sqrt(deltaX*deltaX + deltaY*deltaY);
 
-        if(distance < 2.0 && currentSpeed < 0.1)
+        if(distance <= 5.0 && currentSpeed < 0.1)
         {
             maintainStationArrived = true;
         }