随着计算机技术、通信技术和人工智能技术的发展与应用,越来越多的研究所、院校以及企业等机构开始研究并投入使用无人运载器[1]。无人运载器主要包括无人车、无人机、水面无人艇以及无人潜航器等[2]。由于能够高效率地完成危险艰巨的任务,无人运载器有着广泛的应用领域。例如,无人车(UGV)常被用于地震救援、考古研究、智能农业以及物流配送等领域[3];无人机(UAV)则常被用于农业、航空拍摄、灾难救援、电力巡检以及军事打击等领域[4]。近年来,海洋资源的进一步开发和海上作战的需求促进了水面无人艇(USV)和无人潜航器(UUV)等海上无人装备的研发进度,同时也开拓了海上无人装备的应用领域,如海洋科考探测、海洋环境检测、海事搜救、水下地形勘测、海上牧场、海上运输补给、气象探测以及军事作战等[5-8]。21世纪,我国提倡共同建设“海上丝绸之路”,并多次强调海洋强国建设在经济发展和中国特色社会主义事业建设中的重要作用。因此,作为海上无人装备中的一种,USV在未来海洋建设中必将发挥重要作用。
USV作为一个复杂系统,其中包含众多子系统,如感知系统、载荷系统、控制系统、动力系统以及舾装系统等[9],如图1所示。各子系统相互配合,使USV能够在复杂的海洋环境中实现自主航行。对于无人系统而言,自主航行能力是衡量无人艇智能化水平高低的一项重要指标。“自主”意味着USV在不依靠任何人工控制手段的情况下,能够根据航行规则顺利完成任务。在整个过程中,根据航行环境与任务目标规划一条安全可靠的路径是USV必须具备的一项功能模块,即路径规划模块。
路径规划起源于早期的陆地机器人[10],给路径规划模块输入起始位置、目标位置以及障碍物信息,为机器人输出一条可行路径。路径规划是一个优化问题,最明显的优化标准是距离[11],即为机器人找到一条避开所有障碍物到达终点的最短路径。传统路径规划方法是将机器人视为一个质点,这对于UGV和UAV或许可行。对于UGV而言,由于地理环境相对固定,且其具备紧急制动能力,所以其运动状态可控;UAV在航行中会受到风等环境因素的干扰,但空中不存在复杂障碍物,在遇到紧急情况时,UAV可悬停在空中。但对于USV而言,传统路径规划方法存在一定不足。一方面,由于水域环境复杂,USV会受到风、浪、流、水粘性力和惯性力等外界因素的干扰,即使USV不做任何操作,也无法稳定维持在某一位置上。另一方面,大多数USV是欠驱动的,无法在有限的空间范围内实现大角度转向操纵。因此,USV的路径规划过程应考虑其实时的运动状态以及操纵能力边界。这便将路径规划问题由简单的路线规划上升为运动规划。运动规划过程考虑了USV的所有动力学和运动学约束[12],所以规划的路径符合USV的航行特点,更有利于航行控制。随着无人技术的发展,无人艇路径规划研究逐渐朝向精细化的运动规划发展。
路径规划是在某空间背景下,为USV规划一条连续并符合规划要求的路径。根据发展阶段,将路径规划问题分为路线规划、轨迹规划和运动规划3类[13]。路线规划是路径规划的初级阶段,该阶段将USV视为一个质点,不考虑任何运动学和动力学特性,通常适用于大尺度区域的路径规划[14]。例如,USV从大连港到上海港的路径规划,该路径无需考虑形状、速度等运动细节,如图2(a)所示。轨迹规划是路线规划的优化阶段,对路线规划的结果进行优化,主要优化指标包括航向角、曲率和速度等,通常适用于中等尺度区域的路径规划[15]。例如,USV到达港口附近时,需考虑如何进入内部端口,此时需考虑一些运动学约束,如USV尺寸、航行速度以及回转半径等。运动规划是路径规划的高级阶段,除了考虑运动学特性外,还需考虑动力学特性,如USV在六自由度上受到的力和力矩等,适用于小尺度区域内的精细路径规划[16]。例如,USV在梳形路线巡航时,需知道如何完成直角转弯,如图2(b)所示。在此阶段,将USV视为刚体,充分考虑运动过程中受到的所有约束以及实时运动状态变化,期望的规划结果是找到一条真实可控的路径。因此,本文以路径规划的3个发展阶段为脉络,详细介绍各阶段的规划方法以及研究与应用现状。
在路线规划研究中,一般将规划对象视为一个质点,忽略运动学和动力学对规划效果的影响,如百度地图为用户规划的行走路径、扫地机器人的路径规划以及游戏中角色的移动路线等。路线规划的相关研究相对较早,目前,已有许多经典搜索算法成熟应用于无人艇的路线规划中。根据算法特点分为传统路径规划算法、基于采样路径规划算法和智能仿生算法等。
1.1 传统路径规划算法Dijkstra算法、A*算法、人工势场法等都属于传统路径规划算法类型。其中最为经典的是Dijkstra算法,该算法是Edsger Wybe Dijkstra在1956年提出的一种用来寻找最短路径的算法,主体思想是贪心思想[17],即以起始点为中心向外层层扩展,每次扩展选择移动代价最小的节点作为下一节点,直到到达终点,搜索过程如图3(a)所示。Dijkstra算法找到的路径一定是最优路径,但该方法扩展节点多,搜索效率低,导致在实际应用中存在诸多不足。1968年,斯坦福研究院的Peter Hart基于Dijkstra算法提出了A*算法[18],在路径代价函数中增加了启发项来使搜索方向逐步靠近目标点,A*算法的规划效果如图3(b)所示。A*算法不仅继承了Dijkstra算法的优点,还减少了扩展节点的数量,节约了搜索空间,提高了搜索效率。
人工势场法是由Khatib于1985年提出的一种基于虚拟力场的路径规划算法,该算法的基本思想是当机器人在环境中运动时,将环境设置为人造势场,目标点对机器人产生引力,障碍物对机器人产生斥力,引力和斥力的合力控制着机器人的运动方向[19]。该算法可以产生一条平滑安全的路径,但在距离目标点较远时,引力远大于斥力,可能导致机器人与障碍物发生碰撞。因此,人工势场法常被用于局部路径规划研究。
1.2 基于采样路径规划算法基于采样路径规划算法更具灵活性,即使是同一规划任务,规划结果也可能不相同。基于采样路径规划算法的2种典型算法是随机路线图算法(PRM)和快速搜索随机树算法(RRT)。PRM算法的主要思想是基于图搜索的算法,通过在规划空间中生成随机的状态点来判断空间的可行区域位置,然后连接状态点找到可行路径[20],过程如图4所示。该算法适用于高维空间,常被用于无人机领域。这是因为无人机的路线规划是在三维空间进行的,PRM算法不仅可以快速高效地搜索最优路径,还可以解决无人机多任务分配问题。RRT算法通过对状态空间中的采样点进行碰撞检测,避免了对空间的建模,有效解决高维空间和复杂约束的路径规划问题[21]。该算法以初始点作为根节点,通过随机采样增加叶子节点的方式,生成一个随机扩展树,当目标点位于随机扩展树上时,停止增长,如图5(a)所示。但是,RRT算法的规划结果往往不是最优的,针对这一问题,提出RRT*算法,缩短了路径长度。该算法的规划结果如图5(b)所示。
Song等[22]针对传统A*算法生成的路径折角多并存在多余节点的弊端,提出一种改进A*算法,其改进的核心思想是通过去除冗余节点使路径趋于平滑。Li等[23]基于栅格法建立三维环境模型,使用Dijstktra和A*算法实现三维路径搜索,该方法得到了较短的搜索路径,更具高效性和实时性,但是该方法搜索过程计算量大。为克服这个缺陷,又设计一种多方向A*算法,通过减少搜索点来获取更优路径[24]。张玉奎[25]使用遗传算法为USV规划全局路径,进而使用人工势场法进行局部路径规划,2种方法的结合缩短了规划时间,与单独使用某一种算法相比,得到的路径长度更短。
2 轨迹优化轨迹规划是对路线规划结果的一种优化,规划目标是生成易于跟踪航行的路径。由于路线规划过程得到的路径是曲折的,对于USV来说,其运动过程中具有惯性,无法突然转变航向。因此,路径曲率连续问题是轨迹规划过程中需要重点解决的一个方面。
2.1 曲线优化方法常被采用的方法主要有Dubins算法[26]、样条曲线法[27]、Clothoid曲线[28]和费马螺线[29]等。Wang等[30]在无人艇的路径规划中,使用二次B样条曲线对路径点进行平滑处理,优化后的路径更适合USV的实际航行。刘乐柱等[31]使用Dubins算法为USV规划一条曲率连续的路径,该方法首先根据USV运动特性计算其转向能力,然后利用Dubins曲线与回转圈的切线拼接得到平滑路径。
2.2 动力学约束方法上述曲线拟合的方法需先获取路径点,再对点的连线进行优化。虽然满足了曲率的要求,但是对于USV来说,还有一种效果更好的改进方法,即在路径规划算法中加入运动学的约束。Szczerba等[32]提出稀疏A*算法,使用最大转弯角度和最大路径长度作为约束条件,缩短了搜索时间,同时避免了路径中大转弯角度的出现。Kim等[33]在二维路径规划算法的基础上引入曲率的约束,考虑动力学约束提出一个新的代价函数,虽然得到了更短的路径,但是改进之后还是包含较多的折线段,也未对路径进行平滑处理,所以得到的路径效果有待优化。Hanguen等[34]基于传统A*算法,在搜索过程中考虑航向角和首摇角速度的影响,实验表明,该算法在路径跟踪时间上优于三维A*算法。Lee等[35]考虑了航向角的影响,根据欠驱动船舶的运动特性,将搜索子节点根据无人艇的实时航向信息变为3个子节点,增加了搜索效率,同时删除了无人艇不能到达的节点。将船舶阻力和水深影响引入代价函数中,使无人艇航行过程的能耗降低。最后根据相邻路径点之间的可见性删除不必要路径点,同时考虑折线之间角度的大小,使算法效率提高。Wang等[36]提出一种基于动态约束的全局-局部混合路径规划方案,通过全局路径规划算法生成相当稀疏的路径点,从而得到全局最优路径,通过控制纵向、横向速度和加速度,实现局部避碰。航行区域的水深影响着无人艇的水动力性能,水深不足将会引起搁浅等危险状况,Liu等[37]通过分析无人艇的水动力模型,提出一种水深风险等级A*算法,在满足最短路径的同时考虑水深不足的危害,保证航行安全。传统A*算法在基于距离的代价函数作用下,导致生成的路径与障碍物距离较近,这不利于无人艇在具有复杂障碍物的水域上安全航行,Pc等[38]综合考虑碰撞风险和路径与障碍物之间的距离,提出新的代价函数。根据船舶自身最大速度的约束计算障碍物碰撞风险,实验表明,相比于传统A*算法,该方法生成的路径安全性更高,更适合限制水域的路径规划。
3 运动规划运动规划是路径规划的最终阶段,该过程求解的是无人艇具体要如何操作才能高效完成路径规划任务。因此,在运动规划阶段应综合考虑无人艇所有的运动学约束。这些约束可总结为轨迹约束、尺度约束、首向角约束。轨迹约束是指无人艇的操纵性能对运动规划过程产生的约束,即运动规划过程得到的轨迹必须满足曲率连续且符合无人艇最小回转半径的要求。根据无人艇的水动力性能可知,无人艇航行过程中的运动轨迹受到航速和舵角的影响。在一定航速下,转舵角度越大,回转圈越小;舵角不变时,航速越大,回转圈越小。如果想要无人艇始终稳定的按照规划的路径航行,就须考虑无人艇的实际操纵能力。
在运动规划研究中,要求无人艇能够精准识别自身运动状态,包括所处位置、速度以及首向角等。无人艇的首向角在一定程度上影响着其受到外界环境的干扰程度,同时也会影响跟踪期望路径的能力。由于大多数无人艇都是高度欠驱动型船舶,其运动轨迹受到自身操纵性能的约束,因此无人艇几乎不可能在有限的空间内完成大角度转向。运动规划需全面考虑USV的动力学和运动学约束,该方法可生成更加符合无人艇操纵性的全局路径。运动规划的研究是从无人车开始的,传统方法的一般步骤为:首先利用传统的路径规划方法,规划一条从起点到终点的无碰路径;然后基于路径设计一个包含运动学和动力学约束的控制器,以驱动机器人安全快速地到达目标[39]。目前,流行方法是利用无人艇的操纵运动数学模型改善传统算法,Na[40]、Mingbo[41]、Jinze[42]等将无人艇的非完整约束与快速探索随机树(RRT)法相结合,RRT算法的状态转换可通过运动学模型改进,新节点的生成可通过动力学方程施加约束。
Liu等[43]采用概率地图法,并根据无人艇操纵性能约束进行改进,对操舵响应非线性模型进行线性化处理,考虑舵角饱和约束限制。Gu等[44]根据水面无人艇的运动特性建立无人艇的运动单元库,解决了无人艇在限制水域中的运动规划问题。该方法同时满足无人艇的状态约束,机动特性约束和水深度约束。每个父节点拥有16个子节点,搜索精度更高,但计算量庞大,无人艇的运动状态不连续。Han等[45]提出一种预测轨迹的搜索算法,将由操纵模型生成的轨迹分解为栅格地图上的一系列的点,通过A*算法找到一条可行路径,在代价函数的启发项中引入了最大速度的影响,生成的轨迹可通过无人艇自身的操纵性能精准跟踪。但是,算法迭代次数多,更适用于短距离规划或离线规划。Du等[46-47]基于栅格地图,根据无人艇的运动数学模型来确定无人艇在不同舵角下的运动轨迹,建立轨迹单元;将由无人艇运动数学模型生成的轨迹作为路径规划的动态约束,在A*算法的代价函数中综合考虑了距离和转向的代价,可直接生成一条平滑的路径,但是该轨迹单元的栅格大小是固定的,限制了其应用情景。Willners等[48]在水面无人艇追踪水下潜航器的应用背景下,根据无人艇的运动学模型,确定船舶的可行空间,可行空间有若干个分支组成,每个分支又离散成若干点作为分支的之间状态进行碰撞检测,这种搜索方式的状态连续,但是计算量庞大,实时路径规划时反应迟钝。
4 结 语无人艇运动规划研究起步较晚,多数运动规划方法是基于传统路线规划算法,结合USV的动力学模型或优化曲线到达最终规划目标。近几年国内外学者萌生了新的研究思路,将USV的操纵性数学模型与栅格状态相结合,即将USV的运动状态离散到栅格中,然后通过搜索算法选择并连接状态栅格,得到最终路径,这便演化为图搜索问题。A*算法是一种常用的图形遍历法,其较好的性能和准确度,对环境反映迅速,搜索效率高。在合适的代价函数的作用下,其找到的路径为最优路径,且A*算法与栅格模型结合的搜索效果较优,适合用于运动规划研究。
水面无人艇的运动过程复杂,路线规划和轨迹规划得到的路径并不利于航行控制模块对轨迹进行精准跟踪。针对这一突出问题,设计基于无人艇操纵性数学模型的运动规划方法成为一种趋势。基于USV操纵性数学模型,在搜索过程中考虑USV运动时产生的所有约束,改变搜索空间的构成。由于搜索空间的改变,导致A*算法中的避障方式无法适用于运动规划,因此,需要设定基础性避障和预测性避障2种避障规则;对代价函数进行改进,加入航向角改变代价,并将距离代价转换为相应的时间代价,更能反映实际航行代价。为了使规划的路径更加符合无人艇的操纵运动特性,使用无人艇的操纵运动模型进行轨迹预测,实现对路径点进行平滑处理,使平滑路径的运动状态连续,更利于无人艇控制系统的跟踪。另外,针对不同尺度的地图模型和不同的任务背景,应分析栅格尺度对运动规划效果的影响。
[1] |
周志华. 机器学习[M]. 北京: 清华出版社, 2016.
|
[2] |
FARLEY K A, WILLIFORD K H, STACK K M, et al. Mars 2020 mission overview[J]. Space Science Reviews, 2020, 216(8): 1-41. |
[3] |
BUEHLER M, IAGNEMMA K, SINGH S, et al. The DARPA urban challenge: autonomous vehicles in city traffic[M]. Berlin: Springer, 2009.
|
[4] |
GEORGE Y, DANIEL J P, et al. Ground target detection using cooperative unmanned aerial systems[M]. Kluwer Academic Publishers, 2012.
|
[5] |
汪洋. 海洋智能无人系统技术[M]. 上海: 上海科学技术出版社, 2020.
|
[6] |
YAN R, PANG S, SUN H, et al. Development and missions of unmanned surface vehicle[J]. Journal of Marine Science and Application, 2010, 9(4): 451-457. DOI:10.1007/s11804-010-1033-2 |
[7] |
SHAFER A J, BENJAMIN M R, LEONARD J J, et al. Autonomous cooperation of heterogeneous platforms for sea-based search tasks[C]//Oceans, IEEE, 2008: 1–10.
|
[8] |
SVEC, P, GUPTA S K. Automated synthesis of action selection policies for unmanned vehicles operating in adverse environments[J]. Autonomous Robots, 2012, 32(2): 149-164. DOI:10.1007/s10514-011-9268-6 |
[9] |
董晓明. 海上无人装备体系概览[M]. 哈尔滨: 哈尔滨工程大学出版社, 2020.
|
[10] |
LAVALLE S M. Planning Algorithms[M]. Cambridge: Cambridge University Press, 2006.
|
[11] |
LYDIA E K, STEVEN M L. Motion Planning[M]. Springer Handbook of Robotics, 2008.
|
[12] |
唐永兴, 朱战霞, 张红文, 等. 机器人运动规划方法综述[J]. 航空学报, 2023, 44(2):181–212.
|
[13] |
ZHE D, WEN, et al. Motion planning for unmanned surface vehicle based on trajectory unit[J]. Ocean Engineering, 2018.
|
[14] |
LEKKAS A M. Guidance and path-planning systems for autonomous vehicles[J]. Department of Engineering Cybernetics, 2014.
|
[15] |
LI H, WANG W J, LI K Q. A parallel parking path plan based on the B spline theory[J]. China Highw, 2016(9): 143–151.
|
[16] |
LIU Huajun, YANG Jingyu, LU Jianfeng, et al. Several algorithmic researches on motion planning for autonomous mobile robot[J]. Nanjing University of Science and Technology, 2010.
|
[17] |
DIJKSTRA E W. A note on two problems in connection with graphs[J]. Numerische Mathematik, 1959: 269–271.
|
[18] |
HART P, NILSSON N, RAPHAEL B. A formal basis for the heuristic determination of minimum cost paths[J]. IEEE Transactions of Systems Science and Cybernetics, 1968, 4(2): 100-107. DOI:10.1109/TSSC.1968.300136 |
[19] |
WARREN C W. A technique for autonomous underwater vehicle route planning[J]. IEEE Journal of Oceanic Engineering, 1990, 15: 199-204. DOI:10.1109/48.107148 |
[20] |
HSU D, JIANG T, REIF J, et al. Abstract the bridge test for sampling narrow passages with probabilistic roadmap planners[C]//IEEE International Conference on Robotics and Automation, 2003: 4420–4426.
|
[21] |
FERGUSON D, LIKHACHEV M, STENTZ A. A guide to heuristic-based path planning[C]//In Proceedings of International Conference on Automated Planning and Scheduling, Jerusalem, Israel, 2005: 9–18.
|
[22] |
SONG R, LIU Y, Bucknall R. Smoothed A* algorithm for practical unmanned surface vehicle path planning[J]. Applied Ocean Research, 2019, 83: 9-20. DOI:10.1016/j.apor.2018.12.001 |
[23] |
LI M, ZHANG H . AUV 3D path planning based on A* algorithm[C]//2020 Chinese Automation Congress (CAC), 2020.
|
[24] |
ZHANG C B, GONG Y, LI J J, et al. Automatic path planning for autonomous underwater vehicles based on an adaptive differential evolution[C]//In Proceedings of Annual Conference on Genetic and Evolutionary Computation, ACM, Vancouver, Canada, 2014: 89–96.
|
[25] |
张玉奎. 水面无人艇路径规划技术研究[D]. 哈尔滨: 哈尔滨工程大学, 2008.
|
[26] |
GIORDANO P R, VENDITTELLI M. Shortest paths to obstacles for a polygonal dubins car[J]. IEEE Transactions on Robotics, 2009, 25(5): 1184-1191. DOI:10.1109/TRO.2008.2011421 |
[27] |
李红, 王文军, 李克强. 基于 B 样条理论的平行泊车路径规划[J]. 中国公路学报, 2016(9): 143-151. DOI:10.3969/j.issn.1001-7372.2016.09.019 |
[28] |
王怿, 祝小平, 周洲. 一种基于Clothoid曲线的无人机路径规划算法[J]. 西北工业大学学报, 2012(6): 874-878. DOI:10.3969/j.issn.1000-2758.2012.06.014 |
[29] |
DAHL A R. Path planning and guidance for marine surface vessels[D]. Institute for Teknisk Kybernetikk, 2013.
|
[30] |
WANG Z , XIANG X, YANG J, et al. Composite astar and b-spline algorithm for path planning of autonomous underwater vehicle[C]//2017 IEEE 7th International Conference on Underwater System Technology: Theory and Applications (USYS), IEEE, 2018.
|
[31] |
刘乐柱, 肖长诗, 文元桥. 基于Dubins路径的无人艇运动规划算法[J]. 计算机应用, 2017, 37(7): 2114–2117+2123. |
[32] |
SZCZERBA R J, GALKOWSKI P. Robust algorithm for real-time route planning[J]. IEEE Transactions on Aerospace & Electronic Systems, 2000, 36(3): 869-878. |
[33] |
KIM H, PARK B, MYUNG H . Curvature path planning with high resolution graph for unmanned surface vehicle[J]. Springer Berlin Heidelberg, 2013.
|
[34] |
HANGUEN, KIM, DONGHOON. Angular rate-constrained path planning algorithm for unmanned surface vehicles[J]. Ocean Engineering, 2014.
|
[35] |
LEE T, KIM H, CHUNG H, et al. Energy efficient path planning for a marine surface vehicle considering heading angle[J]. Ocean Engineering, 2015, 10(1): 118-131. |
[36] |
WANG N , XU H. Dynamics-constrained global-local hybrid path planning of an autonomous surface vehicle[J]. IEEE Transactions on Vehicular Technology, 2020, 69(7): 6928–6942.
|
[37] |
LIU, WANG, ZHANG. A method of path planning on safe depth for unmanned surface vehicles based on hydrodynamic analysis[J]. Applied Sciences, 2019, 9(16): 3228. DOI:10.3390/app9163228 |
[38] |
PC A , YHB C , EP A. Global path planning for autonomous ship: a hybrid approach of fast marching square and velocity obstacles methods - sciencedirect[J]. Ocean Engineering, 2014.
|
[39] |
康亮. 自主移动机器人运动规划的若干算法研究[D]. 南京: 南京理工大学, 2010.
|
[40] |
XU N, CHEN X, KONG Q, et al. Motion planning for robot with nonholonomic constraints[J]. Robot, 2011(6): 666–672.
|
[41] |
DU M, MEI T, CHEN J, et al. RRT-based motion planning algorithm for intelligent vehicle in complex environments[J]. Robot, 2015(4): 443–450.
|
[42] |
JING-ZE S, BIN D, EN-ZHONG S, et al. An improved RRT path planning algorithm[J]. Acta Electron, 2010(38): 225–228.
|
[43] |
LIU Zhengfeng, ZHANG Longhui, WEI Naxin, et al. Study on path planning and following control of unmanned surface vehicles in restricted areas[J]. Journal of Ship Mechanics, 2021, 25(9): 1127–1136.
|
[44] |
GU S , ZHOU C , WEN Y, et al. A motion planning method for unmanned surface vehicle in restricted waters[J]. Proceedings of the Institution of Mechanical Engineers Part M: Journal of Engineering for the Maritime Environment, 2020, 234(2): 332–345.
|
[45] |
HAN S, WANG L , WANG Y. An efficient motion planning based on grid map: predicted trajectory approach with global path guiding[J]. Ocean Engineering, 2021 (238).
|
[46] |
DU Zhe, WEN Yuanqiao. Motion planning for unmanned surface vehicle based on trajectory unit[J]. Ocean Engineering, 2018(151):46–56.
|
[47] |
DU Z, WEN Y, XIAO C, et al. Trajectory-cell based method for the unmanned surface vehicle motion planning[J]. Applied Ocean Research, 2019, 86: 207-221. DOI:10.1016/j.apor.2019.02.005 |
[48] |
WILLNERS J S , PETILLOT Y R , PATRON P, et al. Kinodynamic path planning for following and tracking vehicles[C]// Oceans 2018 MTS/IEEE Charleston, IEEE, 2018.
|