소스 검색

add angle limit for laneline decition

liyupeng 2 년 전
부모
커밋
4164430516
1개의 변경된 파일8개의 추가작업 그리고 0개의 파일을 삭제
  1. 8 0
      src/decition/laneline_decition_brain_sf_changan_shenlan/decition/decide_from_laneline.cpp

+ 8 - 0
src/decition/laneline_decition_brain_sf_changan_shenlan/decition/decide_from_laneline.cpp

@@ -371,6 +371,14 @@ double iv::decition::DecideFromLaneline::limitAngle(double speed, double angle)
             preAngle = -15;
             preAngle = -15;
         }
         }
     }
     }
+    if(preAngle > 400)
+    {
+        preAngle = 400;
+    }
+    if(preAngle < -400)
+    {
+        preAngle = -400;
+    }
     return preAngle;
     return preAngle;
 }
 }