[发明专利]基于PurePursuit算法的预瞄点确定方法

说明书

技术领域

本发明涉及一种基于Pure Pursuit算法的预瞄点确定方法，属于智能车辆路径跟踪相关领域。

技术背景

为了提高交通运输效率和交通安全，世界各国对智能交通系统和安全驾驶等问题的研究投入了大量的人力、物力和财力。美国DARPA自2004年以来，连续三年举办了三届智能车挑战赛活动，进一步促进了智能车领域和智能车技术的发展，2012年谷歌公司发布了一款无人驾驶智能车，并预计在2018年正式上市。除了研究机构、科技公司，许多汽车制造商也都纷纷投入到智能车技术的研究中，奥迪公司的Q7轿车上使用了Hella公司的车道变更告警系统、沃尔沃公司推出的激光防撞系统等。2015年4月，由汽车配件商德尔福研发的一辆无人驾驶汽车完成了横跨美国之旅，再次说明近年来无人驾驶智能车技术的飞速发展。“中国智能车未来挑战赛”是由我国国家自然科学基金委员会举办的无人驾驶智能车比赛，自2009年开始，我国已成功举办了六届“中国智能车未来挑战赛”。

无人驾驶智能车的控制主要包括横向控制和纵向控制两部分。其中横向控制主要指对车辆转向系统的控制。路径跟踪是智能车横向控制的一个主要应用。路径跟踪是指在已经得到一条期望路径的前提下，智能车根据大地坐标系中的位置信息，按照一定的控制策略，使智能车的实际行驶路径可以与规划路径达到一致。目前被广泛应用在无人驾驶智能车路径跟踪的算法基本上都是通过调节实际路径与规划路径之间存在的偏差以实现对目标路径进行跟踪，如方位误差、距离误差等。其中Pure Pursuit算法、斯坦利算法、环形预瞄算法是几类常见的路径跟踪算法。

发明内容

本发明的目的在于提出一种确定规划路径上预瞄点的方法，根据车速和道路，确定预瞄点，并利用Pure Pursuit算法实现车辆的路径跟踪，相较于传统的基于Pure Pursuit算法确定预瞄点，该算法可准确、快速地确定规划路径上的预瞄点，并对前方道路进行提前反应，确保车辆在直道和弯道行驶过程中的平稳性，更好地实现智能车的路径跟踪，同时该算法也可降低规划路径数据点，减少了算法在程序实现过程中数据量，降低了程序运算时间。

Pure Pursuit算法的原理为以规划路径上的某一个点为预瞄点，通过控制车辆转向角，使车辆可以沿着一条经过该预瞄点的圆弧行驶，最终实现路径跟踪。因此，预瞄点的确定是该算法实现的重要环节。本发明提出了一种根据几何特性确定预瞄点的方法，采用该方法可以降低对规划路径数据点的要求、减少数据计算量、提高算法的准确性。

一种基于Pure Pursuit算法的预瞄点确定方法，包括以下步骤：

步骤1：GPS位置信息坐标系转换。

GPS输出数据经度、纬度、高度坐标值，并不适合于平面运动的车辆导航。采用通用横轴墨卡托坐标系(Universal Transverse Mercator，UTM)将经纬度转化到平面坐标系。

步骤2：根据车辆参数和当前车辆行驶速度确定预瞄距离

根据人类驾驶车辆的经验，车辆以不同车速行驶在道路上时，驾驶员的预瞄距离也随之改变，在低速行驶时，驾驶员预瞄前方道路的距离较近，车速增大，驾驶员的预瞄距离也随之增大。

步骤3：判断车辆与规划路径位置

步骤4：确定预瞄点

步骤5：道路判断

道路判断主要用于判断前方道路的状况，即车辆行驶在直线道路上还是行驶在弯道上。对于不同道路状况，预瞄点的筛选与略有不同。

步骤6：算法的实现

得到预瞄点和预瞄距离后，根据Pure Pursuit算法可计算出转向角控制量，为了提高车辆在直线或弯道环境中车辆行驶的平稳性，制定了更改比例增益的控制策略。

具体实施过程如下，

步骤1：GPS位置信息坐标系换算

GPS接收机接收到的GPS信号ASCII码语句,包括GPGGA、GPGSA、GPGSV、GPRMC；PGRME、PGRMM、PGRMT(GARMIN定义的语句)。因此得到的位置信息属于空间大地坐标系，需要转换为UTM直角坐标系。

UTM坐标系是将地球划分成60个投影带，以180°经线为起始线，向东每个6°划分为一个纵带，每个纵带中部的经线被命名为中央经线，并定义中央经线坐标值为500000，在南纬80°至北纬84°范围内，分别从赤道开始，每隔8°划分一个横带。