CN103064288A - 一种基于对转桨加鳍舵的低速auv航行控制方法 - Google Patents
一种基于对转桨加鳍舵的低速auv航行控制方法 Download PDFInfo
- Publication number
- CN103064288A CN103064288A CN2012104872823A CN201210487282A CN103064288A CN 103064288 A CN103064288 A CN 103064288A CN 2012104872823 A CN2012104872823 A CN 2012104872823A CN 201210487282 A CN201210487282 A CN 201210487282A CN 103064288 A CN103064288 A CN 103064288A
- Authority
- CN
- China
- Prior art keywords
- rudder
- angle
- auv
- oar
- control method
- 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
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种基于对转桨加鳍舵的低速AUV航行控制方法,AUV(Autonomous Underwater Vehicle,自治水下航行器)载体的艉部安装对转螺旋桨(简称对转桨)和水平舵垂直舵。在每个控制周期内,对纵倾角、航向角、纵倾角速度、航向角速度、深度、高度进行测量,计算出控制值,确定所需水平舵角和垂直舵角的角度值,并控制水平舵电机和垂直舵电机,使得水平舵板和垂直舵板转动到目标角度;确定对转桨的转速,使对转桨达到目标转速。从而使AUV能够稳定的航行。本发明逻辑简单、计算量小,操作方便。
Description
技术领域
本发明涉及低速AUV控制方法,特别是一种基于对转桨加鳍舵的低速AUV航行控制方法。
背景技术
在满足一定的机动性要求情况下,通过减少推进器数量的配置,保持AUV外形的光顺从而达到降低其航行阻力的目的。常见的方法之一就是在AUV的艉部配置一个对转螺旋桨(简称对转桨),通过水平舵和垂直舵对AUV水平面和垂直面的机动性进行控制。在一定的舵板面积和操舵角度下,这种方式在航行体航速较高时,其机动控制能力较强,而在航速较低时,其机动控制能力就较差。由于海洋中干扰因素众多,因此低速航行时抗外界干扰能力较弱,AUV常常难以稳定航行。
发明内容
本发明的主要目的在于提供一种基于对转桨加鳍舵的低速AUV航行控制方法,通过周期性控制调整,保证AUV稳定航行。
为了达到上述目的,本发明提出的技术方案为:
一种基于对转桨加鳍舵的低速AUV航行控制方法,在AUV的艉部安装对转桨、水平舵和垂直舵,对AUV的对转桨转速、水平舵板角度和垂直舵板角度做周期性调整,具体步骤如下:
步骤1:AUV下潜前,保持与海水间的相对速度不变;
步骤2:AUV下潜过程中,通过改变载体的纵倾角和前向速度来控制下潜速度;
步骤3:AUV水下航行过程中,在每个控制周期内,对纵倾角、航向角、纵倾角速度、航向角速度、深度、高度进行测量,采用混合计算方法计算出控制值;
步骤4:根据控制值并通过对舵板水动力特性的分析确定水平舵角和垂直舵角的目标角度,并通过水平舵电机和垂直舵电机,控制水平舵板和垂直舵板转动到目标角度;
步骤5:通过对对转桨的水动力特性、AUV的水动力特性及目标前向速度确定对转桨的目标转速,控制对转桨达到目标转速,结束调整周期。
所述混合计算方法为纵倾角的比例微分算法、深度/高度的比例积分算法和航向的比例微分积分算法的混合计算方法。
所述纵倾角的比例微分算法、深度/高度的比例积分算法公式为:
其中:QK表示垂直力矩;KP1、Kd1分别表示纵倾角误差比例系数、纵倾角微分系数;KP2、Ki2分别表示深度误差的比例系数、深度误差的积分系数;fk、fk-1分别表示本周期纵倾角误差、上周期纵倾角误差;gk表示深度误差;T表示控制周期。
所述航向的比例微分积分算法公式为:
其中:PK表示水平力矩;KP、Ki、Kd分别表示比例系数、积分系数、微分系数;ek、ek-1分别表示本周期航向误差、上周期航向误差;T表示控制周期。
按权利要求1所述的低速AUV基于对转桨加鳍舵控制方法,其特征在于,所述控制值包括水平力矩和垂直力矩。
所述目标角度的计算方法为:
AK=Hk*K/v2
其中AK为目标角度,HK为控制值,K为根据舵板水动力特性的分析确定的系数,v为前向速度。
发明具有以下有益效果及优点:
1.本发明使基于对转桨加鳍舵的AUV通过周期性控制舵角和对转桨转速,能够保证AUV稳定航行;
2.本发明逻辑简单、计算量小,操作方便。
附图说明
图1是本发明下潜方案的流程图;
图2是本发明的航行控制方案的流程图。
具体实施方式
对转桨加鳍舵方式AUV,AUV的艉部安装对转桨和水平舵垂直舵。对转桨主要特点为较高的推进效率,能够可靠的执行预定使命。通过如下技术方案来实现:
如图1所示为下潜方案的流程图,首先按当前航向加速航行,周期性检查当前速度,如果当前速度达到或者超过设定的速度值,则开始下潜,否则继续按当前航向加速航行。
为使AUV能够可靠的下潜,首先应使得AUV与海水间保持一定的相对速度之后再下潜;其次要避免下潜时姿态失控;同时,通过控制载体的纵倾角和前向速度限制载体的下潜速度,也保证了载体的航行姿态。
如图2所示为航行控制方案的流程图,当到达设定的控制周期时,分别获取姿态传感器,角速度传感器,深度和高度传感器的数据,将各数据进行滤波并进行相关控制计算,并算出控制值。根据舵的水动力特性计算出目标舵角,并控制舵机,使舵达到目标舵角。根据螺旋桨的水动力特性,计算出主推电机所需要的转速,控制主推电机使其达到所需转速后本控制周期结束。
在AUV航行过程中,每个控制周期内,利用姿态传感器检测AUV的纵倾角、航向角,利用角速度罗盘检测纵倾角速度、航向角速度,利用深度传感器和高度计检测当前深度/高度,得到以上数值后采用纵倾角的比例微分算法(PD算法),深度/高度的比例积分算法(PI算法)以及航向的比例微分积分算法(PID算法)的混合计算方法计算出控制值,控制值包括水平力矩和垂直力矩。
根据水平力矩和垂直力矩控制值,通过对舵板水动力特性的分析确定所需水平舵角和垂直舵角的角度值;并控制水平舵电机、垂直舵电机,使得水平舵板和垂直舵板转动到相应的角度;通过对对转桨的水动力特性、AUV的水动力特性及希望的前向速度确定对转桨的转速,并通过试验来修正。
此方法通过实际航行验证有效,且能稳定的控制AUV的航向、航速、深度/高度。
航向的比例微分积分算法公式为:
其中:PK表示水平力矩;KP、Ki、Kd分别表示比例系数、积分系数、微分系数;ek、ek-1分别表示本周期航向误差、上周期航向误差;T表示控制周期。
在不同的速度下可采用不同的控制参数值,经过试验即可确定Kp、Ki、Kd的数值。
在上式中,如果微分项采用(ek-ek-1)/T直接计算,由于采样周期较短,因此会产生较大的噪声信号,进而影响控制效果。为了避免这种情况的发生,我们使用角速度测量仪,用它产生的角速度信息代替微分项,这样可获得较好的控制效果。
纵倾角的比例微分算法、深度/高度的比例积分算法公式为:
其中:QK表示垂直力矩;KP1、Kd1分别表示纵倾角误差比例系数、纵倾角微分系数;KP2、Ki2分别表示深度误差的比例系数、深度误差的积分系数;fk、fk-1分别表示本周期纵倾角误差、上周期纵倾角误差;gk表示深度误差;T表示控制周期。
目标角度的计算方法为:
AK=Hk*K/v2
其中AK为目标角度,HK为控制值,K为根据舵板水动力特性的分析确定的系数,v为前向速度。
Claims (6)
1.一种基于对转桨加鳍舵的低速AUV航行控制方法,其特征在于,在AUV的艉部安装对转桨、水平舵和垂直舵,对AUV的对转桨转速、水平舵板角度和垂直舵板角度做周期性调整,具体步骤如下:
步骤1:AUV下潜前,保持与海水间的相对速度不变;
步骤2:AUV下潜过程中,通过改变载体的纵倾角和前向速度来控制下潜速度;
步骤3:AUV水下航行过程中,在每个控制周期内,对纵倾角、航向角、纵倾角速度、航向角速度、深度、高度进行测量,采用混合计算方法计算出控制值;
步骤4:根据控制值并通过对舵板水动力特性的分析确定水平舵角和垂直舵角的目标角度,并通过水平舵电机和垂直舵电机,控制水平舵板和垂直舵板转动到目标角度;
步骤5:通过对对转桨的水动力特性、AUV的水动力特性及目标前向速度确定对转桨的目标转速,控制对转桨达到目标转速,结束调整周期。
2.按权利要求1所述的低速AUV基于对转桨加鳍舵控制方法,其特征在于,所述混合计算方法为纵倾角的比例微分算法、深度/高度的比例积分算法和航向的比例微分积分算法的混合计算方法。
3.按权利要求2所述的低速AUV基于对转桨加鳍舵控制方法,其特征在于,所述纵倾角的比例微分算法、深度/高度的比例积分算法公式为:
其中:QK表示垂直力矩;KP1、Kd1分别表示纵倾角误差比例系数、纵倾角微分系数;KP2、Ki2分别表示深度误差的比例系数、深度误差的积分系数;fk、fk-1分别表示本周期纵倾角误差、上周期纵倾角误差;gk表示深度误差;T表示控制周期。
4.按权利要求2所述的低速AUV基于对转桨加鳍舵控制方法,其特征在于,所述航向的比例微分积分算法公式为:
其中:PK表示水平力矩;KP、Ki、Kd分别表示比例系数、积分系数、微分系数;ek、ek-1分别表示本周期航向误差、上周期航向误差;T表示控制周期。
5.按权利要求1所述的低速AUV基于对转桨加鳍舵控制方法,其特征在于,所述控制值包括水平力矩和垂直力矩。
6.按权利要求1所述的低速AUV基于对转桨加鳍舵控制方法,其特征在于,所述目标角度的计算方法为:
AK=Hk*K/v2
其中AK为目标角度,HK为控制值,K为根据舵板水动力特性的分析确定的系数,v为前向速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012104872823A CN103064288A (zh) | 2012-11-23 | 2012-11-23 | 一种基于对转桨加鳍舵的低速auv航行控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012104872823A CN103064288A (zh) | 2012-11-23 | 2012-11-23 | 一种基于对转桨加鳍舵的低速auv航行控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103064288A true CN103064288A (zh) | 2013-04-24 |
Family
ID=48106961
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2012104872823A Pending CN103064288A (zh) | 2012-11-23 | 2012-11-23 | 一种基于对转桨加鳍舵的低速auv航行控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103064288A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105549611A (zh) * | 2014-10-30 | 2016-05-04 | 中国科学院沈阳自动化研究所 | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 |
CN105843224A (zh) * | 2016-03-25 | 2016-08-10 | 哈尔滨工程大学 | 基于神经动态模型反步法的auv水平面路径跟踪控制方法 |
CN105929825A (zh) * | 2016-05-16 | 2016-09-07 | 哈尔滨工程大学 | 一种基于神经动态模型的船舶动力定位反步控制方法 |
CN108062091A (zh) * | 2017-11-14 | 2018-05-22 | 北京臻迪科技股份有限公司 | 浮游移动体的浮潜动力补偿方法、装置及浮游移动体 |
CN108776428A (zh) * | 2018-06-10 | 2018-11-09 | 西北工业大学 | 一种自主水下航行器四通道耦合控制方法 |
CN109855649A (zh) * | 2019-04-12 | 2019-06-07 | 哈尔滨工程大学 | 一种水下滑翔机平台运动轨迹被动确定方法 |
CN113805598A (zh) * | 2020-06-11 | 2021-12-17 | 中国科学院沈阳自动化研究所 | 一种面向欠驱动auv的航行控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH092383A (ja) * | 1995-06-26 | 1997-01-07 | Ishikawajima Harima Heavy Ind Co Ltd | Rovの自動制御方法 |
CN1666925A (zh) * | 2005-01-07 | 2005-09-14 | 天津大学 | 水下自航行平台机械*** |
CN101628620A (zh) * | 2009-08-27 | 2010-01-20 | 上海交通大学 | 水下飞机 |
-
2012
- 2012-11-23 CN CN2012104872823A patent/CN103064288A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH092383A (ja) * | 1995-06-26 | 1997-01-07 | Ishikawajima Harima Heavy Ind Co Ltd | Rovの自動制御方法 |
CN1666925A (zh) * | 2005-01-07 | 2005-09-14 | 天津大学 | 水下自航行平台机械*** |
CN101628620A (zh) * | 2009-08-27 | 2010-01-20 | 上海交通大学 | 水下飞机 |
Non-Patent Citations (3)
Title |
---|
刘健等: "无缆自治水下机器人控制方法研究", 《机器人》 * |
甘永: "水下机器人运动控制***体系结构的研究", 《中国博士学位论文全文数据库 》 * |
肖金鹏: "潜水器姿态与定深控制关键技术研究", 《中国优秀硕士学位论文全文数据库》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105549611A (zh) * | 2014-10-30 | 2016-05-04 | 中国科学院沈阳自动化研究所 | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 |
CN105549611B (zh) * | 2014-10-30 | 2018-04-17 | 中国科学院沈阳自动化研究所 | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 |
CN105843224A (zh) * | 2016-03-25 | 2016-08-10 | 哈尔滨工程大学 | 基于神经动态模型反步法的auv水平面路径跟踪控制方法 |
CN105929825A (zh) * | 2016-05-16 | 2016-09-07 | 哈尔滨工程大学 | 一种基于神经动态模型的船舶动力定位反步控制方法 |
CN105929825B (zh) * | 2016-05-16 | 2019-02-15 | 哈尔滨工程大学 | 一种基于神经动态模型的船舶动力定位反步控制方法 |
CN108062091A (zh) * | 2017-11-14 | 2018-05-22 | 北京臻迪科技股份有限公司 | 浮游移动体的浮潜动力补偿方法、装置及浮游移动体 |
CN108776428A (zh) * | 2018-06-10 | 2018-11-09 | 西北工业大学 | 一种自主水下航行器四通道耦合控制方法 |
CN109855649A (zh) * | 2019-04-12 | 2019-06-07 | 哈尔滨工程大学 | 一种水下滑翔机平台运动轨迹被动确定方法 |
CN113805598A (zh) * | 2020-06-11 | 2021-12-17 | 中国科学院沈阳自动化研究所 | 一种面向欠驱动auv的航行控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103064288A (zh) | 一种基于对转桨加鳍舵的低速auv航行控制方法 | |
KR101370649B1 (ko) | 무인잠수정의 경로 제어방법 | |
US9195234B2 (en) | Dynamic positioning systems and methods | |
CN106681352B (zh) | 一种可旋转舵推进器的水下机器人控制方法 | |
CN105383654A (zh) | 一种自主式水下潜器的深度控制装置 | |
CN104658368A (zh) | 一种仿真的船舶操舵模拟器及模拟方法 | |
JP5171616B2 (ja) | 波の存在下で帆走させるために帆船を自動操舵する自動操縦モジュール及びシステム | |
Caccia et al. | A practical approach to modeling and identification of small autonomous surface craft | |
CN105549611B (zh) | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 | |
CN106643723B (zh) | 一种无人艇安全航行船位推算方法 | |
CN104950882A (zh) | 全局一致渐进路径跟踪引导控制方法 | |
Zheng et al. | Design and experimental testing of a free-running ship motion control platform | |
CN113359737A (zh) | 一种考虑队形伸缩的船舶编队自适应事件触发控制方法 | |
CN104648613A (zh) | 一种基于激光引导技术的船模操纵性试验装置 | |
WO2014168250A1 (ja) | 自由航走模型船試験方法及び自由航走模型船試験装置 | |
CN201673410U (zh) | 无人驾驶气垫测量船遥测遥控装置 | |
CN204548394U (zh) | 一种基于激光引导技术的船模操纵性试验装置 | |
Caccia et al. | Modelling and identification of the Charlie2005 ASC | |
JP6425241B2 (ja) | 自由航走模型試験から実船の変動トルク又は変動推力を推定する方法及びそれに用いられる自由航走模型船試験装置 | |
EP3389021B1 (en) | Indicator method and system for a vessel | |
CN105825714A (zh) | 鲁棒航迹引导律的确定方法及装置 | |
CN105180944A (zh) | 一种船体侧滑速度误差判定补偿方法 | |
Steenson et al. | Maneuvering of an over-actuated autonomous underwater vehicle using both through-body tunnel thrusters and control surfaces | |
CN109709877B (zh) | 一种不依赖艏向信号的船舶自动操纵***及方法 | |
Moe et al. | Path following of underactuated marine underwater vehicles in the presence of unknown ocean currents |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20130424 |