Information Science and Engineering

Unmanned vehicle path planning method assisted by UAV

  • Yanjun LU ,
  • Dongyu WANG ,
  • Xiaodong ZHANG ,
  • Chang LIU
Expand
  • College of Automation,Shenyang Aerospace University,Shenyang 110136,China

Received date: 2024-12-16

  Revised date: 2025-04-16

  Accepted date: 2025-04-17

  Online published: 2026-03-12

Abstract

In view of the problem of path planning caused by unknown environment when unmanned vehicle performs tasks in complex rescue environment, a dynamic path planning method was proposed for unmanned vehicle assisted by UAV. Firstly, UAV aerial images and SURF algorithm were used to assemble the aerial images to build the complete map information.Then the color space conversion and morphological processing were performed to identify the obstacle information.Finally, the improved artificial potential field method was applied to conduct the unmanned vehicle path planning, and the dynamic gain factor and influence function method were proposed to redesign the potential field function to solve the target inaccessible problem; meanwhile, A* algorithm was proposed to solve the local minimum problem of the artificial potential field method. The results show that the UAV-assisted unmanned vehicle path planning method is feasible and efficient, which improves the performance of unmanned vehicle path planning in complex rescue environment.

Cite this article

Yanjun LU , Dongyu WANG , Xiaodong ZHANG , Chang LIU . Unmanned vehicle path planning method assisted by UAV[J]. Journal of Shenyang Aerospace University, 2026 , 43(1) : 56 -62 . DOI: 10.3969/j.issn.2095-1248.2026.01.008

空地协同能够充分利用无人机与无人车功能互补的优势,在军事和民用领域得到了广泛应用,如险区作战、敌情侦察、灾害救援等。其中,无人车依赖无人机提供的环境信息进行导航和路径规划,以顺利执行如救援等任务是该领域的一个研究热点。
Peterson等1针对在未知环境下实现地面车辆的自主行驶问题,研究开发了一个采用无人机和地面车辆组成的协同作业系统。其中,空中无人机负责图像信息采集和图像处理,为地面车辆规划出一条考虑到地形因素的最优路径。Mohammadreza等2针对突发野火状况,提出了一种基于时空估计的空地协同轨迹规划问题的偏微分方程解决方案,利用UAV上的摄像头获得的本地数据估计和预测野火的传播趋势,为UGV获取一条从初始位置行驶到最终位置的安全路径;同时,规划UAV的路径以收集有关野火的信息。王修远等3针对野外应急救援活动中无具体道路的问题,提出了一种基于格网单元的改进A*算法,无人机为地面终端提供行进路径周边环境的影像,地面终端快速提取影像中地表类型及地形起伏等特征信息,为车辆规划出通往救援目标点的导航路径。王晨捷等4提出了一种基于无人机视觉SLAM的协同建图与导航方法,利用无人机空中视角带来的大范围环境感知能力,协助地面机器人快速构建环境模型,地面机器人根据无人机获得的初始全局地图自动规划全局路径。地面机器人在移动过程中,利用搭载的激光雷达对无人机构建的初始全局地图进行更新,并对路径进行连续重新规划,避免与障碍物发生碰撞。以上各种方法都有具体适合的应用场景。
本文以灾情救援为背景,针对无人机辅助下的救援无人车路径规划问题,提出基于无人机航拍图像识别环境障碍,动态规划无人车有效行驶路径的方法。

1 无人机航拍图像处理

在灾害救援情况下,无人机与无人车协同系统以其卓越的性能,展现了在人类难以直接介入的复杂环境和危险场景中的应对能力。无人机搭载的垂直摄像头捕捉现场的详细图像,随后通过图像处理技术,对环境中的潜在障碍进行精确识别,为无人车划定一个明确的区域。无人车根据无人机提供的信息采集区域实现车辆路径规划。地面站则作为无人机与无人车的指挥中心,提供出发点和目标点的精确坐标,确保整个救援行动的有序进行。协同系统场景如图1所示。
图1 协同系统场景

1.1 基于SURF算法的图像拼接

由于受到飞行高度、相机焦距及视角等因素的约束,单幅无人机图像通常视野有限,只能反映待观测区域的局部信息。为了满足全局感知的需求,利用图像拼接技术将无人机从多个角度对目标地区拍摄到的局部子图像拼接成一幅大视野全景图像5。常见的图像拼接算法包括基于方向的FAST特征点检测和旋转BRIEF描述符(oriented FAST and rotated BRIE,ORB)算法、尺度不变特征变换(scale-invariant feature transform,SIFT)算法及加速稳健特征(speeded-up robust features,SURF)算法等。在选择图像拼接算法时,需要综合考虑算法的鲁棒性、快速性、计算复杂度及特征匹配的准确性。为此,本文选择SURF算法作为无人机航拍图像的拼接算法6。图像拼接结果如图2所示,实验结果可用于后续UGV的路径规划。
图2 图像拼接结果

1.2 基于灰度化的图像预处理

航拍图像的效果会受到噪声、污染和其他各种潜在因素的影响7,图像预处理能够有效降低这些因素对障碍物识别准确性的负面影响。图像灰度化是一种常见的图像预处理方法8,可以在视觉上增加对比,突出目标区域。常见的灰度化处理方法有:最大值法、平均值法和加权平均法。本文采用加权平均RGB 3个颜色通道的亮度值来实现灰度化,对航拍图像灰度化处理后的结果如图3所示。
图3 航拍图像灰度化处理结果

1.3 基于HSV色彩空间的障碍物识别

在RGB色彩空间中,光照变化会影响所有3个颜色通道(红色、绿色和蓝色)。当图像的光照条件改变(例如从日光到阴影)时,所有的RGB值都可能改变,会影响颜色检测的准确度。在色相-饱和度-明度(hue-saturation-value,HSV)色彩空间中,光照变化主要影响“值”(亮度)通道,而对“色调”和“饱和度”通道的影响较小。当光照条件改变,颜色的HSV值也会保持相对稳定。因此,通过在HSV色彩空间中工作,可以更容易地处理光照变化9。HSV空间下障碍物的图像二值化如图4所示。
图4 HSV空间下障碍物的图像二值化
根据图像分割技术与数字形态学处理,上述图像可转换为UGV可执行的地图。UGV地图信息如图5所示。

2 基于改进人工势场法的UGV路径规划

在路径规划领域,人工势场法因其较高的计算效率和广泛的适用性得以广泛应用10
该方法能够利用环境信息的拼接结果,快速地为地面无人车规划出行进路径,但人工势场法在实际应用中展现出以下两个问题:
1)目标不可到达问题:当无人车到达目标点附近,由于其周围存在的障碍物产生的斥力大于引力,使得无人车在目标点附近徘徊,不能到达目标点。
2)局部极小值问题:当无人车在某个点出现合斥力与合引力大小相等、方向相反的情况,导致无人车停在原地。
传统人工势场法仅考虑无人车与目标点、障碍物间的距离,适用于静态路径规划。对于动态障碍物,因传统人工势场法实时性差而难以生成平滑路径。

2.1 改进的人工势场法

针对人工势场法中的目标不可到达问题,引入动态增益因子和影响函数,对势场函数进行了重新设计,优化路径并确保顺利到达目标点。针对局部极小值问题,提出融入A*算法为人工势场法提供子目标点的方法,增强目标的可达性。

2.1.1 引力场函数设计

二维空间中,对于无人车在任意一点 X c = [ x c , y c ],传统人工势场法通过在空间中目标点 X g = [ x g , y g ]建立引力势场,在各个障碍物 X o = [ x o , y o ]处建立斥力势场。传统人工势场法决定目标点引力大小的因素是无人车与目标点的距离11,引力随着距离的增大而增大12。当无人车处于起始位置时距离最远,此时引力也最大,而过大的引力会导致无人车忽略障碍物斥力的作用造成碰撞。为解决这一问题,在引力函数中增加动态增益因子 η
改进后的引力函数如式(1)所示。
F a t t ( X ) = - g r a d U a t t ( X ) = - η ( x c - x g )
式中: η为引力的动态增益因子,表达方式为 η = W 1 + e RW为常数,取值范围为(1,2);R为当前点到目标点的欧式距离,其中 1 1 + e R为Sigmoid函数的一种特定形式。

2.1.2 斥力场函数设计

传统人工势场法在无人车进入障碍物的影响范围时,斥力随着距离的减小而增大13,当距离趋近于0时,斥力趋于无穷大;当无人车到达障碍物附近时,会导致斥力过大,引起系统不稳定与路径抖动问题,可以通过设计新的斥力势场函数来解决这一问题。
在原斥力势场函数中添加的关于当前点到目标点的影响函数为
f ( R ) = 1 - e - R 1 + e - R
改进后的斥力函数为
F r e p X = F r e p 1 + F r e p 2 , ρ c ρ 0 0                  ,       ρ c > ρ 0
式中: F r e q 1为斥力分量,方向由障碍物指向无人车。
F r e p 1 = K r e p 1 ρ c - 1 ρ 0 2 1 ρ c 2 f ( R )
式中: F r e q 2为引力分量,方向由无人车指向目标点。
F r e p 2 = K r e p 1 ρ c - 1 ρ 0 2 f ( R ) R X
影响函数与当前点到目标点之间的距离成正比,当无人车移动到障碍物影响范围时,影响函数在斥力函数的作用下,会使斥力呈指数形式减小,当无人车到达目标点时斥力为0,其在引力与 F r e q 2的共同作用下向目标点移动,从而解决目标不可到达问题。

2.2 融合A*算法解决局部极小值问题

针对局部极小值问题,提出采用人工势场法与A*算法相结合的方法。A*算法进行全局路径规划后获得全局静态路径14,然后提取全局静态路径中的关键点并将其设为全局子目标点,最后根据所设置的全局子目标点,通过改进的人工势场法进行局部路径规划,直至到达全局目标点,算法步骤如下:
步骤1 初始化A*算法中的开放列表、关闭列表,以及人工势场法中的引力场增益系数、斥力场增益系数、步长等参数。
步骤2 在寻径地图上,通过起始点和目标点构建路径规划区域,在路径规划区域内从起始点开始生成其8个方向的子节点,判断每个子节点是否在规划区域内且没有被探索过,将有效子节点加入到开放列表中,计算开放列表中每个节点的g(从起点到该节点的实际代价)、h(启发式估计代价)和f(总代价)。从开放列表中选择f值最小的节点作为父节点,生成其8个子节点并更新开放列表,将父节点移动到关闭列表,同时删除已经被探索过的冗余节点。重复以上步骤直到找到目标节点。
步骤3 保存A*算法规划出的路径,将转折点设置为子目标点,利用改进的人工势场法进行局部路径规划。检测当前子目标点是否为全局目标点,如果是则输出路径并结束,否则将当前子目标点作为起点移动到下一目标点,重复此步骤,直到找到全局目标点。

3 仿真与分析

本文基于MATLAB建立无突发移动障碍、有突发移动障碍两种仿真环境,并进行仿真实验。

3.1 仿真参数设定

本文的仿真环境设置在25×25的二维空间区域,无人车所在的起始点为[1,2],目标点为[19,20]。引力系数 K a t t为6,斥力系数 K r e p为16,障碍影响距离为2 m,移动障碍物速度为0.5 m/s。

3.2 仿真结果与分析

3.2.1 无突发移动障碍环境下仿真验证

无突发移动障碍环境下,利用传统人工势场法、文献[15]的改进方法和本文的改进人工势场法对目标不可到达问题进行对比仿真,结果如图6所示,其中文献[15]针对目标不可达问题在原斥力场函数中引入目标点与无人车之间的距离作为修正系数。
图6 无突发移动障碍环境下仿真结果
图6a为传统人工势场法在无突发移动障碍环境下的仿真结果,其在目标点附近静止不动,无法前进,不能生成完整路径。
图6b为文献[15]的改进方法在无突发移动障碍环境中的仿真结果。文献[15]中仅针对斥力函数进行改进,并没有改进引力函数。通过仿真结果可知,无人车虽然可以顺利到达目标点,但在路径规划前期受到的引力过大,出现了弯曲较大的路径。
图6c为本文的改进人工势场法在无突发移动障碍环境中的仿真结果。改进后的路径相对平滑,在前期并没有产生弯曲路径,能够规划出一条完整的路径。通过对仿真生成的数据对比,传统的人工势场算法生成的路径并不能抵达目标点;利用文献[15]中的算法规划的路径虽然可以顺利达到目标点,但是规划的路径并不平顺,其路径迭代次数较多,规划的路径较长。相比前两种算法,在迭代次数均为200次的情况下,文献[15]的人工势场法平均路径长度为29.43 m,改进后人工势场法平均路径长度为25.70 m,本文算法规划出的路径相对平滑且路径长度比文献[15]改进方法减少了12.7%。

3.2.2 有突发移动障碍环境下仿真验证

有突发移动障碍环境下,针对路径规划中常出现局部极小值点的问题,分别以传统人工势场算法和改进后人工势场算法作为仿真对象,进行仿真验证。有突发移动障碍环境下仿真结果如图7所示。
图7 有突发移动障碍环境下仿真结果
图7a是以传统人工势场算法作为路径规划算法进行仿真的结果。从图7a可知,在无人车陷入局部极小值点时,无法跳出局部极小值点,最终无法规划出完整路径。
7b和7c是在有突发移动障碍环境下改进的人工势场法的仿真的结果。结果表明,在原有的前进路径上出现移动障碍物后,改进的人工势场法能够及时规划新路径,具有实时性,改进后的路径相对平滑,且遇到局部极小值问题,改进后的人工势场法能够根据A*算法提供的子目标点跳出局部极小值点,顺利规划出一条完整的路径。

4 结论

针对无人机辅助的无人车路径规划问题,提出了一种基于环境信息的动态规划无人车有效行驶路径的方法。通过无人机搭载摄像头进行环境信息的采集,为无人车的路径规划提供环境数据。通过图像拼接算法对多幅图像进行融合,生成全局环境地图,利用色彩空间转换、图像分割和形态学处理技术,实现对地面障碍物的识别。在此基础上,针对传统人工势场法存在的问题,提出了相应的改进策略:通过在势场函数中引入影响函数与动态增益因子,确保无人车在目标点处达到受力平衡,增强了算法的目标可到达性;同时,将优化的A*算法与人工势场法相结合,利用优化A*算法提供的子目标点引导机制,有效增强了算法的局部极小值逃离能力。仿真实验结果表明,改进后的人工势场法不仅能够规避突发障碍物,而且生成的路径具有平滑度高、可行性强的特点,充分证明了该算法在突发障碍物环境下的适用性和优越性。
[1]
Peterson J Chaudhry H Abdelatty K,et al.Online aerial terrain mapping for ground robot navigation[J].Sensors201818(2):630.

[2]
Mohammadreza R Balaji S Manish K,et al.PDE solution to UAV/UGV trajectory planning problem by spatio-temporal estimation during wildfires[J].Chinese Journal of Aeronautics202134(5):601-616.

[3]
王修远,孙敏,李修贤,等.Grid A*:面向野外空地协同应急处置的快速路径规划[J].遥感学报202428(3):767-780.

[4]
王晨捷,罗斌,李成源,等.无人机视觉SLAM协同建图与导航[J].测绘学报202049(6):767-776.

[5]
魏友华,何雪梅,徐霞,等.一种自适应图像预处理方法研究与应用[J].现代电子技术202245(7):53-57.

[6]
王冰雪,刘广文,刘美,等.轮廓波域内局部对比度增强的彩色图像灰度化算法[J].液晶与显示202035(2):151-160.

[7]
潘维东,李安虎,刘兴盛.基于区域优化的图像拼接技术研究及应用进展[J].激光与光电子学进展202461(18):1-20.

[8]
姬谕,丁朋,刘楠,等.基于改进SURF的低照度图像拼接方法[J].激光与光电子学进展202461(18):449-459.

[9]
赵晓宇,陈建军,张凯琪,等.基于HSV色彩空间和Otsu算法的无人机影像植被覆盖度自动提取[J].科学技术与工程202121(35):15160-15166.

[10]
Tao F Z Ding Z W Fu Z G,et al.Efficient path planning for autonomous vehicles based on RRT* with variable probability strategy and artificial potential field approach[J].Scientific Reports202414(1):24698.

[11]
Zhang X M Chen L Dong W A,et al.Optimizing redundant robot kinematics and motion planning via advanced D-H analysis and enhanced artificial potential fields[J].Electronics202413(16):3304.

[12]
Luan T T Tan Z G You B,et al.Path planning of unmanned surface vehicle based on artificial potential field approach considering virtual target points[J].Transactions of the Institute of Measurement and Control202446(6):1190-1202.

[13]
Chang Z Y Zhang Z W Deng Q,et al.Route planning of intelligent bridge cranes based on an improved artificial potential field method[J].Journal of Intelligent & Fuzzy Systems202141(3):4369-4376.

[14]
Wang Y C Fu C H Huang R Y,et al.Path planning for mobile robots in greenhouse orchards based on improved A* and fuzzy DWA algorithms[J].Computers and Electronics in Agriculture2024227:109598.

[15]
吴琪,孟婥,李硕,等.基于改进人工势场法的机织机器人避障路径规划[J].东华大学学报(自然科学版)202450(2):113-120.

Outlines

/