Browse Source

fix(grpc_BS):change arrived judgement condition.

sunjiacheng 3 years ago
parent
commit
19e75c6f30
1 changed files with 2 additions and 2 deletions
  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;
         deltaY = localPositionNextY - localPositionY;
         distance = sqrt(deltaX*deltaX + deltaY*deltaY);
         distance = sqrt(deltaX*deltaX + deltaY*deltaY);
 
 
-        if(distance < 2.0 && currentSpeed < 0.1)
+        if(distance <= 5.0 && currentSpeed < 0.1)
         {
         {
             waitingStationArrived = true;
             waitingStationArrived = true;
         }
         }
@@ -399,7 +399,7 @@ void FSMUnit::arriveCheckLoop_Timeout(void)
         deltaY = localPositionNextY - localPositionY;
         deltaY = localPositionNextY - localPositionY;
         distance = sqrt(deltaX*deltaX + deltaY*deltaY);
         distance = sqrt(deltaX*deltaX + deltaY*deltaY);
 
 
-        if(distance < 2.0 && currentSpeed < 0.1)
+        if(distance <= 5.0 && currentSpeed < 0.1)
         {
         {
             maintainStationArrived = true;
             maintainStationArrived = true;
         }
         }