CN109933080A - 一种具有浮力调节功能的水下机器人潜浮运动控制方法 - Google Patents
一种具有浮力调节功能的水下机器人潜浮运动控制方法 Download PDFInfo
- Publication number
- CN109933080A CN109933080A CN201711345449.1A CN201711345449A CN109933080A CN 109933080 A CN109933080 A CN 109933080A CN 201711345449 A CN201711345449 A CN 201711345449A CN 109933080 A CN109933080 A CN 109933080A
- Authority
- CN
- China
- Prior art keywords
- control
- target
- trim
- floating
- dive
- 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
Landscapes
- Other Liquid Machine Or Engine Such As Wave Power Use (AREA)
Abstract
本发明涉及一种具有浮力调节功能的水下机器人潜浮运动控制方法,实现UUV在各海况条件下从水面漂浮到完全浸没、低功耗下潜和下潜预先制动共三个阶段的下潜运动以及上浮启动、低功耗上浮和上浮预先制动共三个阶段的上浮运动。本发明包括下潜运动控制和上浮运动控制;与以往的潜浮控制方法比较,本方法具有更好的适应性和鲁棒性,更能适应外界环境的变化,提高了水下机器人的潜浮控制能力。本方法通用性强,可适用于各种水下机器人。
Description
技术领域
本发明涉及水下机器人技术领域,尤其涉及具有浮力调节功能的水下机器人潜浮运动控制方法,实现对UUV的垂直面运动控制。
背景技术
在海洋开发和利用中,水下机器人的应用越来越广泛。传统UUV潜浮控制方法主要采用自动控制方法和对执行结构进行控制力分配,或者固定负浮力配重无动力下潜和抛掉上浮压载后直接上浮至水面,前一种方法的优点是,后一种方法的优点是算法简单。UUV的衡重变化引起浮力状态的改变以及当AUV的外界条件发生改变时,经典线性控制理论的控制方法控制性能急剧下降。本发明采用自动控制理论与固定浮力状态相结合的方法,更加适合易受自身衡重状态和外界环境改变影响的UUV应用。
发明内容
为了克服以往水下机器人潜浮运动功耗较高或者不能在允许的深度范围内任意深度潜浮的问题,本发明要解决的技术问题提供一种具有浮力调节功能的水下机器人潜浮运动控制方法,降低潜浮运动的功耗且能在水下机器人允许到达的深度范围内任意深度进行潜浮运动。
本发明为实现上述目的所采用的技术方案是:一种具有浮力调节功能的水下机器人潜浮运动控制方法,包括上浮运动控制和下潜运动控制;
所述下潜运动控制包括从水面漂浮到完全浸没控制、低功耗下潜和预先制动控制;
所述从水面漂浮到完全浸没控制采用垂向速度闭环控制、纵倾角闭环控制;
所述低功耗下潜控制采用固定活塞位置控制;
所述下潜预先制动控制采用深度闭环控制、纵倾角闭环控制;
所述上浮运动控制包括上浮启动控制、低功耗上浮控制和预先制动控制;
所述上浮启动控制采用垂向速度闭环控制、纵倾角闭环控制;
所述低功耗上浮控制采用固定活塞位置控制;
所述上浮预先制动控制采用深度闭环控制、纵倾角闭环控制。
所述从水面漂浮到完全浸没控制的方法如下:
其中,Tv是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为v或p;vr和pr分别是UUV的目标垂向速度和目标纵倾角;v和p分别是UUV的实际垂向速度和实际纵倾角。
所述低功耗下潜控制的方法如下:
F_=ρ*g*π*D2/4*(Z-Z0)
其中,F_是垂向负浮力;ρ是当前试验水域的水密度;g是重力加速度,π为圆周率;D为圆筒型浮力调节装置的内直径;Z为圆筒型浮力调节装置内的活塞位置,且Z<Z0;Z0为人为设定的圆筒型浮力调节装置内的浮力为零的活塞位置。
所述下潜预先制动控制的方法如下:
其中,Td是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为d或p;dr和pr分别是UUV的目标深度和目标纵倾角;d和p分别是UUV的实际深度和实际纵倾角。
所述上浮启动控制的方法如下:
其中,Tv是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为v或p;vr和pr分别是UUV的目标垂向速度和目标纵倾角;v和p分别是UUV的实际垂向速度和实际纵倾角。
所述低功耗上浮控制的方法如下:
F+=ρ*g*π*D2/4*(Z-Z0)
其中,F+是垂向正浮力;ρ是当前试验水域的水密度;g是重力加速度,π为圆周率;D为圆筒型浮力调节装置的内直径;Z为圆筒型浮力调节装置内的活塞位置,且Z>Z0;Z0为人为设定的圆筒型浮力调节装置内的浮力为零的活塞位置。
所述上浮预先制动控制的方法如下:
其中,Td是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为d或p;dr和pr分别是UUV的目标深度和目标纵倾角;d和p分别是UUV的实际深度和实际纵倾角。
本发明具有以下有益效果及优点
1.下潜上浮过程节省能耗。相比以往的潜浮控制方法,本方法在下潜上浮过程中,调整好UUV上浮下潜姿态和速度后关闭浮力调节装置电源,对于大深度下潜上浮过程能明显节省能耗。
2.适应自身衡重不准和各种海况环境变化。当外界环境发生改变时,如外界海面涌流的变化,以往的潜浮控制方法会下潜上浮速度减慢,甚至难以上浮下潜以致触发故障;本方法具有更好的鲁棒性,更好地适应自身衡重和外界环境的改变。
3.应用范围广泛。本发明不但可用于UUV,还可用于各种水下机器人的运动控制。
附图说明
图1是本发明的下潜三个阶段过程示意图。
图2是本发明的上浮三个阶段过程示意图。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
本发明的下潜运动控制包括D1,D2,D3三个阶段控制,如图1所示;上浮运动控制包括U1,U2,U3三个阶段控制,如图2所示。
本发明的潜浮运动控制方法包括以下几个内容:
(1)下潜运动控制包括从水面漂浮到完全浸没控制、低功耗下潜和下潜预先制动控制三个阶段控制。
第一阶段:从水面漂浮到完全浸没控制,采用垂向速度闭环控制和纵倾角闭环控制,其具体控制方法如下:
其中,Tv是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为v或p;vr和pr分别是UUV的目标垂向速度和目标纵倾角;v和p分别是UUV的实际垂向速度和实际纵倾角。
第二阶段:低功耗下潜控制采用固定负浮力的位置控制,其具体控制方法如下:
F-=ρ*g*π*D2/4*(Z-Z0)
其中,F-是垂向负浮力;ρ是当前试验水域的水密度;g是重力加速度,一般约为9.8;π为圆周率;D为圆筒型浮力调节装置的内直径;Z为圆筒型浮力调节装置内的活塞位置,且Z<Z0;Z0为人为设定的圆筒型浮力调节装置内的浮力为零的活塞位置。
第三阶段:下潜预先制动控制采用深度闭环控制和纵倾角闭环控制,其具体控制方法如下:
其中,Td是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为d或p;dr和pr分别是UUV的目标深度和目标纵倾角;d和p分别是UUV的实际深度和实际纵倾角。
(2)上浮运动控制包括上浮启动控制、低功耗上浮控制和上浮预先制动控制三个阶段控制。。
第一阶段:上浮启动控制采用垂向速度闭环控制和纵倾角闭环控制,其具体控制方法如下:
其中,Tv是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为v或p;vr和pr分别是UUV的目标垂向速度和目标纵倾角;v和p分别是UUV的实际垂向速度和实际纵倾角。
第二阶段:低功耗上浮控制采用固定正浮力的位置控制,其具体控制方法如下:
F+=ρ*g*π*D2/4*(Z-Z0)
其中,F+是垂向正浮力;ρ是当前试验水域的水密度;g是重力加速度,一般约为9.8;π为圆周率;D为圆筒型浮力调节装置的内直径;Z为圆筒型浮力调节装置内的活塞位置,且Z>Z0;Z0为人为设定的圆筒型浮力调节装置内的浮力为零的活塞位置。
第三阶段:上浮预先制动控制采用深度闭环控制和纵倾角闭环控制,其具体控制方法如下:
其中,Td是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为d或p;dr和pr分别是UUV的目标深度和目标纵倾角;d和p分别是UUV的实际深度和实际纵倾角。
Claims (7)
1.一种具有浮力调节功能的水下机器人潜浮运动控制方法,其特征在于,包括上浮运动控制和下潜运动控制;
所述下潜运动控制包括从水面漂浮到完全浸没控制、低功耗下潜和预先制动控制;所述从水面漂浮到完全浸没控制采用垂向速度闭环控制、纵倾角闭环控制;所述低功耗下潜控制采用固定活塞位置控制;所述下潜预先制动控制采用深度闭环控制、纵倾角闭环控制;
所述上浮运动控制包括上浮启动控制、低功耗上浮控制和预先制动控制所述上浮启动控制采用垂向速度闭环控制、纵倾角闭环控制;所述低功耗上浮控制采用固定活塞位置控制;所述上浮预先制动控制采用深度闭环控制、纵倾角闭环控制。
2.根据权利要求1所述的一种具有浮力调节功能的水下机器人潜浮运动控制方法,其特征在于,所述从水面漂浮到完全浸没控制的方法如下:
其中,Tv是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为v或p;vr和pr分别是UUV的目标垂向速度和目标纵倾角;v和p分别是UUV的实际垂向速度和实际纵倾角。
3.根据权利要求1所述的一种具有浮力调节功能的水下机器人潜浮运动控制方法,其特征在于,所述低功耗下潜控制的方法如下:
F_=ρ*g*π*D2/4*(Z-Z0)
其中,F_是垂向负浮力;ρ是当前试验水域的水密度;g是重力加速度,π为圆周率;D为圆筒型浮力调节装置的内直径;Z为圆筒型浮力调节装置内的活塞位置,且Z<Z0;Z0为人为设定的圆筒型浮力调节装置内的浮力为零的活塞位置。
4.根据权利要求1所述的一种具有浮力调节功能的水下机器人潜浮运动控制方法,其特征在于,所述下潜预先制动控制的方法如下:
其中,Td是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为d或p;dr和pr分别是UUV的目标深度和目标纵倾角;d和p分别是UUV的实际深度和实际纵倾角。
5.根据权利要求1所述的一种具有浮力调节功能的水下机器人(UUV)潜浮运动控制方法,其特征在于,所述上浮启动控制的方法如下:
其中,Tv是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为v或p;vr和pr分别是UUV的目标垂向速度和目标纵倾角;v和p分别是UUV的实际垂向速度和实际纵倾角。
6.根据权利要求1所述的一种具有浮力调节功能的水下机器人潜浮运动控制方法,其特征在于,所述低功耗上浮控制的方法如下:
F+=ρ*g*π*D2/4*(Z-Z0)
其中,F+是垂向正浮力;ρ是当前试验水域的水密度;g是重力加速度,π为圆周率;D为圆筒型浮力调节装置的内直径;Z为圆筒型浮力调节装置内的活塞位置,且Z>Z0;Z0为人为设定的圆筒型浮力调节装置内的浮力为零的活塞位置。
7.根据权利要求1所述的一种具有浮力调节功能的水下机器人潜浮运动控制方法,其特征在于,所述上浮预先制动控制的方法如下:
其中,Td是目标垂向力,τp是目标纵倾力矩;K*_p、K*_d和K*_i分别是比例、微分和积分项系数,*为d或p;dr和pr分别是UUV的目标深度和目标纵倾角;d和p分别是UUV的实际深度和实际纵倾角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711345449.1A CN109933080B (zh) | 2017-12-15 | 2017-12-15 | 一种具有浮力调节功能的水下机器人潜浮运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711345449.1A CN109933080B (zh) | 2017-12-15 | 2017-12-15 | 一种具有浮力调节功能的水下机器人潜浮运动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109933080A true CN109933080A (zh) | 2019-06-25 |
CN109933080B CN109933080B (zh) | 2021-07-27 |
Family
ID=66979497
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711345449.1A Active CN109933080B (zh) | 2017-12-15 | 2017-12-15 | 一种具有浮力调节功能的水下机器人潜浮运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109933080B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113799949A (zh) * | 2020-06-11 | 2021-12-17 | 中国科学院沈阳自动化研究所 | 一种基于q学习的auv浮力调节方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000211583A (ja) * | 1999-01-21 | 2000-08-02 | Nec Corp | 潜水船の深度保持制御方式 |
CN105383654A (zh) * | 2015-10-30 | 2016-03-09 | 哈尔滨工程大学 | 一种自主式水下潜器的深度控制装置 |
CN105404303A (zh) * | 2015-12-28 | 2016-03-16 | 河海大学常州校区 | 一种rov水下机器人的运动控制方法 |
CN105573327A (zh) * | 2016-03-02 | 2016-05-11 | 哈尔滨工程大学 | 基于t-s模糊时滞模型的欠驱动uuv垂直面控制方法 |
CN105717936A (zh) * | 2014-11-30 | 2016-06-29 | 中国科学院沈阳自动化研究所 | 一种无缆自治水下机器人的潜浮控制方法 |
-
2017
- 2017-12-15 CN CN201711345449.1A patent/CN109933080B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000211583A (ja) * | 1999-01-21 | 2000-08-02 | Nec Corp | 潜水船の深度保持制御方式 |
CN105717936A (zh) * | 2014-11-30 | 2016-06-29 | 中国科学院沈阳自动化研究所 | 一种无缆自治水下机器人的潜浮控制方法 |
CN105383654A (zh) * | 2015-10-30 | 2016-03-09 | 哈尔滨工程大学 | 一种自主式水下潜器的深度控制装置 |
CN105404303A (zh) * | 2015-12-28 | 2016-03-16 | 河海大学常州校区 | 一种rov水下机器人的运动控制方法 |
CN105573327A (zh) * | 2016-03-02 | 2016-05-11 | 哈尔滨工程大学 | 基于t-s模糊时滞模型的欠驱动uuv垂直面控制方法 |
Non-Patent Citations (3)
Title |
---|
SERGE L R,等: "‘‘Deep-Arvor’’: A New Profiling Float to Extend the Argo Observations", 《IEEE》 * |
周丽丽 等: "水下机器人嵌入式控制系统设计和运动控制仿真", 《工业控制与应用》 * |
武建国 等: "基于浮力调节的液压系统动态特性仿真", 《海洋技术学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113799949A (zh) * | 2020-06-11 | 2021-12-17 | 中国科学院沈阳自动化研究所 | 一种基于q学习的auv浮力调节方法 |
CN113799949B (zh) * | 2020-06-11 | 2022-07-26 | 中国科学院沈阳自动化研究所 | 一种基于q学习的auv浮力调节方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109933080B (zh) | 2021-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105383654B (zh) | 一种自主式水下潜器的深度控制装置 | |
CN105644743B (zh) | 一种三体构型的长期定点观测型水下机器人 | |
CN106542071B (zh) | 用于长航程auv的浮力及姿态均衡控制方法 | |
US20090241826A1 (en) | Submersible vehicles and methods for transiting the same in a body of liquid | |
JP5504499B2 (ja) | ソーラー水中グライダー及びその潜航方法 | |
CN110803270B (zh) | Auv的浮力调节装置及控制方法 | |
CN206171736U (zh) | 一种可变形半潜式无人船 | |
CN102975835A (zh) | 海水活塞调节式滑翔式潜水器 | |
CN111547212A (zh) | 一种无动力式快速潜浮auv的浮力控制方法 | |
CN108357656B (zh) | 油囊与推进器混合控制rov水下悬停及定深控制装置 | |
CN105539784B (zh) | 一种蹼翼型波浪能水下滑翔测量平台及测量方法 | |
JP2016523340A (ja) | 潮流発電機の多機能搭載装置及びその使用方法 | |
CN113734393A (zh) | 基于攻角法的仿生机器鱼定深控制方法和装置 | |
CN109933080A (zh) | 一种具有浮力调节功能的水下机器人潜浮运动控制方法 | |
US11167828B2 (en) | Method for controlling the buoyancy of a submarine vehicle | |
CN205378034U (zh) | 漂浮拍摄装置 | |
CN207482160U (zh) | 一种水下目标跟踪装置 | |
CN109367741A (zh) | 一种可变形无人潜航器及其使用方法 | |
CN109018278B (zh) | 适用于全海深auv的无纵倾无动力下潜方法及抑制纵倾装置 | |
CN112937765A (zh) | 一种小型漂浮式波浪能装置的复合锚固系统及避险方法 | |
CN109213180B (zh) | 立扁体auv下潜过程中的安全抛载及深度控制方法 | |
CN206644972U (zh) | 一种用于欠驱动uuv的定深悬浮系统 | |
CN106672182A (zh) | 一种水下潜碟 | |
CN110683026A (zh) | 一种海流驱动的飞翼型拖鱼 | |
CN205293034U (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 |