自动驾驶路径规划中路线过渡的平滑处理方法
路径半径为RRR,路径曲率为1R\frac{1}{R}R1。如果要控制车辆平滑运动,必须确保路径的曲率是一个连续的量。那么就得对路径段的连接做平滑处理,已直线段到圆弧段的过渡为例。
为了满足曲率的连续性,我们可以定义一条曲率为其弧长的线性函数的螺旋线,在数学上定义为菲涅尔积分。参数方程为:
[x(t)y(t)]=a[C(t)S(t)]\begin{bmatrix} x(t) \\ y(t) \end{bmatrix} = a\begin{bmatrix} C(t) \\ S(t) \end{bmatrix}[