|
@@ -360,7 +360,7 @@ void FSMUnit::arriveCheckLoop_Timeout(void)
|
|
double deltaY = localPositionNextY - localPositionY;
|
|
double deltaY = localPositionNextY - localPositionY;
|
|
double distance = sqrt(deltaX*deltaX + deltaY*deltaY);
|
|
double distance = sqrt(deltaX*deltaX + deltaY*deltaY);
|
|
|
|
|
|
- if(distance > 1.0)
|
|
|
|
|
|
+ if(distance > 5.0)
|
|
{
|
|
{
|
|
emit sendPathPlanRequest(waitingStation.latitude,waitingStation.longitude);
|
|
emit sendPathPlanRequest(waitingStation.latitude,waitingStation.longitude);
|
|
}
|
|
}
|
|
@@ -387,7 +387,7 @@ void FSMUnit::arriveCheckLoop_Timeout(void)
|
|
double deltaY = localPositionNextY - localPositionY;
|
|
double deltaY = localPositionNextY - localPositionY;
|
|
double distance = sqrt(deltaX*deltaX + deltaY*deltaY);
|
|
double distance = sqrt(deltaX*deltaX + deltaY*deltaY);
|
|
|
|
|
|
- if(distance > 1.0)
|
|
|
|
|
|
+ if(distance > 5.0)
|
|
{
|
|
{
|
|
emit sendPathPlanRequest(maintainStation.latitude,maintainStation.longitude);
|
|
emit sendPathPlanRequest(maintainStation.latitude,maintainStation.longitude);
|
|
}
|
|
}
|