瀏覽代碼

change decition_brain_sf_Jeely_xingyueL.

yuchuli 2 年之前
父節點
當前提交
cb52ba68c1
共有 1 個文件被更改,包括 6 次插入3 次删除
  1. 6 3
      src/decition/decition_brain_sf_Jeely_xingyueL/decition/groupspeedctrl.cpp

+ 6 - 3
src/decition/decition_brain_sf_Jeely_xingyueL/decition/groupspeedctrl.cpp

@@ -226,13 +226,16 @@ double GroupSpeedCtrl::Getmindec_front(iv::group::groupinfo & xgroupinfo,
 
     double fspeeddiff = fsecspeednow - pvehbefore->mgpsimu().speed();
 
-    if(fspeeddiff > 0.1)
+    if(fspeeddiff > 0)
     {
         if(((fspeeddiff*fspeeddiff/(2*1.0))+fVehMinDis) < fdistocur)
         {
 //            assert((fdistocur-fVehMinDis)>0);
-            double fdec = (-1.0) * fspeeddiff*fspeeddiff/(2*(fdistocur - fVehMinDis));
-            return fdec;
+            if((fdistocur - fVehMinDis)>0.001)
+            {
+                double fdec = (-1.0) * fspeeddiff*fspeeddiff/(2*(fdistocur - fVehMinDis));
+                return fdec;
+            }
         }
     }
     else