|
@@ -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;
|
|
}
|
|
}
|