一种基于模糊算法的带约束方波状车速规划方法

摘要

本发明公开了一种基于模糊算法的带约束方波状车速规划方法，属于自动驾驶车辆速度规划领域。该方法首先确定了模糊算法输入输出量隶属函数和模糊算法的模糊规则集。然后计算了后续算法所需的全局变量，包括已得规划路径的曲率信号队列、滤波后的曲率以及方波状拟合算法相关的全局变量。最后对滚动窗口内的曲率进行方波状拟合并结合汽车、环境状态量计算出目标轨迹点的速度，再考虑车辆动力学，为规划出的速度曲线进行二次规划。本发明从人类驾驶经验出发，规划出的速度轨迹更符合正常的驾驶员驾驶习惯，从而更容易实现无人驾驶汽车的相关功能且具有更好的适应性与安全性。