Browse Source

modify final brake

zhangjia 3 years ago
parent
commit
530aa0f2bb
1 changed files with 6 additions and 0 deletions
  1. 6 0
      src/decition/decition_brain_sf/decition/decide_gps_00.cpp

+ 6 - 0
src/decition/decition_brain_sf/decition/decide_gps_00.cpp

@@ -971,6 +971,12 @@ iv::decition::Decition iv::decition::DecideGps00::getDecideFromGPS(GPS_INS now_g
                 else if(gpsMapLine[PathPoint+100]->mode2==23)
                                         minDecelerate=-0.5;
             }
+            else if(PathPoint+150<gpsMapLine.size()){
+                if(gpsMapLine[PathPoint+150]->mode2==23 && realspeed>10)
+                                        minDecelerate=-0.5;
+                else if(gpsMapLine[PathPoint+100]->mode2==23)
+                                        minDecelerate=-0.5;
+            }
             else if(PathPoint+100<gpsMapLine.size()){
                     if(gpsMapLine[PathPoint+100]->mode2==23)
                                         minDecelerate=-0.5;