一种智能驾驶车辆轨迹跟踪控制方法技术

本发明专利技术公开了一种智能驾驶车辆轨迹跟踪控制方法，包括以下步骤：a．生成车辆行驶的目标路径曲线，目标路径曲线由点序列组成；b．计算目标路径曲线上点序列中距车辆当前位置最近的点，基于该点确定车辆在目标路径曲线上预瞄点的位置；c．确定车辆由当前位置经过预瞄时间实际到达的位置；d．确定车辆经过预瞄时间实际到达的位置与预瞄点的位置二者之间的侧向路径偏差；e．基于侧向路径偏差，采用控制算法计算输出车辆的转向盘的转角增量；f．根据转向盘的转角增量控制车辆的转向盘的转动角度。本发明专利技术的智能驾驶车辆轨迹跟踪控制方法很好地解决了智能车辆在主动转向控制过程中出现的稳定性问题和精确性问题，改善了现有的主动转向控制技术。

A Trajectory Tracking Control Method for Intelligent Driving Vehicles

The invention discloses an intelligent driving vehicle trajectory tracking control method, which includes the following steps: A. generating the vehicle traveling target path curve, which is composed of point series; B. calculating the nearest point of the point sequence on the target path curve from the current position of the vehicle, and determining the position of the preview point of the vehicle on the target path curve based on the point; C. determining the vehicle from the current position; The position actually arrives after the preview time; D. Determine the lateral path deviation between the actual position of the vehicle passing through the preview time and the position of the preview point; E. Based on the lateral path deviation, the control algorithm is used to calculate the steering wheel angle increment of the output vehicle; f. Control the steering wheel rotation angle according to the steering wheel angle increment. The trajectory tracking control method of the intelligent driving vehicle of the present invention solves the stability and accuracy problems of the intelligent vehicle in the process of active steering control, and improves the existing active steering control technology.

【技术实现步骤摘要】
一种智能驾驶车辆轨迹跟踪控制方法
本专利技术涉及车辆智能驾驶
，具体涉及一种智能驾驶车辆轨迹跟踪控制方法。
技术介绍
无人驾驶车辆是通过车载传感系统感知道路环境，自动规划行车路线并控制车辆到达预定目标的智能车辆。它是利用车载传感器来感知车辆周围环境，并根据感知所获得的道路、车辆位置和障碍物信息，控制车辆的转向和速度，从而使车辆能够安全、可靠地在道路上行驶。集自动控制、体系结构、人工智能、视觉计算等众多技术于一体，是计算机科学、模式识别和智能控制技术高度发展的产物，也是衡量一个国家科研实力和工业水平的一个重要标志，在国防和国民经济领域具有广阔的应用前景。路径跟踪控制是无人驾驶车研究的关键技术之一，目前路径跟踪问题的提法有很多，它们有一个共同点：控制目的是使被控对象能精确地沿着期望的几何路径行走。可将无人驾驶车的路径跟踪问题描述为：在一定的体系结构下，能够精确跟踪传感器给出的道路信息，或在无道路信息下跟踪虚拟的期望路径的控制策略的研究。国内外在路径跟踪控制方面已经做了大量研究，目前面临的主要问题是：由于驾驶员驾驶特性的非线性、时变性等特征以及车辆的动力学特性，这样得到的车辆模型对输入信号的响应与真实车辆的实际响应相比会有差距。
技术实现思路
本专利技术的目的是针对现有技术中的问题，提供一种改进的智能驾驶车辆轨迹跟踪控制方法。为达到上述目的，本专利技术采用的技术方案是：一种智能驾驶车辆轨迹跟踪控制方法，包括以下步骤：a.生成车辆行驶的目标路径曲线，目标路径曲线由点序列组成；b.计算得出目标路径曲线上点序列中距车辆当前位置最近的点，并基于该点确定车辆在目标路径曲线上的预瞄点的位置；c.确定车辆由当前位置经过预瞄时间所实际到达的位置；d.确定车辆经过预瞄时间实际到达的位置与预瞄点的位置二者之间的侧向路径偏差；e.基于侧向路径偏差，采用控制算法计算输出车辆的转向盘的转角增量；f.根据转向盘的转角增量控制车辆的转向盘的转动角度。优选地，车辆在目标路径曲线上的预瞄点的位置通过计算目标路径曲线上预瞄点在车辆坐标系中的纵坐标值获得。进一步地，车辆在目标路径曲线上的预瞄点在车辆坐标系中的纵坐标值为：yP＝-(Xp+m-XC)sinψ+(Yp+m-YC)cosψ，其中Xp+m、Yp+m为预瞄曲线段终点序号的位置，XC、YC为车辆当前位置，ψ为方位角。更进一步地，令p为目标路径曲线上点序列中距车辆当前位置最近的点Jp的序号，p的初值为0，令Jp,Jp+1,Jp+2…Jp+m为目标曲线路径上的预瞄曲线段，其长度为预瞄距离u·Tp，其中，u为车辆行驶速度，Tp为预瞄时间，由此确定预瞄曲线段的终点Jp+m序号为其中L0为点序列中相邻两点之间的距离。优选地，车辆由当前位置经过预瞄时间实际到达的位置在车辆坐标系中的纵坐标值为：其中车辆当前行驶速度为v，纵向速度分量为u，两者之间夹角为β，车辆从当前位置C以横摆角速度ωr沿目标路径曲线经过预瞄时间Tp实际到达Q点位置。优选地，步骤e中采用PID控制算法计算输出车辆的转向盘的转角增量。进一步地，转向盘的转角增量为Δθsw＝kpey+kDey+ki∫eye-λtdt，其中，ey为侧向路径偏差，kp为比例增益，ki为积分增益，kD为微分增益，λ为遗忘因子，λ大于0。优选地，步骤a中的目标路径曲线为正弦波曲线和/或双移线曲线。由于上述技术方案的运用，本专利技术与现有技术相比具有下列优点：本专利技术的智能驾驶车辆轨迹跟踪控制方法通过计算车辆经过预瞄时间实际到达的位置与预瞄点的位置二者之间的侧向路径偏差，并基于该侧向路径偏差采用一定的控制算法，控制输出转向盘的转角增量，然后基于该值对车辆的转向盘的转角进行调整，在车辆行驶过程中，对车辆转向控制不断进行修正，达到较为理想的控制效果，很好地解决了智能车辆在主动转向控制过程中出现的稳定性问题和精确性问题，改善了现有的主动转向控制技术。附图说明附图1为本专利技术的智能驾驶车辆轨迹跟踪控制方法的流程图；附图2为本专利技术的智能驾驶车辆对目标路径曲线的跟踪效果图之一(正弦波形目标路径曲线，车辆速度为20km/h)；附图3为本专利技术的智能驾驶车辆对目标路径曲线的跟踪效果图之二(正弦波形目标路径曲线，车辆速度为40km/h)；附图4为本专利技术的智能驾驶车辆对目标路径曲线的跟踪效果图之三(双移线形目标路径曲线，车辆速度为20km/h)；附图5为本专利技术的智能驾驶车辆对目标路径曲线的跟踪效果图之四(双移线形目标路径曲线，车辆速度为40km/h)。具体实施方式下面结合附图来对本专利技术的技术方案作进一步的阐述。本专利技术的智能驾驶车辆轨迹跟踪控制方法控制流程图如图1所示，具体包括如下步骤：(1)采用轨迹生成器生成车辆行驶的目标路径曲线，目标路径曲线由点序列组成。目标路径曲线由点序列{J0,J1,J2,…,Jn}组成。其中J0和Jn分别为目标路径曲线的起点和终点。目标路径曲线上各点在车辆坐标系中的坐标为(Xi,Yi)，i＝0,1,2,…,n。这些点均通过采样得到，相邻两点之间距离设为L0。(2)计算得出目标路径曲线上点序列中距车辆当前位置最近的点，并基于该点确定车辆在目标路径曲线上的预瞄点的位置。车辆在目标路径曲线上的预瞄点的位置通过计算目标路径曲线上预瞄点在车辆坐标系中的纵坐标值获得，具体计算方法如下：设车辆当前位置为(XC,YC)、方位角为ψ，则上述目标路径曲线上各点在车辆坐标系中的坐标为：令p为目标路径曲线上点序列中距车辆当前位置最近的点Jp的序号，0≤p≤n。p的初值为0，车辆起步后通过实时搜索最近点确定p的动态值。令Jp,Jp+1,Jp+2…Jp+m为目标路径曲线上的预瞄曲线段，其长度为预瞄距离uTp，u为车辆行驶速度的纵向速度分量，Tp为预瞄时间。由此大致确定该线段的终点Jp+m序号为：因此，目标路径曲线上预瞄点p在车辆坐标系中的纵坐标值yp为：yP＝-(Xp+m-XC)sinψ+(Yp+m-YC)cosψ式中，Xp+m、Yp+m为预瞄曲线段终点序号的位置，XC、YC为车辆当前位置，ψ为方位角。(3)确定车辆由当前位置经过预瞄时间Tp所实际到达的位置。车辆由当前位置经过预瞄时间Tp所实际到达的位置在车辆坐标系中的纵坐标值的计算方法如下：设t时刻目标路径曲线在车辆坐标系中的方程为y＝f(x)，车辆当前行驶速度为v，纵向速度分量为u，两者夹角为β，即航向角，当车辆从当前位置C以横摆角速度ωr沿路径CQ行驶到Q点时，经历预瞄时间Tp，因此其转过的角度为θQ＝ωrTP，直线CQ相对于车辆速度矢量的夹角为θQ/2，所以该直线相对于x轴的夹角为θQ/2+β。因此Q点在车辆坐标系中的纵坐标值yQ为：式中，为车辆从当前位置C点到达Q点的直线距离。(4)确定车辆经过预瞄时间实际到达的位置与预瞄点的位置二者之间的侧向路径偏差ey。侧向路径偏差ey通过下式计算：ey＝yp-yQ(5)基于侧向路径偏差ey，采用控制算法计算输出车辆的转向盘的转角增量。本实施例中，根据侧向路径偏差ey，采用PID控制算法，输出车辆的转向盘的转角增量，转向盘的转角增量通过下式计算：Δθsw＝kpey+kDey+ki∫eye-λtdt其中kp为比例增益，ki为积分增益，kd为微分增益，λ为遗忘因子，λ>0。(6)根据PID控制算法本文档来自技高网...

【技术保护点】
1.一种智能驾驶车辆轨迹跟踪控制方法，其特征在于：包括以下步骤：a.生成车辆行驶的目标路径曲线，目标路径曲线由点序列组成；b.计算得出目标路径曲线上点序列中距车辆当前位置最近的点，并基于该点确定车辆在目标路径曲线上的预瞄点的位置；c.确定车辆由当前位置经过预瞄时间所实际到达的位置；d.确定车辆经过预瞄时间实际到达的位置与预瞄点的位置二者之间的侧向路径偏差；e.基于侧向路径偏差，采用控制算法计算输出车辆的转向盘的转角增量；f.根据转向盘的转角增量控制车辆的转向盘的转动角度。

【技术特征摘要】
1.一种智能驾驶车辆轨迹跟踪控制方法，其特征在于：包括以下步骤：a.生成车辆行驶的目标路径曲线，目标路径曲线由点序列组成；b.计算得出目标路径曲线上点序列中距车辆当前位置最近的点，并基于该点确定车辆在目标路径曲线上的预瞄点的位置；c.确定车辆由当前位置经过预瞄时间所实际到达的位置；d.确定车辆经过预瞄时间实际到达的位置与预瞄点的位置二者之间的侧向路径偏差；e.基于侧向路径偏差，采用控制算法计算输出车辆的转向盘的转角增量；f.根据转向盘的转角增量控制车辆的转向盘的转动角度。2.根据权利要求1所述的智能驾驶车辆轨迹跟踪控制方法，其特征在于：车辆在目标路径曲线上的预瞄点的位置通过计算目标路径曲线上预瞄点在车辆坐标系中的纵坐标值获得。3.根据权利要求2所述的智能驾驶车辆轨迹跟踪控制方法，其特征在于：车辆在目标路径曲线上的预瞄点在车辆坐标系中的纵坐标值为：yP＝-(Xp+m-XC)sinψ+(Yp+m-YC)cosψ，其中Xp+m、Yp+m为预瞄曲线段终点序号的位置，XC、YC为车辆当前位置，ψ为方位角。4.根据权利要求3所述的智能驾驶车辆轨迹跟踪控制方法，其特征在于：令p为目标路径曲线上点序列中距车辆当前位置最近的点Jp的序号，p的初值为0，令Jp,Jp+1,Jp+2…...

【专利技术属性】
技术研发人员：丁延超，丁能根，李颖，
申请(专利权)人：清华大学苏州汽车研究院相城，苏州观瑞汽车技术有限公司，
类型：发明
国别省市：江苏,32