CN112591060B - 一种水下自主航行器x型舵控制方法 - Google Patents
一种水下自主航行器x型舵控制方法 Download PDFInfo
- Publication number
- CN112591060B CN112591060B CN202011539746.1A CN202011539746A CN112591060B CN 112591060 B CN112591060 B CN 112591060B CN 202011539746 A CN202011539746 A CN 202011539746A CN 112591060 B CN112591060 B CN 112591060B
- Authority
- CN
- China
- Prior art keywords
- rudder
- delta
- axis
- shaped
- angle
- 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
Images
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
- B63G8/20—Steering equipment
-
- 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
- B63G8/18—Control of attitude or depth by hydrofoils
-
- 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
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种水下自主航行器X型舵控制方法,属于水下自主航行器控制技术领域,该控制方法能够提高航行器的机动性,使航行器在水面和水下稳定航行。首先取水下自主航行器坐标系Oxyz;设置四个舵面分别与Oy轴和Oz轴成45°角,形成X型舵分布;其次将水下自主航行器中舵机***上电后,舵角指令正常下达,并反馈正常;再次将X型舵投影至Oy轴和Oz轴上,以Oy轴舵角控制垂直方向运动,Oz轴舵角控制水平方向运动,根据航行控制所需要深度保持的水平舵、航向保持的垂直舵、不产生翻滚力矩的差动舵,得到X型舵与十字舵的舵角转换公式;最后反推X型舵中四个舵角的大小,并对舵角进行限幅,从而实现X型舵的航行控制。
Description
技术领域
本发明涉及水下自主航行器控制技术领域,具体涉及一种水下自主航行器X型舵控制方法。
背景技术
水下自主航行器在水面航行时,垂直舵角上部分受航行器浮力的影响,舵面可能在水面以上,从而影响水面操纵性;水下航行时,在同等舵面积的情况下,X型舵舵效较十字舵有较大的提升,对不超基线的水下航行器而言,有较大的优势,方便航行器布放回收。
目前在水下自主航行器的控制技术领域,针对十字型舵的控制方法较多,如何设计针对X型舵的控制方法,从而更有效地发挥X型舵的舵效,在保证水下自主航行器稳定航行的基础上,提高水下自主航行器的机动性。
发明内容
有鉴于此,本发明提供了一种水下自主航行器X型舵控制方法,能够提高航行器的机动性,使航行器在水面和水下稳定航行。
为了达到上述目的,本发明的技术方案包括如下步骤:
步骤1、取水下自主航行器坐标系Oxyz,O为航行器的浮心,Ox沿水下自主航行器的纵轴指向前方,Oy轴垂直于Ox轴指向上方,Oz轴垂直于Ox轴和Oy轴,其方向使坐标系成为右手系;设置四个舵面分别与Oy轴和Oz轴成45°角,形成X型舵分布;
步骤2、水下自主航行器中舵机***上电后,舵角指令正常下达,并反馈正常;
步骤3、将X型舵投影至Oy轴和Oz轴上,以Oy轴舵角控制垂直方向运动,Oz轴舵角控制水平方向运动,根据航行控制所需要深度保持的水平舵、航向保持的垂直舵、不产生翻滚力矩的差动舵,得到X型舵与十字舵的舵角转换公式;
步骤4、反推X型舵中四个舵角的大小,并对舵角进行限幅,从而实现X型舵的航行控制。
进一步地,根据水下自主航行器的X型舵分布,以右上角舵为δ1,逆时针依次为δ2、δ3、δ4。
进一步地,步骤3,具体包括如下步骤:
步骤301、定义舵角正负:水下自主航行器的水平舵角为δe,水下自主航行器的垂直舵角为δr,从艉向艏看,右舵和下舵为正;航行器X型舵分布,以右上角舵为δ1,逆时针依次为δ2、δ3、δ4,从艉向艏看,δ1和δ3右下舵为正,δ2和δ4左下舵为正。
步骤302、根据垂直方向和水平方向的受力分析,即航行控制所需要深度保持的水平舵、航向保持的垂直舵,得到:
步骤303、增加横滚控制,X型舵的四个舵对水下自主航行器产生的翻滚力矩对应的差动舵角为δd,用于平衡潜航器在水下由于自身衡重所引起的横滚:
步骤304、得到δe,δr,δd与δ1,δ2,δ3,δ4的关系,即为X型舵与十字舵的舵角转换公式:
进一步地,根据水下自主航行器不同速度,通过实航或仿真试验得到δd的值。
进一步地,步骤4,具体包括如下步骤:
步骤401,根据矩阵求逆可推算出X型舵四个舵角的角度值分别为:
步骤402,水下自主航行器的水平舵角δe和垂直舵角δr的上下限为舵角幅值±δ,以水平舵角δe作为基准,水平舵角δe的取值范围为[-δ,+δ],垂直舵角的取值范围为[-(δ-δd-δe),+(δ-δd-δe)],从而确保δ1,δ2,δ3,δ4的上下限不超舵角幅值±δ。
有益效果:
本发明适用于水下自主航行器X型舵控制方法,将X型舵投影至水平舵和垂直舵,对航行器的垂向运动、侧向运动和横滚进行控制,并对舵角的限幅进行约束,从而实现平台在水面水下的稳定航行。
附图说明
图1为水下自主航行器X型舵分布图;
图2为本发明提供的水下自主航行器X型舵控制方法流程图。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
本发明提供了一种水下自主航行器X型舵控制方法,其特征在于,包括如下步骤:
步骤1、取水下自主航行器坐标系Oxyz,O为航行器的浮心,Ox沿水下自主航行器的纵轴指向前方,Oy轴垂直于Ox轴指向上方,Oz轴垂直于Ox轴和Oy轴,其方向使坐标系成为右手系;设置四个舵面分别与Oy轴和Oz轴成45°角,形成X型舵分布;如图1所示航行器X型舵分布,根据水下自主航行器的X型舵分布,以右上角舵为δ1,逆时针依次为δ2、δ3、δ4。
步骤2、水下自主航行器中舵机***上电后,舵角指令正常下达,并反馈正常。
步骤3、将X型舵投影至Oy轴和Oz轴上,以Oy轴舵角控制垂直方向运动,Oz轴舵角控制水平方向运动,根据航行控制所需要深度保持的水平舵、航向保持的垂直舵、不产生翻滚力矩的差动舵,得到X型舵与十字舵的舵角转换公式;该步骤3具体包括如下步骤:
步骤301、定义舵角正负:水下自主航行器的水平舵角为δe,水下自主航行器的垂直舵角为δr,从艉向艏看,右舵和下舵为正;航行器X型舵分布,以右上角舵为δ1,逆时针依次为δ2、δ3、δ4,从艉向艏看,δ1和δ3右下舵为正,δ2和δ4左下舵为正。
步骤302、根据垂直方向和水平方向的受力分析,即航行控制所需要深度保持的水平舵、航向保持的垂直舵,得到:
步骤303、增加横滚控制,X型舵的四个舵对水下自主航行器产生的翻滚力矩对应的差动舵角为δd,用于平衡潜航器在水下由于自身衡重所引起的横滚:
步骤304、得到δe,δr,δd与δ1,δ2,δ3,δ4的关系,即为X型舵与十字舵的舵角转换公式:
步骤4、反推X型舵中四个舵角的大小,并对舵角进行限幅,从而实现X型舵的航行控制。该步骤4具体包括如下步骤:
步骤401,根据矩阵求逆可推算出X型舵四个舵角的角度值分别为:
步骤402,水下自主航行器的水平舵角δe和垂直舵角δr的上下限为舵角幅值±δ,以水平舵角δe作为基准,水平舵角δe的取值范围为[-δ,+δ],垂直舵角的取值范围为[-(δ-δd-δe),+(δ-δd-δe)],从而确保δ1,δ2,δ3,δ4的上下限不超舵角幅值±δ。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种水下自主航行器X型舵控制方法,其特征在于,将X型舵投影至水平舵和垂直舵,对航行器的垂向运动、侧向运动和横滚进行控制,并对舵角的限幅进行约束,从而实现平台在水面水下的稳定航行,包括如下步骤:
步骤1、取水下自主航行器坐标系Oxyz,O为航行器的浮心,Ox沿水下自主航行器的纵轴指向前方,Oy轴垂直于Ox轴指向上方,Oz轴垂直于Ox轴和Oy轴,其方向使坐标系成为右手系;设置四个舵面分别与Oy轴和Oz轴成45°角,形成X型舵分布;根据水下自主航行器的X型舵分布,以右上角舵为δ1,逆时针依次为δ2、δ3、δ4;
步骤2、水下自主航行器中舵机***上电后,舵角指令正常下达,并反馈正常;
步骤3、将X型舵投影至Oy轴和Oz轴上,以Oy轴舵角控制垂直方向运动,Oz轴舵角控制水平方向运动,根据航行控制所需要深度保持的水平舵、航向保持的垂直舵、不产生翻滚力矩的差动舵,得到X型舵与十字舵的舵角转换公式;步骤3,具体包括如下步骤:
步骤301、定义舵角正负:水下自主航行器的水平舵角为δe,水下自主航行器的垂直舵角为δr,从艉向艏看,右舵和下舵为正;航行器X型舵分布,以右上角舵为δ1,逆时针依次为δ2、δ3、δ4,从艉向艏看,δ1和δ3右下舵为正,δ2和δ4左下舵为正;
步骤302、根据垂直方向和水平方向的受力分析,即航行控制所需要深度保持的水平舵、航向保持的垂直舵,得到:
步骤303、增加横滚控制,X型舵的四个舵对水下自主航行器产生的翻滚力矩对应的差动舵角为δd,用于平衡潜航器在水下由于自身衡重所引起的横滚:
步骤304、得到δe,δr,δd与δ1,δ2,δ3,δ4的关系,即为X型舵与十字舵的舵角转换公式:
步骤4、反推X型舵中四个舵角的大小,并对舵角进行限幅,从而实现X型舵的航行控制;步骤4,具体包括如下步骤:
步骤401,根据矩阵求逆可推算出X型舵四个舵角的角度值分别为:
步骤402,水下自主航行器的水平舵角δe和垂直舵角δr的上下限为舵角幅值±δ,以水平舵角δe作为基准,水平舵角δe的取值范围为[-δ,+δ],垂直舵角的取值范围为[-(δ-δd-δe),+(δ-δd-δe)],从而确保δ1,δ2,δ3,δ4的上下限不超舵角幅值±δ;
根据水下自主航行器不同速度,通过实航或仿真试验得到δd的值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011539746.1A CN112591060B (zh) | 2020-12-23 | 2020-12-23 | 一种水下自主航行器x型舵控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011539746.1A CN112591060B (zh) | 2020-12-23 | 2020-12-23 | 一种水下自主航行器x型舵控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112591060A CN112591060A (zh) | 2021-04-02 |
CN112591060B true CN112591060B (zh) | 2023-07-14 |
Family
ID=75200426
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011539746.1A Active CN112591060B (zh) | 2020-12-23 | 2020-12-23 | 一种水下自主航行器x型舵控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112591060B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115056948B (zh) * | 2022-06-10 | 2023-08-22 | 华中农业大学 | 无人水下航行器艉舵位形自主切换控制方法及*** |
CN116252939B (zh) * | 2023-02-28 | 2024-02-02 | 中国船舶科学研究中心 | 一种适用于x型操纵面水下航行器的主动流动控制方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108313253B (zh) * | 2018-01-24 | 2019-10-18 | 韩先锋 | “x”舵和“十”字舵可转换舵系 |
CN108776428B (zh) * | 2018-06-10 | 2019-11-22 | 西北工业大学 | 一种自主水下航行器四通道耦合控制方法 |
CN110703791B (zh) * | 2019-10-22 | 2022-10-14 | 中国人民解放军海军工程大学 | 一种复杂条件下潜艇x舵智能模糊控制方法 |
CN110963012B (zh) * | 2019-12-20 | 2022-03-01 | 鹏城实验室 | 水下潜航器和水下潜航设备的控制方法 |
-
2020
- 2020-12-23 CN CN202011539746.1A patent/CN112591060B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112591060A (zh) | 2021-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111580523B (zh) | 一种基于侧滑角补偿的无人艇路径跟踪自抗扰控制方法 | |
Klinger et al. | Control of an unmanned surface vehicle with uncertain displacement and drag | |
CN110308735B (zh) | 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法 | |
Moreira et al. | Path following control system for a tanker ship model | |
CN109814392B (zh) | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 | |
Skjetne et al. | Modeling, identification, and adaptive maneuvering of Cybership II: A complete design with experiments | |
CN112591060B (zh) | 一种水下自主航行器x型舵控制方法 | |
CN109116838B (zh) | 一种用于小型船的自动停泊辅助控制方法 | |
CN113341953B (zh) | 一种吊舱式无人艇航向控制方法 | |
CN112036099B (zh) | 一种基于帆船风帆攻角确定最小回转半径的方法 | |
CN108490944B (zh) | 一种基于喷水推进器的船艇矢量控制***及方法 | |
CN112527018A (zh) | 一种欠驱动自主水下航行器的三维镇定控制方法 | |
CN112987771B (zh) | 基于多端口输出误差触发机制的机帆船路径跟踪控制方法 | |
CN106681352A (zh) | 一种可旋转舵推进器的水下机器人控制方法 | |
CN110827616A (zh) | 一种潜艇操舵和均衡控制仿真试验平台及方法 | |
WO2019233019A1 (zh) | 一种三推水下无人机的闭环运动控制方法及其*** | |
Zhao et al. | A novel path-following control algorithm for surface vessels based on global course constraint and nonlinear feedback technology | |
CN113359737A (zh) | 一种考虑队形伸缩的船舶编队自适应事件触发控制方法 | |
CN113126492B (zh) | 动力定位船舶自动路径跟踪方法 | |
Liang et al. | Research and simulation of ship roll control in turning motion | |
CN112925332A (zh) | 无人艇与水下无人潜器联合***的协同交会对接控制方法 | |
CN110398961B (zh) | 一种气垫船航迹保持舵桨协同控制与分配方法 | |
Wang et al. | AUV modeling and motion control strategy design | |
CN110851917A (zh) | 一种用于预报水下航行体稳定拖曳纵向操纵性的方法 | |
You et al. | Study on the MMG three-degree-of-freedom motion model of a sailing vessel |
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 |