Explorar o código

fix(grpc_BS):change arrived judgement condition.

sunjiacheng %!s(int64=3) %!d(string=hai) anos
pai
achega
19e75c6f30
Modificáronse 1 ficheiros con 2 adicións e 2 borrados
  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;
         }