Quellcode durchsuchen

fix(grpc_BS):change arrived judgement condition.

sunjiacheng vor 3 Jahren
Ursprung
Commit
19e75c6f30
1 geänderte Dateien mit 2 neuen und 2 gelöschten Zeilen
  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;
         }