科创中国

本发明涉及一种水面无人艇动态规划方法，所述方法包括：鉴于水面无人艇在海面上碰到的动态障碍物大多为船舶，根据船舶的形状特性，对其建立椭圆模型；在建立椭圆模型基础上，对椭圆模型进行分析，确定船舶动态障碍物的影响范围，并在影响范围内构建椭圆斥力势场提供斥力，从而引导水面无人艇躲避动态障碍物；进一步考虑船舶动态障碍物运动的不稳定性和不可预测性，水面无人艇需要在短时间内避开动态障碍物，故采用变斥力系数方法，增加斥力，改变合力方向，从而达到快速引导水面无人艇避开动态障碍物的效果。

本发明的目的是提出一种水面无人艇动态规划方法，解决传统人工势场法应用在水面无人艇动态规划过程中的动态障碍物建模困难、快速避障等问题。本发明为了解决上述问题采用以下技术方案：设计了一种水面无人艇动态规划方法，对船舶动态障碍物建立椭圆等效模型，设置满足约束条件的影响范围；根据引力和斥力关系改变斥力系数，从而在下一次运动中，增大斥力，改变合力，快速避障，实现高效可靠实时的动态规划。具体包括以下步骤：步骤1：设置人工势场法中引力系数μ和斥力系数η，水面无人艇的半长轴aq、半短轴bq、初始位置qs和目标点位置qg，船舶动态障碍物模型的半长轴ap、半短轴bp、半焦距cp、左焦点位置cp1和右焦点位置cp2，船舶动态障碍物的影响范围半长轴Ap和半短轴Bp需满足如下约束条件：然后进入步骤2；步骤2：判断水面无人艇当前位置q是否到达qg，是则结束，否则进入步骤3；

由于海洋防卫等需求不断扩大，各国正在全力搭建海洋无人综合平台，而水面无人艇作为新型无人装备得到全面发展。但是水面无人艇运动操纵的动态规划尚不成熟。

[0003] 常用的动态规划方法有速度斥力场算法、动态窗口算法、视觉算法、人工势场法等。其中人工势场法较其他算法而言，具有运算时间短、实时性强、适应性好等方面的优势。但是传统人工势场法在水面无人艇运动操纵及动态规划领域的应用有如下问题：

(1)动态障碍物建模困难问题，由于水面无人艇碰到动态障碍物大多为船舶，传统人工势场法将动态障碍物视为质点，斥力影响范围为圆形船舶动态障碍物影响范围难以确定而且所规划路径达不到安全保证；

(2)快速避障问题，传统人工势场法斥力系数和引力系数固定，产生的斥力是随着水面无人艇与船舶动态障碍物距离的减小而增大，而引力是随着水面无人艇与目标点距离的减小而减小，水面无人艇的位置时刻变化，同时还需要考虑船舶动态障碍物运动的不稳定性和不可预测性，系数固定难以实现快速可靠实时的动态规划。

专利《基于椭圆聚类‑碰撞锥推演的无人艇海洋动态避障控制算法》提供的改进方法，存在以下问题：

(1)该发明对动态船只进行椭圆聚类，按照其尺寸形态进行聚类成动态椭圆障碍物，但是未明确椭圆障碍物的形状，所规划出的路径得不到安全保障；

(2)该发明需要采集动态障碍物的运动状态，获取信息量大，计算难度高实时性差。

综上所述，如何解决人工势场法在水面无人艇动态环境下的应用已成为亟待解决的难点。

此技术为哈尔滨理工大学孙明晓研发，承担本专科及研究生层次普通高等学历教育工作承担科学技术研究工作

与现有技术相比，此技术产生的效益：1.本发明所述方法建立船舶动态障碍物椭圆等效模型，确定船舶动态障碍物的影响范围，在影响范围内构建斥力势场，对无人艇产生斥力，保证无人艇能够顺利避开动态障碍物，达到安全航行的要求；

2.本发明所述方法采用变斥力系数方法，改变斥力，进而改变合力，从而达到水面无人艇快速避开船舶动态障碍物的效果，实现高效可靠实时的动态规划；

3.本发明所述方法明确动态椭圆障碍物的形状，使建立的模型准确，所规划出的路径安全；

4.本发明所诉方法主要是借助位置信息，获取难度低，计算量小，实时性好，能达到快速避障的目的。

技术转让，许可，合作所需资金需双方协商，此项技术想尽快落地保定，希望具备此项技术研发的技术方，能够尽快承接此项目。