Ver Fonte

fix(grpc_BS,xodrload):fix arrived judging

孙嘉城 há 3 anos atrás
pai
commit
f7efee6d3e

+ 2 - 2
src/driver/driver_cloud_grpc_client_BS/fsm_unit.cpp

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

+ 2 - 2
src/driver/driver_map_xodrload/main.cpp

@@ -353,7 +353,7 @@ void ShareMap(std::vector<iv::GPSData> navigation_data)
 
 
     int nsize = 100;
-    float nstep = 1;
+    double nstep = 1;
     if(navigation_data.size() < 100)
     {
         nsize = navigation_data.size();
@@ -361,7 +361,7 @@ void ShareMap(std::vector<iv::GPSData> navigation_data)
     }
     else
     {
-        nstep = navigation_data.size()/100;
+        nstep = navigation_data.size()/100.0;
     }
 
     iv::simpletrace psim[100];