diff --git a/pure_test.py b/pure_test.py index de50b5c..7c6271d 100644 --- a/pure_test.py +++ b/pure_test.py @@ -163,7 +163,7 @@ def pure_pursuit_control(state, cx, cy, pind): if len(TX_TY)>20: Lfc=Lfc*curvature*0.5 # Lfc=round(Lfc) - if curvature<0.05: + if curvature<0.07: Lfc=0.4558 if Lfc==0: Lfc=1 @@ -336,7 +336,7 @@ def main(): -28.984, -29.007, -29.039, -29.063, -29.097, -29.129, -29.158, -29.18, -29.206, -29.227, -29.251, -29.28, -29.304, -29.328, -29.346, -29.369, -29.384, -29.409, -29.426, -29.458, -29.479, -29.499] - target_speed = 5/ 3.6 # [m/s] + target_speed = 3/ 3.6 # [m/s] T = 500.0 # 最大模拟时间 # 设置车辆的出事状态 yaw=math.radians(450-(347+180-360))