基于三次B样条曲线拟合的智能车轨迹跟踪算法

摘要

针对传统几何轨迹跟踪算法切向角获取依赖高精度惯导设备的问题,提出了基于三次B样条曲线拟合的轨迹跟踪算法.首先,通过对先验地图中的离散轨迹点进行拟合生成平滑轨迹线;然后,根据轨迹方程通过插值法重新生成离散路点,并计算各个路点处的切向角,从而实现了对多传感器融合轨迹的优化与跟踪.在真实的智能车实验平台上,用所提算法对20 km/h低速绕圈和60 km/h较高速度直道两种典型场景进行了在真实道路下的跟踪测试.在低速大曲率和较高速度直道两种典型场景下,所提算法轨迹跟踪的最大横向误差均保持在0.3m以内.实验结果表明,该算法有效解决了传统几何轨迹跟踪算法对惯导设备依赖的问题,同时保持了较好的跟踪性能.%The tangential angle acquisition of the traditional geometric path tracking algorithm depends on high precision inertial navigation equipments.In order to solve the problem,a new path tracking algorithm based on cubic B-spline curve fitting was proposed.Firstly,the smooth path was generated by fitting the discrete path points in the priori map.Then,the discrete path points were regenerated by using an interpolation method according to the path equation,and the tangential angle at each point was calculated to realize the optimization and tracking of the multi-sensor fusion path.On the real intelligent vehicle experiment platform,the 20 km/h low-speed-circle and the 60 km/h high-speed-straight-path tracking tests for the proposed algorithm were carried out under the two real road scenes.Under the two typical test scenarios of low-speed-largecurvature and high-speed-straight-path,the maximum lateral error of path tracking of the proposed algorithm is kept within 0.3 m.The experimental results show that,the proposed algorithm can effectively solve the problem of traditional geometric path tracking algorithm's dependence on inertial navigation device,and maintain good tracking pedormance at the same time.