CN109240324A - 一种浮力反馈下的水下滑翔机俯仰角控制方法 - Google Patents
一种浮力反馈下的水下滑翔机俯仰角控制方法 Download PDFInfo
- Publication number
- CN109240324A CN109240324A CN201811333795.2A CN201811333795A CN109240324A CN 109240324 A CN109240324 A CN 109240324A CN 201811333795 A CN201811333795 A CN 201811333795A CN 109240324 A CN109240324 A CN 109240324A
- Authority
- CN
- China
- Prior art keywords
- underwater glider
- pitch angle
- buoyancy
- feedback
- control
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 18
- 238000005259 measurement Methods 0.000 claims description 3
- 238000004088 simulation Methods 0.000 abstract description 5
- 230000004044 response Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000012423 maintenance Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 229910052500 inorganic mineral Inorganic materials 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 239000011707 mineral Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001141 propulsive effect Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000010025 steaming Methods 0.000 description 1
- 201000002282 venous insufficiency Diseases 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提出一种浮力反馈下的水下滑翔机俯仰角控制方法,根据预设俯仰角θr与水下滑翔机实际俯仰角θ之间偏差,设计PID控制器,得出俯仰角误差反馈下的ri。同时,加上稳态俯仰角下的滑块位置rc,再加上基于实时的浮力反馈kbmb,得出修正后的控制输入ric,将其作用于水下滑翔机,实现对水下滑翔机的控制。通过与无浮力反馈下的俯仰角控制对比仿真,验证了本发明所提算法的有效性。
Description
技术领域
本发明属于水下航行器控制领域,具体涉及一种浮力反馈下的水下滑翔机俯仰角控制方法。
背景技术
无人潜水器在可广泛用于海底生物资源探查,矿产资源采样,海底地形勘测,沉物打捞,地震地热活动监测,海洋环境监测,海洋工程维护等。
水下滑翔机是一种新型的水下机器人,是典型的海洋探测平台。由于其利用净浮力和姿态角调整获得推进力,能源消耗极小,只在调整净浮力和姿态角时消耗少量能源,并且具有效率高、续航力大(可达上千公里)的特点。虽然水下滑翔机的航行速度较慢,但其制造成本和维护费用低、可重复使用、并可大量投放等特点,满足了长时间、大范围海洋探索的需要。
水下滑翔机通常通过浮力驱动来控制净浮力,通过内部滑块前后移动控制俯仰角,同时,通过尾舵或者内部滑块侧移完成转向控制。水下滑翔机是一个强耦合、非线性的欠驱动复杂系统,良好的控制系统是保证稳定航行的前提条件。因此,研究水下滑翔机的俯仰控制策略具有非常重要的现实意义。
但在实际工程验证过程中,申请人发现水下滑翔机的俯仰角控制还存在以下两个新问题:1、由于变浮力调节机构制作误差等原因,其会导致额外俯仰力矩干扰,不利于俯仰角控制;2、变浮力响应速率远低于滑块响应速率,在浮力切换瞬间,两者响应速率的不协调会导致较大的初始俯仰角误差。
发明内容
本发明针对浮力变化会影响俯仰角且浮力响应慢等问题,提出了基于浮力反馈下的水下滑翔机俯仰角PID控制方法。
本发明中控制策略是根据预设俯仰角θr与水下滑翔机实际俯仰角θ之间偏差,设计PID控制器,得出俯仰角误差反馈下的ri。同时,加上稳态俯仰角下的滑块位置rc,再加上基于实时的浮力反馈kbmb,得出修正后的控制输入ric,将其作用于水下滑翔机,实现对水下滑翔机的控制。通过与无浮力反馈下的俯仰角控制对比仿真,验证了本发明所提算法的有效性。
本发明的技术方案为:
所述一种浮力反馈下的水下滑翔机俯仰角控制方法,其特征在于:包括以下步骤:
步骤1:水下滑翔机在开始滑翔前,根据实际需求预置滑翔指令参数xr=(θr,vr)T,其中θr为期望滑翔俯仰角,vr为期望的滑翔速度;
步骤2:将给定的滑翔指令xr=(θr,vr)T输入至水下滑翔机稳态运动控制方程中,计算出该系统的稳态输出rc,其中rc为稳态输出的滑块位置;
步骤3:测量水下滑翔机在实际滑翔阶段的俯仰角θ,得到预设俯仰角θr与水下滑翔机实际俯仰角θ之间偏差,采用PID控制器对水下滑翔机的俯仰角进行闭环控制,得到俯仰角误差反馈下的ri,其中ri为由俯仰角误差所产生的滑块位置偏移量:
kp,ki,kd分别为PID控制中的比例、积分和微分系数;Δθ=θ-θr;
步骤4:根据步骤2得到的稳态输出的滑块位置rc,步骤3得到的俯仰角误差所产生的滑块位置偏移量ri,通过以下公式得到修正后的滑块位置控制量ric
ric=ri+rc+kbmb
其中kb为设定的常数,mb为测量得到的水下滑翔机在实际滑翔阶段的浮力值;
步骤5:将步骤4得到的修正后的滑块位置控制量ric输入水下滑翔机俯仰控制系统中,实现水下滑翔机俯仰角控制。
有益效果
相对现有技术,本发明具有如下优点及效果:
本发明所述的控制方法利用浮力的实时反馈值,来修正浮力变化引起的俯仰角误差,补偿变浮力速率与滑块移动速率不协调造成的影响,保证能滑稳定控制滑翔机的俯仰角。
本发明适用于变浮力驱动与俯仰通道存在耦合干扰下的水下滑翔机的俯仰角控制,具有控制参数少,易于调节,自适应能力强,结构简单,控制精度高,易于工程实现等优点。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1是本发明中飞翼式水下滑翔机的侧向运动控制器框图。
图2是基于浮力反馈下水下滑翔机采用PID控制方法、无浮力反馈与期望的俯仰角随时间的变化曲线。
图3是基于浮力反馈下水下滑翔机采用PID控制方法与无浮力反馈下的滑块位置随时间的变化曲线。
图4是仿真过程中浮力的实时反馈。
具体实施方式
下面详细描述本发明的实施例,所述实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
步骤1:水下滑翔机在开始滑翔前,根据实际需求预置滑翔指令参数xr=(θr,vr)T,其中θr为期望滑翔俯仰角,vr为期望的滑翔速度;
本实施例中,根据实际需求预置滑翔指令参数xr=(θr,vr)T,其中,θr为期望滑翔俯仰角,vr为期望的滑翔速度。预设第一阶段期望俯仰角θr=-23°,第二阶段期望俯仰角θr=32°,第三阶段期望俯仰角θr=-25°,第四阶段期望俯仰角θr=35°。期望的滑翔速度vr=0.3m/s,初始俯仰角θ=22.9°。
步骤2:将给定的滑翔指令xr=(θr,vr)T输入至水下滑翔机稳态运动控制方程中,计算出该系统的稳态输出rc,其中rc为稳态输出的滑块位置。水下滑翔机稳态运动控制方程采用的是水下滑翔机领域中常规的控制方程,在已有公开文献中已为本领域技术人员所公知。
本发明中控制策略是根据预设俯仰角θr与水下滑翔机实际俯仰角θ之间偏差,设计PID控制器,得出俯仰角误差反馈下的ri。同时,加上步骤2中稳态俯仰角下的滑块位置rc,再加上实时反馈的浮力kbmb,得出修正后的控制输入ric,将其作用于水下滑翔机,实现对水下滑翔机的控制。
步骤3:测量水下滑翔机在实际滑翔阶段的俯仰角θ,得到预设俯仰角θr与水下滑翔机实际俯仰角θ之间偏差,采用PID控制器对水下滑翔机的俯仰角进行闭环控制,得到俯仰角误差反馈下的ri,其中ri为由俯仰角误差所产生的滑块位置偏移量:
kp,ki,kd分别为PID控制中的比例、积分和微分系数;Δθ=θ-θr;
步骤4:根据步骤2得到的稳态输出的滑块位置rc,步骤3得到的俯仰角误差所产生的滑块位置偏移量ri,通过以下公式得到修正后的滑块位置控制量ric
ric=ri+rc+kbmb
其中kb为设定的常数,mb为测量得到的水下滑翔机在实际滑翔阶段的浮力值;
步骤5:将步骤4得到的修正后的滑块位置控制量ric输入水下滑翔机俯仰控制系统中,实现水下滑翔机俯仰角控制。
通过与无浮力反馈的控制算法仿真对比,验证了基于浮力反馈下的滑翔机俯仰角PID控制方法的有效性。
从仿真图2中可以看出,在无浮力反馈下,由于存在变浮力响应速率远低于滑块响应速率的问题,在浮力切换瞬间,两者响应速率的不协调导致了较大的俯仰角误差。而在采用了基于浮力反馈下的滑翔机俯仰角PID控制方法之后,可以明显看出解决了由于变浮力而产生的较大俯仰角误差的问题。
从仿真图3可以看出,在采用了基于浮力反馈下的滑翔机俯仰角PID控制方法之后,与无浮力反馈控制方法相比,滑块位置趋向于稳定状态的速率明显减小,证明了基于浮力反馈下的滑翔机俯仰角PID控制方法的有效性。
从仿真图4中可以看出在仿真过程中水下滑翔机的浮力实时反馈值。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (1)
1.一种浮力反馈下的水下滑翔机俯仰角控制方法,其特征在于:包括以下步骤:
步骤1:水下滑翔机在开始滑翔前,根据实际需求预置滑翔指令参数xr=(θr,vr)T,其中θr为期望滑翔俯仰角,vr为期望的滑翔速度;
步骤2:将给定的滑翔指令xr=(θr,vr)T输入至水下滑翔机稳态运动控制方程中,计算出该系统的稳态输出rc,其中rc为稳态输出的滑块位置;
步骤3:测量水下滑翔机在实际滑翔阶段的俯仰角θ,得到预设俯仰角θr与水下滑翔机实际俯仰角θ之间偏差,采用PID控制器对水下滑翔机的俯仰角进行闭环控制,得到俯仰角误差反馈下的ri,其中ri为由俯仰角误差所产生的滑块位置偏移量:
kp,ki,kd分别为PID控制中的比例、积分和微分系数;Δθ=θ-θr;
步骤4:根据步骤2得到的稳态输出的滑块位置rc,步骤3得到的俯仰角误差所产生的滑块位置偏移量ri,通过以下公式得到修正后的滑块位置控制量ric
ric=ri+rc+kbmb
其中kb为设定的常数,mb为测量得到的水下滑翔机在实际滑翔阶段的浮力值;
步骤5:将步骤4得到的修正后的滑块位置控制量ric输入水下滑翔机俯仰控制系统中,实现水下滑翔机俯仰角控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811333795.2A CN109240324A (zh) | 2018-11-09 | 2018-11-09 | 一种浮力反馈下的水下滑翔机俯仰角控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811333795.2A CN109240324A (zh) | 2018-11-09 | 2018-11-09 | 一种浮力反馈下的水下滑翔机俯仰角控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109240324A true CN109240324A (zh) | 2019-01-18 |
Family
ID=65077945
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811333795.2A Pending CN109240324A (zh) | 2018-11-09 | 2018-11-09 | 一种浮力反馈下的水下滑翔机俯仰角控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109240324A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110309571A (zh) * | 2019-06-24 | 2019-10-08 | 西北工业大学 | 基于径向基函数模型的翼身融合水下滑翔机外形优化方法 |
CN112363401A (zh) * | 2020-11-29 | 2021-02-12 | 西北工业大学 | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 |
CN113879495A (zh) * | 2021-10-26 | 2022-01-04 | 西北工业大学 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
CN114527657A (zh) * | 2022-02-06 | 2022-05-24 | 西北工业大学 | 一种基于高斯过程的水下滑翔机系统辨识方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101315563A (zh) * | 2007-05-31 | 2008-12-03 | 中国科学院自动化研究所 | 基于重心改变的仿生机器鱼深度控制方法 |
CN104793625A (zh) * | 2015-04-17 | 2015-07-22 | 西北工业大学 | 一种自主水下航行器动态抗饱和俯仰角控制方法 |
US20170029082A1 (en) * | 2014-04-08 | 2017-02-02 | Mrv Systems, Llc. | Underwater vehicles configured to perform vertical profiling and diagonal profiling, and corresponding methods of operation |
CN107544258A (zh) * | 2017-10-17 | 2018-01-05 | 西北工业大学 | 自主型水下航行器自适应反演控制方法 |
-
2018
- 2018-11-09 CN CN201811333795.2A patent/CN109240324A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101315563A (zh) * | 2007-05-31 | 2008-12-03 | 中国科学院自动化研究所 | 基于重心改变的仿生机器鱼深度控制方法 |
US20170029082A1 (en) * | 2014-04-08 | 2017-02-02 | Mrv Systems, Llc. | Underwater vehicles configured to perform vertical profiling and diagonal profiling, and corresponding methods of operation |
CN104793625A (zh) * | 2015-04-17 | 2015-07-22 | 西北工业大学 | 一种自主水下航行器动态抗饱和俯仰角控制方法 |
CN107544258A (zh) * | 2017-10-17 | 2018-01-05 | 西北工业大学 | 自主型水下航行器自适应反演控制方法 |
Non-Patent Citations (3)
Title |
---|
NINA MAHMOUDIAN 等: "Underwater Glider Motion Control", 《PROCEEDINGS OF THE 47TH IEEE CONFERENCE ON DECISION AND CONTROL》 * |
张福斌 等: "水下滑翔机建模与运动PID控制 ", 《鱼雷技术》 * |
陈宇航 等: "水下滑翔机纵倾运动的自适应积分反演控制 ", 《兵工学报》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110309571A (zh) * | 2019-06-24 | 2019-10-08 | 西北工业大学 | 基于径向基函数模型的翼身融合水下滑翔机外形优化方法 |
CN110309571B (zh) * | 2019-06-24 | 2022-02-11 | 西北工业大学 | 基于径向基函数模型的翼身融合水下滑翔机外形优化方法 |
CN112363401A (zh) * | 2020-11-29 | 2021-02-12 | 西北工业大学 | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 |
CN112363401B (zh) * | 2020-11-29 | 2022-06-07 | 西北工业大学 | 一种基于浮力调节的水下滑翔机自适应反演深度控制方法 |
CN113879495A (zh) * | 2021-10-26 | 2022-01-04 | 西北工业大学 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
CN113879495B (zh) * | 2021-10-26 | 2024-04-19 | 西北工业大学 | 一种基于海流预测的水下滑翔机动态运动规划方法 |
CN114527657A (zh) * | 2022-02-06 | 2022-05-24 | 西北工业大学 | 一种基于高斯过程的水下滑翔机系统辨识方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109240324A (zh) | 一种浮力反馈下的水下滑翔机俯仰角控制方法 | |
CN109976349B (zh) | 一种含约束无人船的路径跟踪制导与控制结构的设计方法 | |
CN106444794B (zh) | 一种无参数欠驱动uuv垂直面路径跟踪滑模控制方法 | |
CN104898688B (zh) | Uuv四自由度动力定位自适应抗扰滑模控制系统及控制方法 | |
CN108594639B (zh) | 一种基于强化学习的全垫升气垫船航迹跟踪控制方法 | |
CN102331717A (zh) | 一种船舶航速智能控制方法 | |
US10437204B2 (en) | Method and system for dynamic positioning of instrumented cable towed in water | |
CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
CN102385316A (zh) | 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法 | |
CN108267955A (zh) | 面向无人艇自主靠泊的运动控制方法 | |
CN110032197A (zh) | 一种基于有限时间制导和控制的无人船路径跟踪控制方法 | |
Claus et al. | Analysis and development of a buoyancy-pitch based depth control algorithm for a hybrid underwater glider | |
Loc et al. | Development and control of a new AUV platform | |
Xiao et al. | Online speed optimization for sailing yachts using extremum seeking | |
CN105807789A (zh) | 基于t-s模糊观测器补偿的uuv控制方法 | |
CN105786007B (zh) | 一种垂直/短距起降飞机飞行控制系统 | |
CN108873923B (zh) | 应急指挥控制固定翼无人机舰面紧急起飞控制方法 | |
CN105549611A (zh) | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 | |
CN108829102B (zh) | 自适应艏向信息融合的波浪滑翔器航向控制方法 | |
KR101658112B1 (ko) | 수중글라이더의 글라이딩 안정화 방법 | |
CN111414011B (zh) | 考虑执行机构故障的高超声速飞行器保性能容错控制方法 | |
CN109189083A (zh) | 一种具有垂推的低速水下航行器的定深控制方法 | |
Ullah et al. | Effect of waves and current on motion control of underwater gliders | |
CN109521798B (zh) | 基于有限时间扩张状态观测器的auv运动控制方法 | |
CN109856965A (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190118 |