CN112363401A - 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 - Google Patents
一种基于浮力调节的水下滑翔机自适应反演深度控制方法 Download PDFInfo
- Publication number
- CN112363401A CN112363401A CN202011366197.2A CN202011366197A CN112363401A CN 112363401 A CN112363401 A CN 112363401A CN 202011366197 A CN202011366197 A CN 202011366197A CN 112363401 A CN112363401 A CN 112363401A
- Authority
- CN
- China
- Prior art keywords
- underwater glider
- buoyancy
- depth
- glider
- underwater
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 230000003044 adaptive effect Effects 0.000 claims description 11
- 230000008859 change Effects 0.000 claims description 6
- 230000033001 locomotion Effects 0.000 claims description 5
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 5
- 230000007246 mechanism Effects 0.000 claims description 3
- 239000000126 substance Substances 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 claims description 2
- 230000013575 regulation of buoyancy Effects 0.000 claims 2
- 239000012530 fluid Substances 0.000 claims 1
- 238000004088 simulation Methods 0.000 abstract description 12
- 230000004075 alteration Effects 0.000 description 1
- 230000002457 bidirectional effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 239000003305 oil spill Substances 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 239000013535 sea water Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提出一种基于浮力调节的水下滑翔机自适应反演深度控制方法,首先计算水下滑翔机深度位置的跟踪误差,其次基于位置跟踪误差和当前水下滑翔机速度,计算速度跟踪误差,再基于位置与速度跟踪误差,得到浮力控制输入,并且为了消除中间参数估计误差对系统稳定性的影响,还设计了模型中间参数自适应律。从仿真结果来看,在本发明所提出的自适应滑模控制器控制下,水下滑翔机的深度跟踪误差收敛到零,系统能够比较好地跟踪期望信号。
Description
技术领域
本发明涉及一种水下滑翔机控制方法,具体地说是一种基于浮力调节的水下滑翔机自适应反演深度控制方法,属于水下航行器控制领域。
背景技术
水下滑翔机是一种被广泛用于海洋环境观测的无人水下观测平台。它通过调节自身浮力大小实现竖直方向的上浮和下潜运动,能够搭载各种传感器采集不同深度、不同水域的海水温度、盐度、压力等资料并通过卫星定位与数据传输系统将采集到的资料传回。这些资料对于提高气候预报的精度、预测开阔大洋上溢油的影响以及指导远洋渔业的生产等都具有极高的应用价值。因此,水下滑翔机受到了各临海国家尤其是发达国家的重视。
水下滑翔机的附加质量、阻力系数等流体动力参数往往难以精确测量。因此,水下滑翔机的动力学模型中部分参数具有不确定性。这就要求所设计的深度控制器必须具有良好的自适应能力。
发明内容
为解决现有技术存在的问题,本发明提出一种基于浮力调节的水下滑翔机自适应反演深度控制方法,包括以下步骤:
步骤1:根据给定深度指令,计算水下滑翔机深度位置的跟踪误差:
z1=z-zd
其中z、zd分别为水下滑翔机的当前深度和参考深度指令;
步骤2:基于步骤1中计算得到的位置跟踪误差和当前水下滑翔机速度,计算速度跟踪误差:
其中ur为水下滑翔机在连体坐标系中的运动速度,λ1为控制参数;
步骤3:基于步骤1和步骤2计算得到的位置与速度跟踪误差,得到如下浮力控制输入:
其中γ=m+λ11,m为水下滑翔机质量,λ11为水下滑翔机附加质量,B0为水下滑翔机初始浮力,G是水下滑翔机总重力,ΔB为浮力调节机构的浮力控制输入,初始时刻ΔB=0,d为流体动力系数,Δ(ur)为水下滑翔机竖直方向单自由度动力学模型中的未建模项;
步骤4:为了消除中间参数估计误差对系统稳定性的影响,设计模型中间参数自适应律为:
式中
其中ξ1、ξ2、ξ3为自适应参数,λ2为控制参数。
有益效果
本发明提出一种基于浮力调节的水下滑翔机自适应反演深度控制方法,从仿真结果来看,在本文所提出的自适应滑模控制器控制下,水下滑翔机的深度跟踪误差收敛到零,系统能够比较好地跟踪期望信号。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为本发明结构示意图
图2为参考指令为常值和线性输入时的深度跟踪结果
图3为参考指令为常值和线性输入时系统控制输入随时间变化曲线
图4为参考指令为正弦输入时的深度跟踪结果
图5为参考指令为正弦输入时的速度变化曲线
图6为自适应控制器对质量和附加质量之和的真值和估计值随时间的变化曲线
图7为参考指令为正弦输入时系统控制输入随时间变化曲线
具体实施方式
下面结合附图及实例对本发明做进一步的详细说明。
本发明所应用的基于浮力调节的水下滑翔机如图1所示,浮力调节装置包括可变形的内油囊和外油囊各一个,使用抽吸水泵和双向电磁阀调节两个油囊之间油液的流动,从而改变水下滑翔机本体的平均密度,实现浮力调节。这种装置调节浮力的范围较小,但易实现浮力的精确控制。
水下滑翔机竖直方向单自由度模型如下:
式中,ur为滑翔机在连体坐标系中的运动速度,m为滑翔机质量,λ11为滑翔机附加质量,B0为滑翔机初始浮力,G是滑翔机总重力,ΔB为浮力调节机构引起的浮力变化量,初始时刻ΔB=0,d为流体动力系数,Δ(ur)为水下滑翔机竖直方向单自由度动力学模型中的未建模项。
为方便讨论,将系统模型(1)简化为下式:
本发明解决方案步骤如下:
步骤1:根据给定深度指令,计算水下滑翔机深度位置的跟踪误差:
z1=z-zd (3)
其中z、zd分别为滑翔机的当前深度、参考深度指令,可以利用深度传感器测量滑翔机深度z。
步骤2:基于步骤1中计算得到的位置跟踪误差和当前滑翔机速度,计算速度跟踪误差:
其中ur为滑翔机在连体坐标系中的运动速度,λ1为控制参数。可以利用多普勒测量滑翔机纵向运动速度ur。
步骤3:基于步骤1和步骤2计算得到的位置与速度跟踪误差,进行如下浮力控制输入:
步骤4:为了消除中间参数估计误差对系统稳定性的影响,设计模型中间参数自适应律:
式中
其中ξ1、ξ2、ξ3为自适应参数,λ2为控制参数。
为了验证本发明设计的水下滑翔机自适应反演深度控制方法的有效性,通过数学仿真验证上述自适应反演滑模控制算法的性能,仿真中选取的水下滑翔机模型参数如下:m=30.5kg,λ11=0.930kg,d=3.9kg/m,B0-G=0.1k,|gΔB|≤0.5kg。假设真实环境中存在的未建模项为Δ=-2sin(ur),控制参数为:λ1=λ2=1,ηs=0.1,自适应参数为ξ1=0.0031,ξ2=0.001,ξ3=0.1。
(1)深度指令为常值和线性输入的仿真:
水下航行器的初始深度为-40m,初始速度为零,仿真时间300s,前150s参考指令为常值zd=-50m,150s到250s深度指令为线性输入,之后为常值:
仿真结果如图2~3所示,图2虚线代表参考指令,实线代表实际深度曲线,图3代表控制输入随时间变化曲线。从仿真结果来看,虽然初始深度跟踪误差和速度跟踪误差较大,但经过一段时间的调节,滑翔机稳定到期望深度,并能够较好地跟踪线性输入指令。
(2)深度指令为正弦输入的仿真:
水下航行器初始深度-40m,初始速度为零。如图4所示,给定参考深度为正弦输入:
仿真结果如图4~7所示,其中图4为水下滑翔机深度随时间的变化的仿真曲线,实线为实际深度,虚线为参考指令,图5为水下滑翔机在仿真过程中的速度变化曲线,图6为自适应控制器对质量和附加质量之和的真值和估计值随时间的变化曲线,图7为系统控制输入随时间变化曲线。
从仿真结果来看,在本文所提出的自适应滑模控制器控制下,水下滑翔机的深度跟踪误差收敛到零,系统能够比较好地跟踪期望信号。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (3)
1.一种基于浮力调节的水下滑翔机自适应反演深度控制方法,其特征在于:包括以下步骤:
步骤1:根据给定深度指令,计算水下滑翔机深度位置的跟踪误差:
z1=z-zd
其中z、zd分别为水下滑翔机的当前深度和参考深度指令;
步骤2:基于步骤1中计算得到的位置跟踪误差和当前水下滑翔机速度,计算速度跟踪误差:
其中ur为水下滑翔机在连体坐标系中的运动速度,λ1为控制参数;
步骤3:基于步骤1和步骤2计算得到的位置与速度跟踪误差,得到如下浮力控制输入:
3.根据权利要求1或2所述一种基于浮力调节的水下滑翔机自适应反演深度控制方法,其特征在于:所述水下滑翔机中的浮力调节装置包括可变形的内油囊和外油囊各一个,使用抽吸水泵和双向电磁阀调节两个油囊之间油液的流动,从而改变水下滑翔机本体的平均密度,实现浮力调节。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011366197.2A CN112363401B (zh) | 2020-11-29 | 2020-11-29 | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011366197.2A CN112363401B (zh) | 2020-11-29 | 2020-11-29 | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112363401A true CN112363401A (zh) | 2021-02-12 |
CN112363401B CN112363401B (zh) | 2022-06-07 |
Family
ID=74536194
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011366197.2A Active CN112363401B (zh) | 2020-11-29 | 2020-11-29 | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112363401B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113325857A (zh) * | 2021-06-08 | 2021-08-31 | 西北工业大学 | 基于质心与浮力系统的仿蝠鲼水下航行器定深控制方法 |
CN113879495A (zh) * | 2021-10-26 | 2022-01-04 | 西北工业大学 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107544526A (zh) * | 2017-08-07 | 2018-01-05 | 熊学军 | 油囊式水下滑翔机浮力精确控制方法 |
CN107544258A (zh) * | 2017-10-17 | 2018-01-05 | 西北工业大学 | 自主型水下航行器自适应反演控制方法 |
CN109189083A (zh) * | 2018-11-09 | 2019-01-11 | 西北工业大学 | 一种具有垂推的低速水下航行器的定深控制方法 |
CN109240324A (zh) * | 2018-11-09 | 2019-01-18 | 西北工业大学 | 一种浮力反馈下的水下滑翔机俯仰角控制方法 |
CN110427040A (zh) * | 2019-07-16 | 2019-11-08 | 哈尔滨工程大学 | 一种基于动态面滑模的欠驱动无缆水下机器人深度反步控制方法 |
CN110758698A (zh) * | 2019-11-28 | 2020-02-07 | 中国科学院自动化研究所 | 仿生滑翔机器海豚的滑翔深度控制方法、系统、装置 |
-
2020
- 2020-11-29 CN CN202011366197.2A patent/CN112363401B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107544526A (zh) * | 2017-08-07 | 2018-01-05 | 熊学军 | 油囊式水下滑翔机浮力精确控制方法 |
CN107544258A (zh) * | 2017-10-17 | 2018-01-05 | 西北工业大学 | 自主型水下航行器自适应反演控制方法 |
CN109189083A (zh) * | 2018-11-09 | 2019-01-11 | 西北工业大学 | 一种具有垂推的低速水下航行器的定深控制方法 |
CN109240324A (zh) * | 2018-11-09 | 2019-01-18 | 西北工业大学 | 一种浮力反馈下的水下滑翔机俯仰角控制方法 |
CN110427040A (zh) * | 2019-07-16 | 2019-11-08 | 哈尔滨工程大学 | 一种基于动态面滑模的欠驱动无缆水下机器人深度反步控制方法 |
CN110758698A (zh) * | 2019-11-28 | 2020-02-07 | 中国科学院自动化研究所 | 仿生滑翔机器海豚的滑翔深度控制方法、系统、装置 |
Non-Patent Citations (2)
Title |
---|
JIAN GAO 等: "Backstepping Adaptive Docking Control for a Full-Actuated Autonomous Underwater Vehicle with Onboard USBL System", 《2014 OCEANS - ST. JOHN"S》 * |
高剑 等: "一类低速水下航行器的自适应反演运动控制", 《系统仿真学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113325857A (zh) * | 2021-06-08 | 2021-08-31 | 西北工业大学 | 基于质心与浮力系统的仿蝠鲼水下航行器定深控制方法 |
CN113325857B (zh) * | 2021-06-08 | 2022-08-05 | 西北工业大学 | 基于质心与浮力系统的仿蝠鲼水下航行器定深控制方法 |
CN113879495A (zh) * | 2021-10-26 | 2022-01-04 | 西北工业大学 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
CN113879495B (zh) * | 2021-10-26 | 2024-04-19 | 西北工业大学 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112363401B (zh) | 2022-06-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105383654B (zh) | 一种自主式水下潜器的深度控制装置 | |
CN112363401B (zh) | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 | |
CN110597069B (zh) | 一种基于rbf神经网络的水下机器人自适应区域动力定位控制方法 | |
CN111547212B (zh) | 一种无动力式快速潜浮auv的浮力控制方法 | |
CN101833338B (zh) | 无人潜航器垂直面欠驱动运动控制方法 | |
CN108445762B (zh) | 基于ukf滤波和约束模型预测控制的动力定位控制方法 | |
CN107179693B (zh) | 基于Huber估计的鲁棒自适应滤波和状态估计方法 | |
CN110703601B (zh) | 一种基于模糊控制和卡尔曼滤波的浮标深度控制算法 | |
CN108490472A (zh) | 一种基于模糊自适应滤波的无人艇组合导航方法 | |
Wang et al. | Modeling and simulation of the VideoRay Pro III underwater vehicle | |
CN110286687A (zh) | 一种海浪对水下机器人扰动评估装置及方法 | |
CN109946976B (zh) | 一种宽航速auv运动控制方法 | |
CN104181815B (zh) | 一种基于环境估计的船舶运动补偿控制方法 | |
CN102854798A (zh) | 一种船舶动力定位参数自适应观测器的在线调整方法 | |
CN109579850A (zh) | 基于对水速度辅助惯导的深水智能导航方法 | |
CN108226887B (zh) | 一种观测量短暂丢失情况下的水面目标救援状态估计方法 | |
CN107101631A (zh) | 一种基于自适应滤波技术的舰船升沉测量方法 | |
CN111025909B (zh) | 船舶运动控制系统的Kalman三自由度解耦滤波方法 | |
CN109521798A (zh) | 基于有限时间扩张状态观测器的auv运动控制方法 | |
CN106527454B (zh) | 一种无稳态误差的远程水下航行器定深控制方法 | |
CN109752086B (zh) | 基于bellhop的快速声场计算方法 | |
CN113479304B (zh) | 多舵面水下拖曳式航行器的平行潜浮与相对潜浮一体化深度控制系统及方法 | |
CN110837254B (zh) | 一种水翼艇纵向运动控制方法 | |
Rusello et al. | Improving depth averaged velocity measurements from seaglider with an advanced acoustic current profiler, the nortek ad2cp-glider | |
CN112363169B (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 |