基于purepursuit算法的纵向速度调整策略制造技术

本发明专利技术公开一种基于pure pursuit算法的纵向速度调整策略，包括如下步骤:确定智能汽车的转角角度和当前车速；比较所述转角角度与预设阈值的大小进而调整智能汽车的加速度。本发明专利技术在pure pursuit算法思想的基础上同时实现纵向速度的控制，使得路径跟踪的精度更高；本发明专利技术提出了一种新的纵向速度控制策略，根据转弯的大小自动、实时改变加速度的大小，从而自动调节运动速度的大小。自动调节运动速度的大小。自动调节运动速度的大小。

【技术实现步骤摘要】
基于pure pursuit算法的纵向速度调整策略


[0001]本专利技术属于智能汽车控制
，特别是涉及一种智能汽车的纵向速度调整策略。

技术介绍

[0002]无人驾驶智能汽车的控制主要包括横向控制和纵向控制两部分，其中横向控制主要指对车辆转向系统的控制，路径跟踪是智能车横向控制的一个主要应用。所谓的路径跟踪是指在已经得到一条期望路径的前提下，智能汽车根据大地坐标系中的位置信息，按照一定的控制策略，使智能汽车的实际行驶路径可以与规划路径达到一致。目前被广泛应用在无人驾驶智能汽车路径跟踪的算法基本上都是通过调节实际路径与规划路径之间存在的偏差以实现对目标路径进行跟踪，如方位误差、距离误差等。其中Pure Pursuit算法、斯坦利算法、环形预瞄算法是几类常见的路径跟踪算法。
[0003]基于Pure Pursuit算法的路径跟踪算法，其主要思想是：根据当前智能汽车的位置选择前方路径上的某个路径点作为预瞄点，这时，智能汽车的位置与预瞄点之间的连线和车身的朝向有个角度偏差，根据这个角度偏差来调整智能汽车的方向盘的转角，从而实现横向控制。
[0004]中国专利CN104960520B《基于Pure Pursuit算法的预瞄点确定方法》详细披露了这一技术。该算法思想简单有效，可实现较高精度的路径跟踪，但是只是有横向速度的控制，没有考虑到纵向速度的控制(即运动速度方面的控制)。
[0005]中国专利CN108001447A《一种智能车辆路径跟踪前轮转角补偿控制方法》揭示了一种控制方法，通过设计纵向车速模糊控制器来确定纵向车速，将实时纵向车速和目标车速的差作为车轮转矩PID控制器的输入值，该方法中同样将纵向基准速度设为被控车辆的参考基准车速，为已知设定值，同样没有纵向车速的控制。

技术实现思路

[0006]本专利技术的目的是解决上述技术问题，提供一种基于pure pursuit算法的纵向速度调整策略。
[0007]为实现上述目的，本专利技术提供了如下方案：
[0008]一种基于pure pursuit算法的纵向速度调整策略，包括:
[0009]步骤S1、确定智能汽车的转角角度turningAngle和当前车速currentV；
[0010]步骤S2、比较所述转角角度turningAngle与预设阈值的大小；当所述转角角度turningAngle小于该阈值，则保持智能汽车的当前速度currentV，当所述转角角度turningAngle不小于该阈值，则调整智能汽车的加速度speedAcceleration，使其达到最终速度targetV_out。
[0011]优选的，所述步骤S1中，通过Pure Pursuit算法得到智能汽车的转角角度turningAngle，通过行车传感器读取当前车速currentV。
[0012]优选的，所述步骤S2中，所述预设阈值为10
°-
12
°
。
[0013]优选的，所述“调整智能汽车的加速度”的具体步骤包括，
[0014]将智能汽车的当前车速currentV设置为PID控制器的智能汽车输入速度targetV_in；
[0015]按以下公式设置PID控制器的智能汽车输出速度targetV_out，
[0016]targetV_out＝targetV_in*(K/turningAngle)，其中K是比例系数，(K/turningAngle)的取值范围是(0，1)；
[0017]将targetV_out和targetV_in作为所述PID控制器的输入值，加速度speedAcceleration作为所述PID控制器的输出值，通过调节所述PID控制器的参数控制智能汽车的纵向速度。
[0018]本专利技术的有益效果主要体现在：在pure pursuit算法思想的基础上同时实现纵向速度的控制，使得路径跟踪的精度更高；提出了一种新的纵向速度控制策略，根据转弯的大小自动、实时改变加速度的大小，从而自动调节运动速度的大小。
附图说明
[0019]为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
[0020]图1为本专利技术智能汽车的纵向速度控制方法的流程示意图。
具体实施方式
[0021]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0022]为使本专利技术的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本专利技术作进一步详细的说明。
[0023]智能汽车在直线行驶的时候，速度较大；在转弯的时候，速度会变慢，而且是转角越大，速度也需要越慢，从而实现在转弯的时候也时候实现精确的路径跟踪，且可以保证运动的平稳性。
[0024]本专利技术基于上述的思想，揭示了一种基于pure pursuit算法的纵向速度调整策略，如图1所示，包括如下步骤：
[0025]步骤S1、确定智能汽车的转角角度turningAngle和当前车速currentV；
[0026]步骤S2、比较所述转角角度turningAngle与预设阈值的大小；当所述转角角度turningAngle小于该阈值，则保持智能汽车的当前速度currentV，当所述转角角度turningAngle不小于该阈值，则调整智能汽车的加速度speedAcceleration，使其达到最终速度targetV_out。
[0027]所述步骤S1中，通过Pure Pursuit算法得到智能汽车的转角角度turningAngle，
通过行车传感器读取当前车速currentV。这些都是现有技术，在此不再赘述。
[0028]步骤S2是本专利技术的关键，首先会设置一个阈值，一般为10
°-
12
°
。根据实际实用以及测试情况发现，汽车直线行驶时，转角的大小都在12
°
以内，在转弯不大的拐角，驾驶者也不希望车子减速，完全可以按照设定的目标速度(即当前速度)前进；而当转角较大时，希望速度可以降下来，这样是为了乘坐的舒适。
[0029]所述“调整智能汽车的加速度”的具体步骤包括，
[0030]将智能汽车的当前车速currentV设置为PID控制器的智能汽车输入速度targetV_in；
[0031]按以下公式设置PID控制器的智能汽车输出速度targetV_out，
[0032]targetV_out＝targetV_in*(K/turningAngle)，其中K是比例系数，根据车子自身车本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于pure pursuit算法的纵向速度调整策略，其特征在于，包括:步骤S1、确定智能汽车的转角角度turningAngle和当前车速currentV；步骤S2、比较所述转角角度turningAngle与预设阈值的大小；当所述转角角度turningAngle小于该阈值，则保持智能汽车的当前速度currentV，当所述转角角度turningAngle不小于该阈值，则调整智能汽车的加速度speedAcceleration，使其达到最终速度targetV_out。2.根据权利要求1所述的方法，其特征在于，所述步骤S1中，通过Pure Pursuit算法得到智能汽车的转角角度turningAngle，通过行车传感器读取当前车速currentV。3.根据权利要求1所述的方法，其特征在于，所述步骤S2...

【专利技术属性】
技术研发人员：贾士伟，孙忠潇，
申请(专利权)人：泰牛汽车技术苏州有限公司，
类型：发明
国别省市：