CN113879495B - 一种基于海流预测的水下滑翔机动态运动规划方法 - Google Patents
一种基于海流预测的水下滑翔机动态运动规划方法 Download PDFInfo
- Publication number
- CN113879495B CN113879495B CN202111249478.4A CN202111249478A CN113879495B CN 113879495 B CN113879495 B CN 113879495B CN 202111249478 A CN202111249478 A CN 202111249478A CN 113879495 B CN113879495 B CN 113879495B
- Authority
- CN
- China
- Prior art keywords
- underwater glider
- glider
- energy consumption
- underwater
- time
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 51
- 238000005265 energy consumption Methods 0.000 claims abstract description 81
- 238000005457 optimization Methods 0.000 claims abstract description 27
- 230000006870 function Effects 0.000 claims description 9
- 230000001105 regulatory effect Effects 0.000 claims description 9
- 238000005096 rolling process Methods 0.000 claims description 9
- 230000036962 time dependent Effects 0.000 claims description 8
- 238000000354 decomposition reaction Methods 0.000 claims description 4
- 238000001514 detection method Methods 0.000 claims description 4
- 239000002245 particle Substances 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000015572 biosynthetic process Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000004891 communication Methods 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 claims description 3
- 239000013535 sea water Substances 0.000 claims description 3
- 238000003786 synthesis reaction Methods 0.000 claims description 3
- 238000012843 least square support vector machine Methods 0.000 claims 1
- 230000008569 process Effects 0.000 description 10
- 238000004458 analytical method Methods 0.000 description 6
- 238000011160 research Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000003068 static effect Effects 0.000 description 3
- 238000012706 support-vector machine Methods 0.000 description 3
- 230000010391 action planning Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 235000012771 pancakes Nutrition 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/10—Geometric CAD
- G06F30/15—Vehicle, aircraft or watercraft design
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
- G06F2119/14—Force analysis or force optimisation, e.g. static or dynamic forces
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Geometry (AREA)
- General Physics & Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出一种基于海流预测的水下滑翔机动态运动规划方法，用于在海流未知且时变的复杂海流环境下动态规划水下滑翔机从起点到目标点的一系列运动参数：航向、深度和俯仰。该方法主要利用基于VMD‑PSO‑LSSVM的水下滑翔机深平流预测模型和异步双精度优化窗口策略实现动态运动规划。首先，对水下滑翔机模型进行分析，分别建立稳态滑翔模型和能耗模型；其次，建立基于VMD‑PSO‑LSSVM的水下滑翔机深平流预测模型，实现对未知海流的预测；最后，利用异步双精度优化窗口策略完成对滑翔机每一滑翔周期的运动参数进行规划。本方法考虑了水下滑翔机能耗模型和海洋环境模型，能够实现动态避障，为滑翔机提供安全保障和降低能耗。
Description
技术领域
本发明属于水下滑翔机任务规划技术领域，具体涉及一种水下滑翔机动态运动规划方法。
背景技术
自主式水下滑翔机(Autonomous Underwater Glider)是一种以净浮力为驱动力的新型水下航行器，具有滑翔速度低，单周期滑翔时间长，能耗低等特点，被广泛地用于海洋观测、水下监控、海底勘探等科学研究。水下滑翔机单周期的滑翔过程主要包括：(1)准备下潜阶段。水下滑翔机收到下潜任务指令时，开始减小浮力，准备下潜；(2)稳态下潜阶段。控制系统保持水下滑翔机以固定的俯仰角稳态下潜；(3)上浮浮力调节阶段。当水下滑翔机到达目标深度时，开始浮力调节，移动滑块增大油馕体积进而转为上浮。(4)稳态上浮阶段。控制系统保持水下滑翔机以固定俯仰角稳态上浮。(5)浮出水面阶段。水下滑翔机浮出水面，通过卫星发送水下滑翔机当前状态，然后接收操作人员新的指令。
深平流指不同深度下水平方向海流的平均值。由于水下滑翔机动力小，滑翔速度低，其对海洋环境信息(海流、气象、障碍、地形等)非常敏感，因此在运动规划的过程中需要充分考虑海洋环境信息。尤其是海流信息，表面的海流往往比较容易获取，但是获取不同深度下的海流信息比较困难。同时，由于滑翔机能耗的限制和载荷量的限制，水下滑翔机往往不携带测流装置，因此，如何根据滑翔机特殊的运动方式来估计和预测深平流对滑翔机运动规划研究有重要的意义。本方法采用的是基于VMD-PSO-LSSVM的水下滑翔机深平流预测模型。该预测模型能够准确的估计和预测滑翔机未来多周期的深平流信息，为后续动态运动规划提供理论指导。
目前，水下滑翔机路径规划方法研究的非常成熟，无论是在时不变的海流环境还是在时变的海流环境中，路径规划都能取得不错的结果。然而，国内外针对水下滑翔机运动规划的研究内容较少。本方法提出了一种基于海流预测的水下滑翔机动态运动规划方法，结合了海洋环境模型和滑翔机能耗模型，规划了滑翔机每一周的运动参数：航向、深度和俯仰。动态运动规划有重要的研究意义，一方面，利用滑翔机每一周期的航向、深度和俯仰可以确定一条精细的三维路径；另一方面，详细的动作规划结果可作为滑翔机轨迹跟踪的控制期望，一定程度上减轻滑翔机控制压力。本方法适用于海流信息未知、障碍物未知的复杂海洋环境，通过异步双精度优化窗口策略，为滑翔机运动规划提供安全保障和降低能耗。
发明内容
为提高水下滑翔机在复杂海洋环境中动态运动规划能力，本发明提供一种基于海流预测的水下滑翔机动态运动规划方法。首先，建立水下滑翔机的稳态滑翔模型和能耗模型，分别得出滑翔速度与净浮力和俯仰角之间的关系和滑翔机滑翔一周期的总能耗；然后利用深平流预测方法预测未来滑翔周期的海流信息；最后利用异步双精度优化窗口策略动态规划滑翔机每一周期的航向、深度和俯仰。本发明能够在海流信息未知、障碍物未知的复杂海洋环境下，实现动态避障。
本发明为解决其技术问题所采用的技术方案包括以下步骤：
步骤1：建立水下滑翔机稳态滑翔模型；
通过对水下滑翔机稳态滑翔时的受力分析，可得出稳态滑翔速度是净浮力和滑翔角的函数：
式中，B表示水下滑翔机的净浮力，ξ表示滑翔角，KL和KL0表示水下滑翔机的升力系数，KD和KD0为水下滑翔机的阻力系数，升力系数和阻力系数由水下滑翔机的结构决定，为常值。
水下滑翔机稳态下潜时的攻角为：
滑翔角与俯仰角和攻角的关系为：
ξ＝θ-α (3)
由于水下滑翔机的攻角很小，可以忽略不计，因此滑翔角近似等于俯仰角。水下滑翔机的滑翔速度可以表示为：
式中，Vh表示稳态下潜的水平速度，Vz表示稳态下潜的垂直速度，计算方法分别如下：
Vz＝Vsin(ξ) (6)
步骤2：建立水下滑翔机能耗模型；
水下滑翔机能耗模型主要分为与时间相关的能耗和与时间无关的能耗。
(1)与时间相关的能耗
与时间相关的能耗主要包括控制与导航系统的能耗，测量传感器的能耗和定位与通讯系统的能耗。水下滑翔机滑翔一个周期的时间为：
式中，h表示水下滑翔机下潜深度。取这些能耗的平均功率为Pt，则水下滑翔机滑翔一周期与时间相关的能耗为：
Et＝Pt·t (8)
(2)与时间无关的能耗
与时间无关的能耗主要包括浮力调节系统的能耗和姿态调节系统的能耗。水下滑翔机滑翔一周期浮力调节系统的能耗为：
式中，ρ为海水密度，g为重力加速度，PC为液压泵的流量，qp为液压泵的功率。
姿态调节系统的能耗又可分为俯仰调节和横滚调节。由于滑翔机受海流影响比较大，很难稳定地控制横滚角，导致很难建立横滚调节系统能耗模型，因此本方法仅考虑俯仰调节系统的能耗。假设滑块移动的速度为vm，移动的电功率为Pm，则水下滑翔机滑翔一个周期推动滑块的能耗为：
式中，r滑块偏离平衡点的距离。
由上述分析可得，水下滑翔机滑翔一周期的总能耗为：
E＝Et+Eh+Em (11)
步骤3：建立海流未知且时变的复杂海洋环境模型；
为模拟时变海流环境，本方法利用多个涡流场函数建立时变海流场，设定涡流中心S0随着时间变化，虽然建立的海流环境和真实情况还有一定的差距，但主要目的是为了检验所建立的水下滑翔机模型和动态运动规划算法的有效性和正确性。涡流场函数为：
式中，uc(S)和vc(S)分别为海流在x轴和y轴方向的分量，S0表示涡流中心，η和ζ分别表示涡流半径和涡流强度，S表示二维平面上的任意位置。
步骤4：利用基于VMD-PSO-LSSVM的水下滑翔机深平流预测方法对滑翔机未来k个周期的深平流进行预测；
水下滑翔机将历史滑翔周期计算得到的深平流数据看作时间序列，然后利用结合变分模态分解(VMD)、粒子群优化算法(PSO)和最小二乘支持向量机(LSSVM)的方法实现对海流的预测。深平流预测方法的详细过程见具体实施例。
步骤5：建立海流影响下的水下滑翔机速度合成模型；
根据步骤1建立的稳态滑翔模型可求出水下滑翔机在不同净浮力和俯仰角下的水平滑翔速度Vh。假设海流的大小为Vcur，方向为φcur，Vh的方向为φaug。则海流影响下的水下滑翔机水平速度为：
步骤6：利用异步双精度优化窗口策略动态规划水下滑翔机每一周期的航向、深度和俯仰。
异步双精度优化窗口策略由基于全局已知信息(地形、静态障碍等)的全局窗口和基于探测信息(台风、障碍等)的局部窗口组成。全局窗口和局部窗口采用不同的步长和滚动机制，更新频率和时刻均不同。全局窗口利用A*算法可为局部窗口提供航路点信息，局部窗口利用滚动优化的方式动态规划滑翔机每一周期的航向、深度和俯仰。步骤6的详细过程见具体实施例。
由于采用了本发明提出的一种基于海流预测的水下滑翔机动态运动规划方法，带来了如下有益效果：
1、建立了准确的水下滑翔机模型分析方法：稳态滑翔模型和能耗模型；
2、深平流预测和异步双精度优化窗口策略的结合可使在海流信息未知的复杂海洋环境中动态运动规划成为可能，既能为滑翔机提供安全保障又可以降低能耗。
3、滑翔机动态运动规划结果可为滑翔机轨迹跟踪提供控制期望，在一定程度上减轻滑翔机控制压力。
附图说明
图1为本发明方法稳态滑翔受力分析图。
图2为本发明方法基于VMD-PSO-LSSVM的水下滑翔机深平流预测模型图。
图3为本发明方法A*算法流程图。
图4为本发明方法基于异步双精度优化窗口策略的动态运动规划流程图。
图5为本发明方法水下滑翔机动态运动规划结果图。
图6为本发明方法水下滑翔机在二维平面运动轨迹图。
图7为本发明方法水下滑翔机在三维空间运动轨迹图。
图8为异步双精度优化窗口策略。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
为更好地实现水下滑翔机在复杂海洋环境中躲避障碍，安全地到达目标点，本发明提出了一种基于海流预测的水下滑翔机动态运动规划方法。在整个算法的实现过程中，需要建立水下滑翔机稳态滑翔模型和能耗模型。在动态运动规划过程中充分考虑了海洋环境信息对水下滑翔机的影响，利用异步双精度优化窗口策略为滑翔机规划了每一周期的航向、深度和俯仰。
本发明提供一种基于海流预测的水下滑翔机动态运动规划方法包括以下步骤：
步骤1：建立水下滑翔机稳态滑翔模型；
通过对水下滑翔机稳态滑翔时的受力分析，可得出稳态滑翔速度是净浮力和滑翔角的函数：
式中，B表示水下滑翔机的净浮力，ξ表示滑翔角，KL和KL0表示水下滑翔机的升力系数，KD和KD0为水下滑翔机的阻力系数，升力系数和阻力系数由水下滑翔机的结构决定，为常值。
水下滑翔机稳态下潜时的攻角为：
滑翔角与俯仰角和攻角的关系为：
ξ＝θ-α (3)
由于水下滑翔机的攻角很小，可以忽略不计，因此滑翔角近似等于俯仰角。水下滑翔机的滑翔速度可以表示为：
式中，Vh表示稳态下潜的水平速度，Vz表示稳态下潜的垂直速度，计算方法分别如下：
Vz＝Vsin(ξ) (6)
步骤2：建立水下滑翔机能耗模型；
水下滑翔机能耗模型主要分为与时间相关的能耗和与时间无关的能耗。
(1)与时间相关的能耗
与时间相关的能耗主要包括控制与导航系统的能耗，测量传感器的能耗和定位与通讯系统的能耗。水下滑翔机滑翔一个周期的时间为：
式中，h表示水下滑翔机下潜深度。取这些能耗的平均功率为Pt，则水下滑翔机滑翔一周期与时间相关的能耗为：
Et＝Pt·t (8)
(2)与时间无关的能耗
与时间无关的能耗主要包括浮力调节系统的能耗和姿态调节系统的能耗。水下滑翔机滑翔一周期浮力调节系统的能耗为：
式中，ρ为海水密度，g为重力加速度，PC为液压泵的流量，qp为液压泵的功率。
姿态调节系统的能耗又可分为俯仰调节和横滚调节。由于滑翔机受海流影响比较大，很难稳定地控制横滚角，导致很难建立横滚调节系统能耗模型，因此本方法仅考虑俯仰调节系统的能耗。假设滑块移动的速度为vm，移动的电功率为Pm，则水下滑翔机滑翔一个周期推动滑块的能耗为：
式中，r滑块偏离平衡点的距离。
由上述分析可得，水下滑翔机滑翔一周期的总能耗为：
E＝Et+Eh+Em (11)
步骤3：建立海流未知且时变的复杂海洋环境模型；
为模拟时变海流环境，本方法利用多个涡流场函数建立时变海流场，设定涡流中心S0随着时间变化，虽然建立的海流环境和真实情况还有一定的差距，但主要目的是为了检验所建立的水下滑翔机模型和动态运动规划算法的有效性和正确性。涡流场函数为：
式中，uc(S)和vc(S)分别为海流在x轴和y轴方向的分量，S0表示涡流中心，η和ζ分别表示涡流半径和涡流强度，S表示二维平面上的任意位置。
步骤4：利用基于VMD-PSO-LSSVM的水下滑翔机深平流预测方法对滑翔机未来k个周期的深平流进行预测；
水下滑翔机将历史滑翔周期计算得到的深平流数据看作时间序列，然后利用结合变分模态分解(VMD)、粒子群优化算法(PSO)和最小二乘支持向量机(LSSVM)的方法实现对海流的预测。深平流预测方法的详细过程见具体实施例。
步骤5：建立海流影响下的水下滑翔机速度合成模型；
根据步骤1建立的稳态滑翔模型可求出水下滑翔机在不同净浮力和俯仰角下的水平滑翔速度Vh。假设海流的大小为Vcur，方向为φcur，Vh的方向为φaug。则海流影响下的水下滑翔机水平速度为：
步骤6：利用异步双精度优化窗口策略动态规划水下滑翔机每一周期的航向、深度和俯仰。
异步双精度优化窗口策略由基于全局已知信息(地形、静态障碍等)的全局窗口和基于探测信息(台风、障碍等)的局部窗口组成。全局窗口和局部窗口采用不同的步长和滚动机制，更新频率和时刻均不同。全局窗口利用A*算法可为局部窗口提供航路点信息，局部窗口利用滚动优化的方式动态规划滑翔机每一周期的航向、深度和俯仰。步骤6的详细过程见具体实施例。
具体实施例：
本发明实施例以水下滑翔机在未知且时变海流环境中动态运动规划方法为例，对动态运动规划方法进行了验证：
1、水下滑翔机稳态滑翔受力分析。
水下滑翔机稳态下潜时的受力分析如图1所示，由力矩平衡可得：
Dcos(ξ)+Lsin(ξ)＝0 (1)
-Dsin(ξ)+Lcos(ξ)＝B (2)
式中，D为水下滑翔机受到的阻力，L为水下滑翔机受到的升力，B为水下滑翔机的净浮力，ξ为水下滑翔机的滑翔角。由(1)和(2)可得：
L＝Bcos(ξ) (3)
D＝-Bsin(ξ) (4)
水下滑翔机的水动力还可近似表示为：
L＝(KL0+KLα)V2 (5)
D＝(KD0+KDα2)V2 (6)
根据公式(3)、(4)、(5)和(6)，可得稳态滑翔速度和稳态下潜的攻角分别为：
2、建立基于VMD-PSO-LSSVM的水下滑翔机深平流预测模型。
深平流预测模型如图2所示，主要包括以下步骤：
(1)将深平流时间序列归一化，利用变分模态分解法(VMD)将其分解为m个子时间序列{x1,x2,…,xm}；
(2)对每个子时间序列，先利用粒子群优化算法(PSO)优化最小二乘支持向量机(LSSVM)的正则化因子和核参数，然后使用优化后的预测模型PSO-LSSVM对每个子时间序列xi进行预测，得到预测结果yi；
(3)将各子时间序列的预测结果{y1,y2,…,ym}叠加并反归一化。最终得到深平流预测结果。
3、建立基于异步双精度优化窗口策略的动态运动规划模型。
异步双精度优化窗口策略的动态运动规划流程如图4所示，主要包括全局窗口和局部窗口。
(1)全局窗口
全局窗口基于已知的全局范围信息(地形、静态障碍)，利用A*算法，以能耗最低作为优化目标，进行全局路径规划，并为局部窗口运动规划提供参考。A*算法的原理可以描述为：
Fn＝Gn+Hn (9)
式中，Fn表示从起点到终点的代价估计；Gn表示从起点到当前点n的实际代价；Hn表示从当前点n到目标状态的估计代价，用于启发搜索。A*算法的详细流程如图3所示。
(2)局部窗口
局部窗口利用基于探测的局部信息，进行滚动优化，利用A*规划的粗略轨迹来指导精细的运动参数规划：航向、深度和俯仰。运动参数的范围为：航向yaw∈[0°,360°]，深度depth∈[100m,500m]，俯仰pitch∈[15°,30°]。
假设滑翔机的预测窗口为k个执行窗口，则水下滑翔机从当前位置到达预测窗口位置的坐标为：
式中，x(n+k)表示滑翔机第n+k滑翔周期的x坐标，y(n+k)表示滑翔机第n+k滑翔周期的y坐标。表示海流影响下的第i周期水平滑翔速度，/>表示第i周期垂直滑翔速度。水下滑翔机滑翔一个周期的时间为为：
根据技术方案中的能耗模型分析，可计算每一个滑翔周期的能耗Ei，滑翔机从当前位置到达预测窗口的位置的总能耗为：
假设从预测窗口位置到目标点的估计代价为：
式中：distance表示预测窗口位置到目标点的距离，En+k表示第n+k周期的能耗。水下滑翔机从当前位置到目标点的能耗代价为：
E＝l1·Ep+l2·Ee (15)
式中，l1和l2表示权重系数。若在规划的过程中碰到障碍或碰到海底，能耗代价E为无穷大。在滚动优化过程中利用差分进化算法，优化出滑翔机从当前位置到达目标点位置能耗代价最低的运动参数组合：[yaw,depth,pitch]。然后水下滑翔机根据规划的结果[yaw,depth,pitch]滑翔一个周期，到达执行窗口后，继续进行局部窗口滚动优化，直到到达目标点。
图5、图6和图7表示在海流未知且时变的复杂海洋环境下运动规划结果，规划结果验证了该方法的有效性。
Claims (1)
1.一种基于海流预测的水下滑翔机动态运动规划方法，其特征在于：包括以下步骤：
步骤1：建立水下滑翔机稳态滑翔模型；
通过对水下滑翔机稳态滑翔时的受力分析，得出稳态滑翔速度是净浮力和滑翔角的函数：
式中，B表示水下滑翔机的净浮力，ξ表示滑翔角，KL和KL0表示水下滑翔机的升力系数，KD和KD0为水下滑翔机的阻力系数，升力系数和阻力系数由水下滑翔机的结构决定，为常值；
水下滑翔机稳态下潜时的攻角为：
滑翔角与俯仰角和攻角的关系为：
ξ＝θ-α (3)
由于水下滑翔机的攻角很小，可以忽略不计，因此滑翔角近似等于俯仰角；水下滑翔机的滑翔速度表示为：
式中，Vh表示稳态下潜的水平速度，Vz表示稳态下潜的垂直速度，计算方法分别如下：
Vz＝Vsin(ξ) (6)
步骤2：建立水下滑翔机能耗模型；
所述水下滑翔机能耗模型分为与时间相关的能耗和与时间无关的能耗：
(1)与时间相关的能耗
与时间相关的能耗主要包括控制与导航系统的能耗，测量传感器的能耗和定位与通讯系统的能耗；水下滑翔机滑翔一个周期的时间为：
式中，h表示水下滑翔机下潜深度；取这些能耗的平均功率为Pt，则水下滑翔机滑翔一周期与时间相关的能耗为：
Et＝Pt·t (8)
(2)与时间无关的能耗
与时间无关的能耗包括浮力调节系统的能耗和姿态调节系统的能耗；水下滑翔机滑翔一周期浮力调节系统的能耗为：
式中，ρ为海水密度，g为重力加速度，PC为液压泵的流量，qp为液压泵的功率；
姿态调节系统的能耗又可分为俯仰调节和横滚调节；假设滑块移动的速度为vm，移动的电功率为Pm，则水下滑翔机滑翔一个周期推动滑块的能耗为：
式中，r滑块偏离平衡点的距离；
水下滑翔机滑翔一周期的总能耗为：
E＝Et+Eh+Em (11)
步骤3：建立海流未知且时变的复杂海洋环境模型；
为模拟时变海流环境，利用多个涡流场函数建立时变海流场，设定涡流中心S0随着时间变化，涡流场函数为：
式中，uc(S)和vc(S)分别为海流在x轴和y轴方向的分量，S0表示涡流中心，η和ζ分别表示涡流半径和涡流强度，S表示二维平面上的任意位置；
步骤4：利用基于VMD-PSO-LSSVM的水下滑翔机深平流预测方法对滑翔机未来k个周期的深平流进行预测；
所述深平流指不同深度下水平方向海流的平均值；
水下滑翔机将历史滑翔周期计算得到的深平流数据看作时间序列，然后利用结合变分模态分解、粒子群优化算法和最小二乘支持向量机的方法实现对海流的预测；
步骤5：建立海流影响下的水下滑翔机速度合成模型；
根据步骤1建立的稳态滑翔模型可求出水下滑翔机在不同净浮力和俯仰角下的水平滑翔速度Vh；假设海流的大小为Vcur，方向为φcur，Vh的方向为φaug；则海流影响下的水下滑翔机水平速度为：
步骤6：利用异步双精度优化窗口策略动态规划水下滑翔机每一周期的航向、深度和俯仰；
异步双精度优化窗口策略由基于全局已知信息的全局窗口和基于探测信息的局部窗口组成；全局窗口和局部窗口采用不同的步长和滚动机制，更新频率和时刻均不同；全局窗口利用A*算法可为局部窗口提供航路点信息，局部窗口利用滚动优化的方式动态规划滑翔机每一周期的航向、深度和俯仰。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111249478.4A CN113879495B (zh) | 2021-10-26 | 2021-10-26 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111249478.4A CN113879495B (zh) | 2021-10-26 | 2021-10-26 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113879495A CN113879495A (zh) | 2022-01-04 |
| CN113879495B true CN113879495B (zh) | 2024-04-19 |
Family
ID=79014615
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111249478.4A Active CN113879495B (zh) | 2021-10-26 | 2021-10-26 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113879495B (zh) |
Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102079373A (zh) * | 2009-11-27 | 2011-06-01 | 中国科学院沈阳自动化研究所 | 一种水下滑翔机用低功耗控制系统及其控制方法 |
| KR101658112B1 (ko) * | 2015-06-24 | 2016-09-20 | 인하대학교 산학협력단 | 수중글라이더의 글라이딩 안정화 방법 |
| CN107618641A (zh) * | 2017-08-07 | 2018-01-23 | 熊学军 | 水下滑翔机无滑脱随流运动控制方法 |
| CN109240324A (zh) * | 2018-11-09 | 2019-01-18 | 西北工业大学 | 一种浮力反馈下的水下滑翔机俯仰角控制方法 |
| KR101994105B1 (ko) * | 2018-11-14 | 2019-06-28 | 엘아이지넥스원 주식회사 | 바운스 경로를 결정하는 수중 글라이더 및 이를 이용하는 방법 |
| KR20190086331A (ko) * | 2018-01-12 | 2019-07-22 | 경북대학교 산학협력단 | 수중글라이더의 환경적응형 비행 모델 설계 장치 및 방법, 상기 방법을 수행하기 위한 기록 매체 |
| CN111813143A (zh) * | 2020-06-09 | 2020-10-23 | 天津大学 | 一种基于强化学习的水下滑翔机智能控制系统及方法 |
| CN112100834A (zh) * | 2020-09-06 | 2020-12-18 | 西北工业大学 | 一种基于深度强化学习的水下滑翔机姿态控制方法 |
| CN112363401A (zh) * | 2020-11-29 | 2021-02-12 | 西北工业大学 | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 |
| CN112363517A (zh) * | 2020-10-09 | 2021-02-12 | 中国科学院沈阳自动化研究所 | 一种水下滑翔机的编队控制方法 |
| CN112612290A (zh) * | 2020-12-06 | 2021-04-06 | 西北工业大学 | 一种考虑洋流的水下航行器三维多任务路径规划方法 |
-
2021
- 2021-10-26 CN CN202111249478.4A patent/CN113879495B/zh active Active
Patent Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102079373A (zh) * | 2009-11-27 | 2011-06-01 | 中国科学院沈阳自动化研究所 | 一种水下滑翔机用低功耗控制系统及其控制方法 |
| KR101658112B1 (ko) * | 2015-06-24 | 2016-09-20 | 인하대학교 산학협력단 | 수중글라이더의 글라이딩 안정화 방법 |
| CN107618641A (zh) * | 2017-08-07 | 2018-01-23 | 熊学军 | 水下滑翔机无滑脱随流运动控制方法 |
| KR20190086331A (ko) * | 2018-01-12 | 2019-07-22 | 경북대학교 산학협력단 | 수중글라이더의 환경적응형 비행 모델 설계 장치 및 방법, 상기 방법을 수행하기 위한 기록 매체 |
| CN109240324A (zh) * | 2018-11-09 | 2019-01-18 | 西北工业大学 | 一种浮力反馈下的水下滑翔机俯仰角控制方法 |
| KR101994105B1 (ko) * | 2018-11-14 | 2019-06-28 | 엘아이지넥스원 주식회사 | 바운스 경로를 결정하는 수중 글라이더 및 이를 이용하는 방법 |
| CN111813143A (zh) * | 2020-06-09 | 2020-10-23 | 天津大学 | 一种基于强化学习的水下滑翔机智能控制系统及方法 |
| CN112100834A (zh) * | 2020-09-06 | 2020-12-18 | 西北工业大学 | 一种基于深度强化学习的水下滑翔机姿态控制方法 |
| CN112363517A (zh) * | 2020-10-09 | 2021-02-12 | 中国科学院沈阳自动化研究所 | 一种水下滑翔机的编队控制方法 |
| CN112363401A (zh) * | 2020-11-29 | 2021-02-12 | 西北工业大学 | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 |
| CN112612290A (zh) * | 2020-12-06 | 2021-04-06 | 西北工业大学 | 一种考虑洋流的水下航行器三维多任务路径规划方法 |
Non-Patent Citations (1)
| Title |
|---|
| 能耗最优的水下滑翔机采样路径规划;朱心科;俞建成;王晓辉;;机器人;第33卷(第3期);第360-365页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113879495A (zh) | 2022-01-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Yang et al. | Motion parameter optimization for gliding strategy analysis of underwater gliders | |
| CN105843233B (zh) | 一种基于非线性观测器的自主水下航行器运动控制方法 | |
| CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
| Kraus | Wave glider dynamic modeling, parameter identification and simulation | |
| CN107314768A (zh) | 水下地形匹配辅助惯性导航定位方法及其定位系统 | |
| CN107942095B (zh) | 波浪滑翔器实际航向预测方法 | |
| CN103389094B (zh) | 一种改进的粒子滤波方法 | |
| CN101833338A (zh) | 无人潜航器垂直面欠驱动运动控制方法 | |
| CN108197350A (zh) | 一种无人船速度和不确定性估计系统及设计方法 | |
| CN113885534B (zh) | 一种基于智能预测控制的水面无人船路径跟踪方法 | |
| CN106054607A (zh) | 水下检测与作业机器人动力定位方法 | |
| CN109724592A (zh) | 一种基于进化梯度搜索的auv地磁仿生导航方法 | |
| CN111930141A (zh) | 一种水下机器人三维路径可视化跟踪方法 | |
| CN109946976B (zh) | 一种宽航速auv运动控制方法 | |
| CN108664039A (zh) | 基于梯度估计的自主式水下机器人场源搜索方法及系统 | |
| CN111026135A (zh) | 一种无人艇高性能航行前馈控制系统及其控制方法 | |
| Stuntz et al. | Enabling persistent autonomy for underwater gliders with ocean model predictions and terrain-based navigation | |
| CN107014374B (zh) | 一种基于互补滤波的水下滑翔器节能算法 | |
| CN115686002A (zh) | 一种复杂海域下的水面无人艇路径跟踪控制方法 | |
| Zhang et al. | Research on the maneuverability and path following control of the wave glider with a propeller-rudder system | |
| CN113879495B (zh) | 一种基于海流预测的水下滑翔机动态运动规划方法 | |
| CN111290392B (zh) | 一种过闸船舶编队协同停船控制系统及方法 | |
| CN113501114B (zh) | 一种基于深潜器无动力下潜实时信息的深海海流计算方法 | |
| CN116540717A (zh) | 一种基于改进dwa的auv局部路径规划方法 | |
| CN114253279A (zh) | 一种考虑海流环境的水下滑翔机运动规划方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |