一种基于差异创新搜索算法的车辆横纵向协同跟踪方法

本发明具体涉及一种基于差异创新搜索算法的车辆横纵向协同跟踪方法，使用路径规划模块对路径的起点和终点进行规划，并计算出该路径的期望航向角、道路曲率、期望横向位置、期望纵向位置；利用建立的车辆跟踪误差动力学模型，以状态观测器监测到的车辆信息和路径规划的道路信息构建LQR控制器；利用差异创新搜索算法计算出LQR控制器的最优控制律；将最优控制律带入到LQR控制器中经过最终计算模块，计算出车辆的前轮转角，同时引入了横向误差ed通过一个PID控制器进行计算，从而解决车辆转向不足的问题；纵向控制器通过位置误差、车辆信息和道路信息进行计算得到车辆油门和刹车的节气门开度进而控制车辆的速度。