CN106681352B - 一种可旋转舵推进器的水下机器人控制方法 - Google Patents
一种可旋转舵推进器的水下机器人控制方法 Download PDFInfo
- Publication number
- CN106681352B CN106681352B CN201510750233.8A CN201510750233A CN106681352B CN 106681352 B CN106681352 B CN 106681352B CN 201510750233 A CN201510750233 A CN 201510750233A CN 106681352 B CN106681352 B CN 106681352B
- Authority
- CN
- China
- Prior art keywords
- control
- auv
- speed
- coefficient
- trim
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种可旋转舵推进器的水下机器人控制方法,实现对AUV的五自由度运动控制。本发明包括速度控制、航向控制和垂直面控制;所述速度控制包括速度开环控制和速度闭环控制,所述速度开环控制不考虑速度反馈直接输出控制推进器轴向推力;所述速度闭环控制将速度反馈引入到航速控制器中;所述航向控制为变结构航向控制;所述垂直面控制分为强机动控制和弱机动控制,在水下机器人与目标位置的距离大于设定值时,采用强机动控制;否则采用弱机动控制。与传统的控制方法比较,本方法具有更好的鲁棒性,更能适应外界环境的改变,提高了AUV的控制能力。本方法移植方便,可以适用于各种机器人。
Description
技术领域
本发明涉及水下机器人技术领域,尤其涉及一种可旋转舵推进器的水下机器人(简称AUV)控制方法,实现对AUV的五自由度(不包含横滚控制)运动控制。
背景技术
在海洋应用中,水下机器人发挥越来越重要的作用。水下机器人分成两类:一种是遥控式有缆水下机器人(简称ROV),一种是无人自治水下机器人(简称AUV)。ROV需要水面母船支持,同时受到电缆长度的限制,其作业距离有限,一般只有几百米;而AUV自身携带能源,可以远离母船,活动距离达到几十公里甚至上百公里。所以AUV的研究越来越受到各国的重视,AUV的发展代表了未来水下机器人的发展方向。但是AUV的控制方法比ROV的控制方法复杂,只有设计出好的控制方法才能发挥出AUV强大的作业能力。传统AUV控制方法主要采用经典线性控制理论进行控制和对执行结构进行控制力分配,这种方法最大的好处是算法简单,但是AUV的水动力性能是非线性和时变的,水动力试验也很难获得精确的水动力系数,再加上AUV负载变化引起重心和浮心的改变,导致当AUV的外界条件发生改变时,经典线性控制理论的控制方法控制性能急剧下降。本发明采用经典控制理论与变结构控制相结合的方法,对于水动力参数变化的不敏感性和控制抗干扰性优于传统的控制方法,更加适合AUV这种非线性时变模型***。
发明内容
为了克服传统线性控制方法在对于水动力系数敏感性较强和抗干扰性较弱的问题,本发明要解决的技术问题提供一种可旋转舵推进器的水下机器人控制方法,降低控制***对水动力参数敏感性和提高***的控制抗干扰性。
本发明为实现上述目的所采用的技术方案是:一种可旋转舵推进器的水下机器人控制方法,包括速度控制、航向控制和垂直面控制;
所述速度控制包括速度开环控制和速度闭环控制,所述速度开环控制不考虑速度反馈直接输出控制推进器轴向推力;所述速度闭环控制将速度反馈引入到航速控制器中;
所述航向控制为变结构航向控制;
所述垂直面控制分为强机动控制和弱机动控制,在水下机器人与目标位置的距离大于设定值时,采用强机动控制;否则采用弱机动控制。
所述速度开环控制的控制方法如下:
TX=-X|u|u|ud|ud
其中,Tx是推进器的前向推力,是控制输出量;ud是AUV的目标速度,是控制输入量;X|u|u是AUV与前向速度相关的水动力系数,是已知参数。
所述速度闭环控制的控制方法如下:
其中,Tx是推进器的前向推力,是控制输出量;ud是AUV的目标速度,u是AUV的反馈速度,ud和u都是控制输入量;X|u|u是AUV与前向速度相关的水动力系数,是AUV的惯性质量,X|u|u和都是已知参数,Kp和Ki是需要整定的控制参数,通过线性控制理论的参数整定方法来计算。
所述变结构航向控制的控制方法如下:
τN=Kp2(ψ-ψd)+Kd2(r-rd)+ηtanh(σ/0.2)
其中,τN是AUV的水平面转艏力矩,是航向控制的控制输出变量;σ是滑膜面,是航向控制的中间变量;(ψ-ψd)是当前航向角误差,(r-rd)是当前航向角误差的微分,它们是控制输入量;Kp2是航向角误差系数,Kd1是航向角误差微分系数,η是滑膜系数,它们可以通过试验测定,是已知参数。
所述弱机动控制的控制方法如下:
τM=Kdp(d-dd)+Kpθ(θ-θd)+Kdθq+BGzWsinθ
其中,τM是垂直面的纵倾力矩,是控制输出量;d是AUV的当前深度值,dd是AUV的当前目标深度值,θ是AUV的纵倾角,θd是AUV当前的目标纵倾角,它们是AUV的状态量,通过AUV的深度传感器和姿态传感器可以测量和计算;(d-dd)是AUV的深度误差,(θ-θd)是AUV的纵倾角误差,q是AUV的垂直角速率,它们是控制输入量;Kdp是AUV的深度误差系数,Kpθ是AUV的纵倾角误差系数,Kdθ是AUV的垂直角速率系数,BGzWsinθ是AUV的重力/浮力垂直静力矩,它们可以通过试验测定,是已知参数。
所述强机动控制的控制方法如下:
τM=Kpθ2(θ-θd)+Kdθ2q+BGzWsinθ
其中,τM是垂直面的纵倾力矩,是控制输出量;θ是AUV的当前纵倾角,θd是AUV当前的目标纵倾角,它们是AUV的状态量,通过AUV的姿态传感器可以测量和计算;(θ-θd)是AUV的纵倾角误差,q是AUV的垂直角速率,它们是控制输入量;Kpθ2是AUV的纵倾角误差系数,Kdθ2是AUV的垂直角速率系数,BGzWsinθ是AUV的重力/浮力垂直静力矩,它们可以通过试验测定,是已知参数。
本发明具有以下有益效果及优点
1.对于水动力系数不敏感。相比传统的控制方法,本方法对于水动力系数不敏感,能够在水动力模型不准确的情况下使用。
2.能够更好地适应外界环境的改变。当外界环境发生改变时,例如AUV负载的变化和外界海流的变化,传统的控制方法会偏离最佳工作状态,降低控制***性能;本方法具有更好的鲁棒性,更好地适应外界环境的改变。
3.应用范围广。本发明不但可以应用于AUV,还可以用于各种机器人的运动控制。
附图说明
图1是本发明的组成示意图。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
本发明的硬件要求是一台AUV,AUV的艏部配置2个水平舵,在艏部水平舵上装有2个推进电机;艉部配置2个水平舵,在艉部水平舵上装有2个推进电机;在艉部配置一个垂直舵,如图1所示。
本发明的AUV运动控制方法包括以下几个内容:
速度控制的作用是保持AUV以指定的前向速度航行。速度控制包括两种,一种是速度开环控制,是不考虑速度反馈直接输出控制推进器轴向推力的控制;另一种是速度闭环控制,是将速度反馈引入到航速控制器设计中。速度控制线性性比较高,所以采用经典线性控制方法。
速度开环控制的控制方法如下:
TX=-X|u|u|ud|ud
其中,Tx是推进器的前向推力,是控制输出量;ud是AUV的目标速度,是控制输入量;X|u|u是AUV与前向速度相关的水动力系数,是已知参数。
速度闭环控制的控制方法如下:
其中,Tx是推进器的前向推力,是控制输出量;ud是AUV的目标速度,u是AUV的反馈速度,ud和u都是控制输入量;X|u|u是AUV与前向速度相关的水动力系数,是AUV的惯性质量,X|u|u和都是已知参数。Kp和Ki是需要整定的控制参数,可以通过线性控制理论的参数整定方法来计算。
航向控制的作用是保持AUV在指定的航向上沿直线稳定航行。在要求AUV进行水平面机动时,航向控制能够及时改变AUV的航向,转到指定的目标航向航行。传统航向控制的线性控制方法对于水动力参数敏感,当外界环境发生改变时,线性控制方法的航向控制就偏离最佳工作状态,增加操舵次数和推进器转速变更次数,造成舵机和推进器磨损,降低执行机构的使用寿命。当线性控制方法的航向控制偏离最佳工作状态时,还会造成周期性的航向震荡,降低AUV的航行品质。所以本发明设计了变结构航向控制。变结构航向控制设计如下:
首先,设计航向控制的滑膜面,它的作用抑制外界改变对航向控制器的影响,提高航向控制器的鲁棒性:
σ=Ki1(ψi-ψid)+Kp1(ψ-ψd)+Kd1(r-rd)
其中σ是滑膜面,是航向控制的中间变量;ψi是当前航向角误差的积分,ψid是当前目标航向角的积分,ψ是当前航向角,ψd是当前目标航向角,r是当前航向角的微分,rd是目标航向角微分,它们是AUV的状态量,通过AUV的姿态传感器可以测量和计算;(ψi-ψid)是航向角误差的积分,(ψ-ψd)是当前航向角误差,(r-rd)是当前航向角误差的微分,它们是控制输入量;Ki1是航向角误差积分系数,Kp1是航向角误差系数,Kd1是航向角误差微分系数,它们可以通过水池试验测定,是已知参数。
下一步,根据滑膜面设计的变结构航向控制:
τN=Kp2(ψ-ψd)+Kd2(r-rd)+ηtanh(σ/0.2)
其中τN是AUV的水平面转艏力矩,是航向控制的控制输出变量;σ是滑膜面,是航向控制的中间变量;(ψ-ψd)是当前航向角误差,(r-rd)是当前航向角误差的微分,它们是控制输入量;Kp2是航向角误差系数,Kd1是航向角误差微分系数,η是滑膜系数,它们可以通过试验测定,是已知参数。
垂直面控制的作用是保持AUV在指定的深度下稳定航行和在垂直面内进行深度机动操纵。表面上看,垂直面控制和水平面控制相同,实际上垂直面控制复杂度高于水平面控制,AUV在垂直面运动,不但像水平面运动受到流体动力的作用外,还受到静力和静力矩的作用。垂直面控制分成强机动控制和弱机动控制,其中强机动控制是指大范围的垂直面机动,弱机动控制的垂直面机动范围比较小。
弱机动控制设计如下:
τM=Kdp(d-dd)+Kpθ(θ-θd)+Kdθq+BGzWsinθ
其中,τM是垂直面的纵倾力矩,是控制输出量;d是AUV的当前深度值,dd是AUV的当前目标深度值,θ是AUV的纵倾角,θd是AUV当前的目标纵倾角,它们是AUV的状态量,通过AUV的深度传感器和姿态传感器可以测量和计算;(d-dd)是AUV的深度误差,(θ-θd)是AUV的纵倾角误差,q是AUV的垂直角速率,它们是控制输入量;Kdp是AUV的深度误差系数,Kpθ是AUV的纵倾角误差系数,Kdθ是AUV的垂直角速率系数,BGzWsinθ是AUV的重力/浮力垂直静力矩,它们可以通过试验测定,是已知参数。
强机动控制设计如下:
τM=Kpθ2(θ-θd)+Kdθ2q+BGzWsinθ
其中,τM是垂直面的纵倾力矩,是控制输出量;θ是AUV的当前纵倾角,θd是AUV当前的目标纵倾角,它们是AUV的状态量,通过AUV的姿态传感器可以测量和计算;(θ-θd)是AUV的纵倾角误差,q是AUV的垂直角速率,它们是控制输入量;Kpθ2是AUV的纵倾角误差系数,Kdθ2是AUV的垂直角速率系数,BGzWsinθ是AUV的重力/浮力垂直静力矩,它们可以通过试验测定,是已知参数。
在AUV设计完成后,首先进行水池水动力试验,获得AUV的水动力系数。然后按照本发明方法设计AUV的速度、水平面和垂直面控制器。最后,将使用本发明方法的AUV进行航行试验,验证控制方法的正确性。
Claims (4)
1.一种可旋转舵推进器的水下机器人控制方法,其特征在于,包括速度控制、航向控制和垂直面控制;
所述速度控制包括速度开环控制和速度闭环控制,所述速度开环控制不考虑速度反馈直接输出控制推进器轴向推力;所述速度闭环控制将速度反馈引入到航速控制器中;
所述航向控制为变结构航向控制;
所述垂直面控制分为强机动控制和弱机动控制,在水下机器人与目标位置的距离大于设定值时,采用强机动控制;否则采用弱机动控制;
所述弱机动控制的控制方法如下:
τM=Kdp(d-dd)+Kpθ(θ-θd)+Kdθq+BGzW sinθ
其中,τM是垂直面的纵倾力矩,是控制输出量;d是水下机器人AUV的当前深度值,dd是AUV的当前目标深度值,θ是AUV的纵倾角,θd是AUV当前的目标纵倾角,是AUV的状态量,通过AUV的深度传感器和姿态传感器测量和计算;(d-dd)是AUV的深度误差,(θ-θd)是AUV的纵倾角误差,q是AUV的垂直角速率,是控制输入量;Kdp是AUV的深度误差系数,Kpθ是AUV的纵倾角误差系数,Kdθ是AUV的垂直角速率系数,BGzWsinθ是AUV的重力/浮力垂直静力矩,是已知参数;
所述强机动控制的控制方法如下:
τM′=Kpθ2(θ-θd)+Kdθ2q+BGzW sinθ
其中,τM′是垂直面的纵倾力矩,是控制输出量;θ是AUV的当前纵倾角,θd是AUV当前的目标纵倾角,是AUV的状态量,通过AUV的姿态传感器测量和计算;(θ-θd)是AUV的纵倾角误差,q是AUV的垂直角速率,它们是控制输入量;Kpθ2是AUV的纵倾角误差系数,Kdθ2是AUV的垂直角速率系数。
2.根据权利要求1所述的一种可旋转舵推进器的水下机器人控制方法,其特征在于,所述速度开环控制的控制方法如下:
TX=-X|u|u|ud|ud
其中,Tx是推进器的前向推力,是控制输出量;ud是AUV的目标速度,是控制输入量;X|u|u是AUV与前向速度相关的水动力系数,是已知参数。
3.根据权利要求1所述的一种可旋转舵推进器的水下机器人控制方法,其特征在于,所述速度闭环控制的控制方法如下:
其中,Tx是推进器的前向推力,是控制输出量;ud是AUV的目标速度,u是AUV的反馈速度,ud和u都是控制输入量;t是控制周期;X|u|u是AUV与前向速度相关的水动力系数,是AUV的惯性质量,X|u|u和都是已知参数,Kp和Ki是需要整定的控制参数,通过线性控制理论的参数整定方法来计算。
4.根据权利要求1所述的一种可旋转舵推进器的水下机器人控制方法,其特征在于,所述变结构航向控制的控制方法如下:
τN=Kp2(ψ-ψd)+Kd2(r-rd)+ηtanh(σ/0.2)
其中,τN是AUV的水平面转艏力矩,是航向控制的控制输出变量;σ是滑膜面,是航向控制的中间变量;(ψ-ψd)是当前航向角误差,(r-rd)是当前航向角误差的微分,是控制输入量;Kp2是航向角误差系数,Kd2是航向角误差微分系数,η是滑膜系数,是已知参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510750233.8A CN106681352B (zh) | 2015-11-06 | 2015-11-06 | 一种可旋转舵推进器的水下机器人控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510750233.8A CN106681352B (zh) | 2015-11-06 | 2015-11-06 | 一种可旋转舵推进器的水下机器人控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106681352A CN106681352A (zh) | 2017-05-17 |
CN106681352B true CN106681352B (zh) | 2019-01-25 |
Family
ID=58858571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510750233.8A Active CN106681352B (zh) | 2015-11-06 | 2015-11-06 | 一种可旋转舵推进器的水下机器人控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106681352B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108563234A (zh) * | 2018-05-09 | 2018-09-21 | 深圳市吉影科技有限公司 | 一种水下无人机自平衡控制方法及*** |
CN108776428B (zh) * | 2018-06-10 | 2019-11-22 | 西北工业大学 | 一种自主水下航行器四通道耦合控制方法 |
CN111240346B (zh) * | 2018-11-28 | 2021-07-23 | 中国科学院沈阳自动化研究所 | 深海auv无人监控平台跟踪方法 |
CN113075879B (zh) * | 2020-01-03 | 2022-02-01 | 中国科学院沈阳自动化研究所 | 一种倾转旋翼无人机发动机控制*** |
CN111994238A (zh) * | 2020-08-11 | 2020-11-27 | 中国科学院沈阳自动化研究所 | 一种高机动大潜深自主水下机器人形体结构 |
CN114217521B (zh) * | 2021-11-30 | 2023-11-10 | 中国科学院沈阳自动化研究所 | 基于推进器矢量布局的水下机器人的全姿态运动控制方法 |
CN114739357B (zh) * | 2022-04-08 | 2023-09-22 | 上海中车艾森迪海洋装备有限公司 | 水下机器人的连续滚转角测量方法、装置及电子设备 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101234665A (zh) * | 2008-03-03 | 2008-08-06 | 中国科学院光电技术研究所 | 一种小型水下观测机器人 |
CN101251379A (zh) * | 2008-02-19 | 2008-08-27 | 哈尔滨工程大学 | 一种面向水下运载器的实时双目视觉导引方法 |
CN103264389A (zh) * | 2013-05-14 | 2013-08-28 | 东南大学 | 一种可全向运动的模块化自重构机器人的单元模块结构 |
CN103838146A (zh) * | 2014-03-18 | 2014-06-04 | 大连海事大学 | 一种海流估计***和估计方法 |
CN103941685A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一种深海作业型rov控制***及其控制方法 |
CN104808689A (zh) * | 2015-05-15 | 2015-07-29 | 厦门大学 | 一种迷你型水下机器人的控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7540255B2 (en) * | 2005-08-23 | 2009-06-02 | Hawkes Calvert T | Propulsion and steering mechanism for an underwater vehicle |
-
2015
- 2015-11-06 CN CN201510750233.8A patent/CN106681352B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101251379A (zh) * | 2008-02-19 | 2008-08-27 | 哈尔滨工程大学 | 一种面向水下运载器的实时双目视觉导引方法 |
CN101234665A (zh) * | 2008-03-03 | 2008-08-06 | 中国科学院光电技术研究所 | 一种小型水下观测机器人 |
CN103264389A (zh) * | 2013-05-14 | 2013-08-28 | 东南大学 | 一种可全向运动的模块化自重构机器人的单元模块结构 |
CN103838146A (zh) * | 2014-03-18 | 2014-06-04 | 大连海事大学 | 一种海流估计***和估计方法 |
CN103941685A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一种深海作业型rov控制***及其控制方法 |
CN104808689A (zh) * | 2015-05-15 | 2015-07-29 | 厦门大学 | 一种迷你型水下机器人的控制方法 |
Non-Patent Citations (1)
Title |
---|
无缆自治水下机器人控制方法研究;刘健等;《机器人》;20040131;第26卷(第1期);第7-10页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106681352A (zh) | 2017-05-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106681352B (zh) | 一种可旋转舵推进器的水下机器人控制方法 | |
Sarda et al. | Station-keeping control of an unmanned surface vehicle exposed to current and wind disturbances | |
CN105383654B (zh) | 一种自主式水下潜器的深度控制装置 | |
CN105843233B (zh) | 一种基于非线性观测器的自主水下航行器运动控制方法 | |
Bui et al. | A ship berthing system design with four tug boats | |
Sun et al. | Adaptive path following control for wave gliders in time-varying environment | |
KR101370649B1 (ko) | 무인잠수정의 경로 제어방법 | |
CN101419464B (zh) | 一种采用矢量推进器的无人潜水器定深航行控制方法 | |
CN105549611B (zh) | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 | |
Fang et al. | Application of neuro-fuzzy algorithm to portable dynamic positioning control system for ships | |
Wang et al. | Filter-backstepping based neural adaptive formation control of leader-following multiple AUVs in three dimensional space | |
CN113359785B (zh) | 一种微小型auv水下运动和悬停控制方法 | |
Fan et al. | Impact of current disturbances on AUV docking: Model-based motion prediction and countering approaches | |
CN112147899A (zh) | 一种基于模糊滑模算法的水下机器人自主避障控制方法 | |
CN103064288A (zh) | 一种基于对转桨加鳍舵的低速auv航行控制方法 | |
CN102346485B (zh) | 面向复杂海况的欠驱动uuv大攻角潜浮自适应串级控制方法 | |
CN113359737A (zh) | 一种考虑队形伸缩的船舶编队自适应事件触发控制方法 | |
Grenestedt et al. | LORCA: A high performance USV with applications to surveillance and monitoring | |
CN104590517B (zh) | 一种水下航行器的复合姿轨控制方法 | |
Feng et al. | H/sub/spl infin//autopilot design for an autonomous underwater vehicle | |
Bibuli et al. | Adaptive steering control for an azimuth thrusters-based autonomous vessel | |
Jiang et al. | Design of novel S-plane controller of autonomous underwater vehicle established on sliding mode control | |
Zhou et al. | Experimentally verified depth control of an unmanned semi-submersible vehicle | |
Moe et al. | Path following of underactuated marine underwater vehicles in the presence of unknown ocean currents | |
Rosario et al. | Experimental variable structure trajectory tracking control of a surface vessel with a motion capture system |
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 |