自动驾驶汽车路径矫正

车辆与目标线存在一定角度,后轴轴心与目标线距离已知,车身与目标线夹角已知,建立数学模型,需要多久车车身与目标线重合?

假设车辆最初位置的车身与目标线夹角为θ,即车辆的车身与目标线的夹角为θ,车辆的后轴轴心与目标线的距离为d,车身的速度为v,则车身在时间t内移动的距离为vt,车身与目标线夹角变化量为v/d×t,当车身与目标线夹角变为0时,即车身与目标线重合,则有:

θ-v/d×t=0

即:

t=θ×d/v

车身与目标线重合所需的时间为t=θ×d/v。