您好, 访客   登录/注册

基于海图环境的无人艇全局路径规划

来源:用户上传      作者:马欣 杨兵 邱斌彬 王胜正 赵建森

  摘要:无人艇作为一种性能高、体型小、能够执行各种危险任务的水上智能移动平台备受各国关注。本文在考虑无人艇的航行水深环境和其运动性能的基础上对无人艇全局路径规划展开研究,提出一种多约束的路径规划方法。首先基于VoronoiField算法的原理构建安全距离约束模型,利用安全距离约束模型对A-star算法进行改进,保证全局路径与障碍物之间存在可控的安全距离。在此基础上,对规划路径提出一种减少转折点及冗余节点的路径平滑优化方法。实验证明改进后的A-star算法规划出的航行路径能够与障碍物保持可控的安全距离,平滑优化后的路径在路径长度、平滑度和节点数上较优化前其优势明显。
  关键词:电子海图;无人艇;路径规划
  中图分类号:U664.82文献标识码:A文章编号:1006―7973(2022)08-0041-03
  近年来,由于全球气候变暖、陆地资源紧缺、环境污染日益加剧,世界各国对海洋资源的开发更加重视,也因此带动了水面无人艇(UnmannedSurfaceVehicle,USV)和水下机器人等海上高端设备的快速发展[1]。作为一种海上智能机器人,USV能够在无人干预的状况下独立执行任务,是一种具有体量小、高速智能、隐蔽性强等优点的水面作业任务平台,主要被用于执行具有危险性以及不适合有人船舶执行的任务[2-3]。无人艇在环境监测、水文探测、近海巡逻、海上搜寻救助、远程侦察等民用及军事领域中都发挥了重大的作用[4]。
  Singh[5]等使用可以设置安全距离的A*算法在卫星图上生成了一条沿岸的安全路径,该方法更适用于近岸航行。Candeloro[6]等利用维诺图(VoronoiDiagram,VD)方法对新加坡海峡的航行空间进行分割,分割边界上的路径是环境中最安全的路径,但利用费马螺线方法平滑后的路径与初始规划路径偏差较大。Niu[7]等利用维诺图算法和Dijsktra算法进行全局路径搜索,在重构的新加坡海峡环境下得到了一条距离所有障碍物最远的路径但却不够平滑。Zhang[8]等将遗传算法和模拟退火法混合,在栅格化的海图环境上进行了实验,解决了传统遗传算法搜索能力不足和时间消耗问题。以上研究虽然考虑了路径的安全性,但对实验环境中障碍物的建模以及路径的经济性考虑不足。
  为了无人艇在自主航行过程中能够规划出一条安全、经济的路径,本文通过Web海图构建基于5m等深线的实验环境,确定全局路径规划的安全性优化目标,建立全局路径规划子模型。
  1实验部分
  1.1海图数据处理
  首先,对于海图中渲染了不同颜色的面数据,用像素阈值分割技术进行处理。其中,满足水深约束条件的处理为可航区域,其他为障碍物区域。其次,筛选实验区域内碍航的点、线数据绘制在实验环境模型中。最后,将海图数据构建为栅格化环境模型。
  由于栅格化环境模型下生成的路径为直角坐标系下的栅格位置点,为了能够在实际中指导无人艇的航行,需要对栅格节点与地理坐标系(经度、纬度)进行转换,坐标转换计算原理如图1所示。图1表示一块最大纬度和最小纬度为Lat、Lat,最大经度和最小经度为Lon、Lon的海图区域。对应的横向栅格数目为m,纵向栅格数目为n。经纬度与栅格坐标的转换公式如下:
  式(1)中,Lat和Lon分别表示无人艇航行过程中的位置点坐标,x和y分别表示栅格图中横向坐标和纵向坐标。
  1.2Voronoi-field算法
  维诺场是Dolgov[9]等提出的在维诺图区域边界与障碍物之间按比例添加的危险势场,路径越靠近VE,则维诺场值越接近于0,越安全;路径越靠近障碍物,则维诺场值越接近于1,越危险。维诺场定义如下所示:
  式(2)中,do(x,y)为当前节点到障碍物的距离;dv(x,y)为当前节点到维诺边界的距离;a>0是控制势场衰减率的常数;domax>0是控制势场最大作用范围的常量。
  该公式适用于当势场值为0时;因此,若将公式中的domax设置为domax=D,根据公式可知,维诺场值为0的航行区域与障碍物之间的距离均大于USV需要保持的安全距离D。无人艇航行在维诺场值为0的区域能够降低碰撞风险。
  1.3改进A-star算法
  A-star算法作为一种常用的启发式路径搜索算法,被广泛应用在全局路径规划领域。它的搜索方式有4连通区域搜索和8连通区域搜索两种,考虑到USV在海洋中的运动特性,文中采用八连通区域的搜索方式对可航水域进行搜索。本文将危险度函数作为评价函数的一部分进行路径规划,改进后A-star算法的启发式函数f(n)定义如下:
  f(n)=g(n)+h(n)+D(n)(3)
  式(3)中,g(n)为起始点到当前节点的实际距离代价,h(n)为估算当前节点到目标节点的距离代价。D(n)为利用维诺场为栅格添加危险度的危险度函数。D(n)的定义如下:
  式(4)中,Pv为当前节点处的维诺场值;dv(x,y)为当前节点到维诺边界的距离;D为安全约束距离。
  2结果与讨论
  本文对选定的海图区域进行栅格化处理,划分为500×500的栅格,每个栅格代表25m。针对USV的操纵性能,设定了100m、200m、300m的安全距离约束。基于不同安全距离约束并且平滑优化后的全局路径规划结果如图3所示,图3(a)为栅格环境中规划路径的显示,图3(b)为重绘的海图水深环境中规划路径的显示。
  图2为传统A-star算法与不同安全距离约束条件下A-star算法的实验结果的对比。其中,{色实线为没有添加安全距离约束的A-star算法全局路径规划的结果,可以看出规划的路径在障碍物附近贴近障碍物,这无疑会增加无人艇与障碍物之间的碰撞风险。红色、青色与洋红色分别为是保持100m、200m、300m安全距离约束的路径规划结果,可以看出随着距离约束的增加,规划出的路径在靠近障碍物时能够保持距离约束并且安全距离越大的路径与障碍物的距离越远,所提的方法能够保证安全水深的约束。

nlc202209191141



转载注明来源:https://www.xzbu.com/2/view-15439877.htm

相关文章

服务推荐