一种基于模型预测的动态避障控制方法技术

本发明专利技术提供了一种包括两层的无人车避障控制方法。首先，通过雷达，摄像头等获取动态障碍物的速度，位姿等信息。获得信息后将其输入第一层，也就是模型预测层，通过给出的车速和航向角作为模型输入参数，基于模型预测理论对障碍物进行判断甄别，判断是否会进入可能碰撞域。若判断会进入可能碰撞域，则将其输入第二层，第二层为改进的人工势场法，通过改进，解决了经典的人工势场法存在的会陷入局部最优问题。本发明专利技术利用模型预测的理论，对无人车和障碍物分别建模，并划分出可能碰撞域，对整个动态避障过程进行两层识别判断，可以大大减小整个避障过程的计算量。此外，对人工势场法进行改进优化，大大提高无人车避障规划的安全性和可靠性。

【技术实现步骤摘要】
一种基于模型预测的动态避障控制方法
本专利技术涉及无人车避障领域，尤其关于局部路径规划下的无人车动态避障领域
技术介绍
伴随着计算机技术和5G技术的发展，无人驾驶技术的发展也是突飞猛进。无人驾驶技术简单来说，分为三个模块，第一个是感知模块，依靠雷达，摄像头等传感器获取周围环境的信息；第二个模块是规划模块，依靠制定好的算法对之前采集到的环境信息进行处理，做出判断，第三个模块是决策模块，基于规划模块的计算做出判断，制定无人驾驶行为。新的技术的出现同样也会存在许多问题，对于当前无人驾驶避障这一方面，常用的算法包括A*算法、蚁群算法、人工势场法、RRT算法等，其中A*和蚁群算法主要应用于全局路径规划，在局部路径规划方面，RRT和人工势场法应用的更加广泛一些。当前避障规划存在的问题主要是识别速度不够快和准确性不够高的问题，各自对应于RRT算法和人工势场法。当输入的数据维数增加，RRT收敛速度将会大大下降。同样，人工势场法也存在会陷入局部最优而无法继续下去的问题。
技术实现思路
本专利技术的目的在于提供一种基于模型预测的动态避障控制方法，能够提高动态避障过程中的速度和准确性。为实现上述专利技术目的，本专利技术采取的技术方案为：一种基于模型预测的动态避障控制方法，其特征在于，包括如下步骤：S1：由传感器获取目标障碍物的信息，通过AIS范围理论和避免的反应需求设置可能碰撞域；S2：传感器将适时获取的目标障碍物信息输入到模型预测层，模型预测层对输入信息进行计算，判断动态障碍物是否会进入预先设定的可能碰撞域；S3：若判断不会进入可能碰撞域，则认为动态障碍物不会对无人车造成障碍，无需启动第二层避障，避障模式结束；S4：若判定障碍物将进入可能碰撞域，则启用第二层避障，启用改进的人工势场法进行避障。上述方案中，S1中，传感器获取目标障碍物的信息包括车速，转角，障碍物距离。上述方案中，S2中，以无人车的质心R为坐标系中心建模，模型预测层的推到公式为：sin(α-β)*V0＝-ΔVsinΨ(1)VR-V0cos(α-β)＝ΔVcosΨ(2)VR2+V02-2V0VRcos(α-β)＝ΔV2(3)VRsin(β-α)＝ΔVsinη(4)V0-VRcos(α-β)＝ΔVcosη(5)其中，VR代表的是无人车车速，α表示无人车航向角。V0和β分别代表障碍物的车速和航向角。ΔV和Ψ代表速度差和速度差相对应的角度。φ代表ΔV和VR之间的夹角，η表示ΔV和V0之间的夹角；计算出差速度ΔV与OR质心连线的角度γ：通过γ角来判断动态障碍物是否会驶入可能碰撞域。上述方案中，S2中，引入一个判断角度系数其中，R为小车质心，T1，T2则是以经过质心R做经过障碍物O边界的切线所形成的两个切点；当γ＜μ，障碍物将会驶入可能碰撞域；相反，若γ＞μ，障碍物不会驶入可能碰撞域。上述方案中，S4中，改进的人工势场法避障过程为：将无人车置身于一个人造的势力场中，在这个势力场中，无人车会受到三种力，一个是目标点给它的吸引力，记作F1，另一个是障碍物给他带来的斥力，记作F2，势力场给无人车提供一个切向力，记作F3，F1＝ωρ(q，qg)(9)F3＝kcenX(12)其中ω为正比例增益函数，ρ(q，qg)是一个矢量，表示的是车的位置q和目标点位置qg之间的距离，在斥力场函数中，k表示的正比例系数，与引力场不同，这里设置了一个边界值ρ0，也即障碍物对汽车产生作用的最大范围；同理，ρ(q，q0)表示的是车的位置和障碍物之间的距离；kcen为切向力势场正比例系数，X为小车和障碍物的距离；无人车运动时所受到的运动合力为：Fall＝F1+F2+F3(13)。本专利技术的有益效果：通过第一层的模型预测，减少了不必要的计算量，大大提高了识别速度。通过第二层的改进算法，提高了识别的准确性，在一定程度上解决了人工势场法陷入局部最优解而无法继续下去的问题。附图说明图1为整个避障策略的流程图。图2为第一层，也就是模型预测层的分析模型。图3为改进的人工势场法的理论模型。具体实施过程首先结合图1对设计策略进行阐述。初始化模型，由传感器检测出障碍物的速度，航向角等信息，并输入预测模型。预测模型通过给定的数据，对障碍物和无人车模型进行计算，判断障碍物是否会进入预先由AIS范围理论和避免的反应需求所设定的可能碰撞域。若判断障碍物不会进入可能碰撞域，则认定无人车和障碍物之间相对安全，不需要进行避障，直接跳过第二层，避障过程结束。若模型预测判定障碍物将会进入可能碰撞域，则判定障碍物可能会与无人车发生碰撞，需启动第二层避障模块。第二层避障模块通过改进的人工势场法模型算法对障碍物进行避障，在模型中增加了一个障碍物与无人车之间的切向力，一方面切向力可以帮助无人车进行转向处理，帮助无人车加速驶离障碍物，同时，在添加了切向力的同时，避免了无人车陷入局部最优解而无法继续下去的窘境。通过两层避障模块的组合，一方面大大减少了运算量，使得避障规划速度大大提升，有效提升了避障方法的安全性，此外，通过改进的人工势场法，提高了避障模式的准确性，并在一定程度上解决了人工势场法会陷入局部最优解而使得整个模型不能继续运行下去的问题。接下来结合图2对预测模型进行阐述。如图2所示，R表示的是无人车的质心，并以其为坐标系中心建模，基于VRV0ΔV形成的速度矢量三角形并结合各自角度对数学模型做出如下推导：sin(α-β)*V0＝-ΔVsinΨ(1)VR-V0cos(α-β)＝ΔVcosΨ(2)VR2+V02-2V0VRcos(α-β)＝ΔV2(3)VRsin(β-α)＝ΔVsinη(4)V0-VRcos(α-β)＝ΔVcosη(5)其中，VR代表的是无人车车速，α表示无人车航向角。V0和β分别代表障碍物的车速和航向角。ΔV和Ψ代表速度差和速度差相对应的角度。φ代表ΔV和VR之间的夹角，η表示ΔV和V0之间的夹角。从图2中不难看出γ相当于两个航向角的差再减去一个θ角，于是可以进一步对γ做出推导如下：用γ代表RO射线和ΔV之间的夹角，θ代表的是RO射线和坐标轴x的夹角，而VR代表的是无人车车速，α表示无人车航向角，V0和β分别代表障碍物的车速和航向角，前文已阐述过。如图2所示，如果速度向量Δv在两根射线RT1和RT2之间，则判定障碍物将会驶入可能碰撞域，对无人车产生威胁，需要启用下一步的避障策略。为了方便阐述说明，这里我们定义一个角度判断系数μ概念，其中，R为小车质心，T1，T2则是以经过质心R做经过障碍物O边界的切线所形成的两个切点。通过上述推导，我们只需要对γ进行计算比较就可以判断障碍物是否会驶入可能碰撞域。也即当γ＜μ时，障碍物将会驶入可能碰撞域，此时需要启用第二层避障策略；相反，若γ＞μ时，障碍物不会驶入可能碰本文档来自技高网...

【技术保护点】
1.一种基于模型预测的动态避障控制方法，其特征在于，包括如下步骤：/nS1：由传感器获取目标障碍物的信息，通过AIS范围理论和驾驶员反应时间需求设置可能碰撞域；/nS2：传感器将适时获取的目标障碍物信息输入到模型预测层，模型预测层对输入信息进行计算，判断动态障碍物是否会进入预先设定的可能碰撞域；/nS3：若判断不会进入可能碰撞域，则认为动态障碍物不会对无人车造成障碍，无需启动第二层避障，避障模式结束；/nS4：若判定障碍物将进入可能碰撞域，则启用第二层避障，启用改进的人工势场法进行避障。/n

【技术特征摘要】
1.一种基于模型预测的动态避障控制方法，其特征在于，包括如下步骤：
S1：由传感器获取目标障碍物的信息，通过AIS范围理论和驾驶员反应时间需求设置可能碰撞域；
S2：传感器将适时获取的目标障碍物信息输入到模型预测层，模型预测层对输入信息进行计算，判断动态障碍物是否会进入预先设定的可能碰撞域；
S3：若判断不会进入可能碰撞域，则认为动态障碍物不会对无人车造成障碍，无需启动第二层避障，避障模式结束；
S4：若判定障碍物将进入可能碰撞域，则启用第二层避障，启用改进的人工势场法进行避障。


2.根据权利要求1所述的一种基于模型预测的动态避障控制方法，其特征在于，S1中，传感器获取目标障碍物的信息包括车速，转角，障碍物距离。


3.根据权利要求1所述的一种基于模型预测的动态避障控制方法，其特征在于，S2中，以无人车的质心R为坐标系中心建模，模型预测层的推到公式为：
sin(α-β)*V0＝-ΔVsinΨ(1)
VR-V0cos(α-β)＝ΔVcosΨ(2)
VR2+V02-2V0VRcos(α-β)＝ΔV2(3)
VRsin(β-α)＝ΔVsinη(4)
V0-VRcos(α-β))＝ΔVcosη(5)
其中，VR代表的是无人车车速，α表示无人车航向角。V0和β分别代表障碍物的车速和航向角。ΔV和Ψ代表速度差和速度差相对应的角度。φ代表ΔV和VR之间的夹角，η表...

【专利技术属性】
技术研发人员：刘文光，刘浩伟，孙圳，王志民，
申请(专利权)人：江苏大学，
类型：发明
国别省市：江苏;32