论文部分内容阅读
自动驾驶系统从地图数据获取一系列轨迹点作为寻迹行驶的参考轨迹,由于地图数据误差的存在,导致输入的参考轨迹不够平滑,影响到后续决策控制模块的性能,最终造成自动驾驶车辆行驶的舒适性差。针对这一问题,提出一种分段多项式拟合的参考轨迹平滑处理方法,对原始的参考轨迹点做分段处理,利用带约束条件的最小二乘法求解分段轨迹点的多项式拟合曲线,最后将分段拟合曲线等间距采样作为平滑处理后的参考轨迹。该方法能够保证分段曲线高阶连续的同时,在分断点处具有一阶连续。实验结果表明,采用分段多项式拟合方法获得的拟合曲线连续光滑,处理后