CN105807789B - 基于t-s模糊观测器补偿的uuv控制方法 - Google Patents
基于t-s模糊观测器补偿的uuv控制方法 Download PDFInfo
- Publication number
- CN105807789B CN105807789B CN201610177334.5A CN201610177334A CN105807789B CN 105807789 B CN105807789 B CN 105807789B CN 201610177334 A CN201610177334 A CN 201610177334A CN 105807789 B CN105807789 B CN 105807789B
- Authority
- CN
- China
- Prior art keywords
- uuv
- fuzzy
- observers
- next step
- coefficient
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 230000033001 locomotion Effects 0.000 claims abstract description 13
- 239000011159 matrix material Substances 0.000 claims description 42
- 230000035935 pregnancy Effects 0.000 claims description 15
- 239000013598 vector Substances 0.000 claims description 10
- 238000009795 derivation Methods 0.000 claims description 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 4
- 238000013016 damping Methods 0.000 claims description 3
- 238000010606 normalization Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 abstract description 4
- 238000004458 analytical method Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000004141 dimensional analysis Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005211 surface analysis Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000007704 transition Effects 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/10—Simultaneous control of position or course in three dimensions
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Image Analysis (AREA)
- Feedback Control In General (AREA)
Abstract
基于T‑S模糊观测器补偿的UUV控制方法,涉及一种UUV控制方法。为了解决在有海流干扰时UUV跟踪航迹不精确的问题。包括:获取UUV下一步的期望航迹;姿态控制器根据期望轨迹进行跟踪误差,解算出下一步垂直舵与水平舵的舵角信息;T‑S模糊观测器根据海流干扰、当前UUV状态信息和航迹位置误差对UUV进行观测,估计出UUV下一步的状态信息;将UUV下一步的状态信息作为航速控制器的输入信号,获得推进器的下一步的推力;根据垂直舵与水平舵的舵角信息和推力,对UUV进行控制,获得UUV的运动状态,进而确定UUV的航迹,判断该航迹是否达到期望轨迹。本发明用于UUV跟踪水下线缆或管道、水下搜救、深海资源探测及地形探测。
Description
技术领域
本发明涉及一种UUV控制方法,特别涉及一种基于T-S模糊观测器补偿的一种UUV控制方法。
背景技术
无人水下航行器(Underwater Unmanned Vehicle,UUV)在跟踪水下线缆或管道、水下搜救、深海资源探测及地形探测等方面有广泛应用,而精确的三维航迹跟踪是实现上述应用的重要前提。由于本发明研究的UUV具有欠驱动及加速度不可积的非完整约束条件,且受外界海流的影响,从而导致所建立的模型复杂。实际应用中所使用的UUV六自由度模型均以忽略高阶项及未建模动态为前提,致使当UUV工作于复杂环境下时,由于未建模动态及高阶项影响增大,实际跟踪精度变差。
1999年,Taniguchi T.等人将常规T-S模糊模型推广到更一般的情况,提出了T-S模糊广义系统模型。通过将T-S模糊系统与广义系统理论相结合,从而使得T-S系统可以借助于线性系统的分析和控制手段,为T-S模糊系统的应用开辟了一条崭新的途径。本发明通过建立UUV T-S模糊广义模型,引入T-S模糊观测器对UUV未建模动态进行在线观测,将观测结果反馈至控制器。该控制策略控制精度高,抗干扰性能强,具有非常好的使用价值。
文献《基于T-S模型的轮式移动机器人轨迹跟踪控制》(控制理论与应用,2007年12月,第24卷第6期)提出了在控制力受限情况下对外部干扰有一定抑制能力的轮式移动机器人(WMR)轨迹跟踪方法。利用轮式移动机器人本身运动特性和参考轨迹建立起跟踪误差系统,并将WMR实时的期望角度以及角度跟踪误差作为模糊推理的前件,对该系统作T-S模型描述,针对每个线性子系统,不考虑各个子系统的相互关系,单独设计满足控制输入约束以及对于外部干扰有一定抑制能力的状态反馈H∞控制器,再利用PDC设计原则构建全局反馈控制器,并验证闭环系统的李雅普诺夫稳定性。
文献《基于T-S模糊模型的机器人轨迹跟踪控制》(现代电子技术,2014年4月,第37卷第8期)是针对机器人模型的非线性,通过扇区非线性方法建立T-S模糊模型的。文献考虑到与实际模型之间的差异和扰动的存在,设计了滑模控制器,并利用李雅普诺夫理论证明了其稳定性。设计方法简单,通用性强。
但采用现有这些基于T-S模糊模型的控制方法,控制有海流影响的UUV时,不能精确跟踪航迹。
发明内容
本发明的目的是为了解决现有UUV控制,在有海流干扰时,跟踪航迹不精确的问题,本发明提供一种基于T-S模糊观测器补偿的UUV控制方法。
本发明的基于T-S模糊观测器补偿的UUV控制方法,所述方法包括如下步骤:
步骤一:获取UUV下一步的期望航迹;
步骤二:姿态控制器根据期望轨迹进行跟踪误差,解算出下一步垂直舵与水平舵的舵角信息;
步骤三:T-S模糊观测器根据海流干扰、当前UUV状态信息和航迹位置误差对UUV进行观测,估计出UUV下一步的状态信息;
所述航迹位置误差为期望轨迹与T-S模糊观测器当前估计出的状态信息和UUV当前的状态信息的差值;
步骤四:将步骤三获得的UUV下一步的状态信息作为航速控制器的输入信号,获得推进器的下一步的推力;
步骤五:根据步骤二获得的垂直舵与水平舵的舵角信息和步骤三获得的推力,对UUV进行控制,并获得UUV的运动状态;
步骤六:根据步骤五获得的运动状态确定UUV的航迹,判断该航迹是否达到期望轨迹,若是,转入步骤一,若否,则转入步骤二。
所述步骤三中,T-S模糊观测器为:
所述T-S模糊观测器是针对UUV近水面航行建立,忽略UUV的横倾角;
其中,选取未建模动态的观测更新律为:
n为T-S模糊观测器建立规则的数量,i=1,2,...,n;
为UUV下一步在{B}下的线速度和角速度矢量;
y为UUV当前状态输出;
为UUV下一步的状态输出;
wi(z)为相应规则的归一化权值函数,z=[u,v,w,q,r,(v2+w2)2]T,u、v和w为UUV线速度矢量在艇体坐标系{B}下的三个分量;p、q和r分别为UUV角速度矢量在艇体坐标系{B}下的三个分量,p=0;
Ai为相应规则所对应的UUV动力学模型的非线性项线性化的常量矩阵;
Di相应规则所对应的输入矩阵;
Mi为相应规则的外界干扰的增益矩阵;
τ为控制力或控制力矩;
Li为相应规则所对应的增益矩阵;
T为UUV的系统惯性矩阵,含附加质量,
m11为ξ方向的惯性质量,m22为η方向的惯性质量,m33为ζ方向的惯性质量,m44为η方向的惯性矩,m55为ζ方向的惯性矩;
外界干扰力或外界干扰力矩τd=Aδix+Bδiu+ai,Aδi为相应规则所对应的状态干扰系数矩阵,Bδi为相应规则所对应的输入干扰系数矩阵,ai为相应规则所对应的外界干扰系数矩阵;
ey为状态观测误差;
P为变换矩阵;
为C的伪逆;
C=I为线性化后的常矩阵;
˙表示求导。
所述T-S模糊观测器的获取方法包括:
步骤A:建立UUV动力学模型;
步骤B:根据动力学模型,获得UUV动力学方程式,并依据模糊规则将UUV动力学方程式转换为T-S模糊模型为:
其中,x=[u,v,w,q,r]T∈R5×1表示UUV当前在艇体坐标系{B}下的线速度和角速度矢量,τd为外界干扰力或外界干扰力矩;Ai∈R5×5,Mi∈R5×5,Di∈R5×5;
步骤C:将UUV所受τd表示为τd=Aδx+Bδu+a,将其带入步骤二中T-S模糊模型得出含有未建模动态的T-S模糊模型为:
其中,Aδ为模糊前的状态干扰系数矩阵,Bδ为模糊前的输入干扰系数矩阵,a为模糊前的外界干扰系数矩阵;Aδi∈R5×5,Bδi∈R5×5,ai∈R5×5;
步骤D:根据步骤C得出的T-S模糊模型得到模糊观测器:
其中,选取未建模动态的观测更新律为:
所述动力学模型:
式中mvr、mwq、mur和muq均是水动力项系数,分别为mvr=1/2ρL3X′vr、mwq=1/2ρL3X′wq、mur=1/2ρL3Y′r和muq=1/2ρL3Z′q,L为UUV长度,ρ为水密度,X′vr为v和r的耦合系数,X′wq为w和q的耦合系数,Y′r为艏项角速度系数,Z′q为纵倾角速度系数,du、dv、dw、dq和dr分别为在五个自由度上的非线性水动力阻尼项,Xporp、Mporp和Nporp分别表示推进器推力、水平舵作用力矩和垂直舵作用力矩,w1、w2、w3、w4和w5分别为在五个自由度上的外界干扰力或外界干扰力矩,所述外界干扰力或外界干扰力矩不且为τd减去输入不确定性和状态不确定性。
本发明的有益效果在于,通过建立UUV的T-S模糊模型估计出UUV的高阶未建模项,设计的T-S模糊观测器使所估计出的UUV状态信息更加接近实际情况,最终使得UUV在复杂环境下能够进行精确航迹跟踪。
附图说明
图1为具体实施方式中UUV垂直面坐标系示意图。
图2为具体实施方式中UUV水平面坐标系示意图。
图3为艇体坐标系{B}的原理示意图。
图4为具体实施方式中基于T-S模糊观测器补偿的UUV控制方法的流程示意图。
具体实施方式
本实施方式所述的基于T-S模糊观测器补偿的UUV控制方法,本实施方式研究的UUV具有欠驱动及加速度不可积的非完整约束条件,且受外界海流影响,导致所建立的模型复杂。该UUV模型在尾部安装水平推进器提供纵向推力,垂直舵实现航向控制,水平舵实现纵倾或深度控制。为便于分析,对该UUV模型进一步做出如下假设:UUV航速为非负值,即不考虑倒行时的航迹控制;忽略横滚运动的影响;所考虑的UUV对象左右对称。
在UUV运动分析及操纵性试验中,通常分为水平面与垂直面两方面来进行。其中水平面分析主要用于考察UUV航速及回转运动稳定性,而垂直面分析则主要考察UUV定深、变深性能。图1与图2描述了UUV三维空间运动分析时所用到的坐标系。其中,Eξηζ为大地固定坐标系,以E为大地固定坐标系的中心,ξ、η和ζ分别表示大地固定坐标系下的三个轴对应的坐标。BXYZ为UUV艇体坐标系,如图3所示,以B为艇体坐标系的中心,p、q和r分别为UUV角速度矢量在艇体坐标系下的三个分量;G为UUV重心,在坐标系{B}下其坐标为RG=(xG,0,0)T;UUV的合成速度U=[u v w]T,χ和γ分别为UUV潜浮角与航迹角;α和β分别为UUV冲角与漂角;ψ为艏向角;由于本实施方式考虑的是近水面UUV航行时,所以忽略横倾角与纵倾角θ,即
UUV艇体坐标系BXYZ相关参数含义如表1所示。
表1UUV运动变量
根据前述假设,有则欠驱动UUV三维运动学模型为:
其中,θ和ψ分别为UUV初始状态的艏向角和纵倾角,α和β分别为UUV初始状态的冲角与漂角;
假定坐标系{E}与坐标系{B}原点重合,动力学方程可描述为:
式中mvr、mwq、mur和muq均是水动力项系数,分别为mvr=1/2ρL3X′vr、mwq=1/2ρL3X′wq、mur=1/2ρL3Y′r和muq=1/2ρL3Z′q,L为UUV长度,ρ为水密度,X′vr为v和r的耦合系数,X′wq为w和q的耦合系数,Y′r为艏项角速度系数,Z′q为纵倾角速度系数,du、dv、dw、dq和dr分别为在五个自由度上的非线性水动力阻尼项,Xporp、Mporp和Nporp分别表示推进器推力、水平舵作用力矩和垂直舵作用力矩,w1、w2、w3、w4和w5分别为在五个自由度上的外界干扰力或外界干扰力矩,所述w1、w2、w3、w4和w5为不包括输入不确定性和状态不确定性的外界干扰力或外界干扰力矩。
将UUV动力学方程式(2)表示为矩阵向量形式:
式中,x=[u,v,w,q,r]T∈R5×1表示UUV在{B}下的线速度和角速度矢量,τ为控制力或控制力矩;τd为外界干扰力或外界干扰力矩;M为外界干扰的增益矩阵,D为输入矩阵,y为UUV当前状态输出;C=I为线性化后的常矩阵;˙表示求导;
可将式(3)中的非线性项A(x)表示为:
X[i],Y[i],Z[i],M[·],N[i],J[·]为[·]所对应的水动力系数;m为UUV的质量。
A(x)的每一个元素都可由集合{u,v,w,q,r,(v2+w2)1/2}中的元素线性表示。从而由模糊推理系统邻域非线性逼近原理,可知:
式中i=1,2,...,n,n为T-S模糊观测器所建立规则的数量,N为模糊集合,Ai∈R5 ×5,Mi∈R5×5,Di∈R5×5。可将式(3)改写成为T-S模糊模型:
式中z={u,v,w,q,r,(v2+w2)1/2},w(z)为相应的归一化权值函数,其计算过程如下:
式中,hix(x)为第i条规则时,分量x所具有的权值,具体值根据所选取的隶属度函数计算。
当UUV在实际航行时,由于受外界不确定扰动的影响,其未建模动态是时变的,因此利用该观测器实时对UUV的高阶未建模动态进行在线估计。
设UUV所受干扰力或干扰力矩τd由三部分组成:状态不确定性所引入的干扰、输入不确定所引入的干扰及外界直接作用在UUV上的干扰力或干扰力矩。从而可将τd表述为:
τd=Aδx+Bδu+a (8)
式中,其中,Aδ为模糊前的状态干扰系数矩阵,Bδ为模糊前的输入干扰系数矩阵,a为模糊前的外界干扰系数矩阵;Aδ∈R5×5,Bδ∈R5×5,a∈R5×5均未知。将(8)式代入(5)式,可得含有未建模动态的T-S模糊模型为:
基于T-S模糊模型式(8),所设计的自适应观测器如下:
式中,Li为相应规则所对应的增益矩阵;i=1,2,...,n。选取未建模动态的观测更新律为:
Ai为相应规则所对应的UUV动力学模型的非线性项线性化的常量矩阵;
Di相应规则所对应的输入矩阵;
Mi为相应规则的外界干扰的增益矩阵;
T为UUV的系统惯性矩阵,含附加质量,
m11为ξ方向的惯性质量,m22为η方向的惯性质量,m33为ζ方向的惯性质量,m44为η方向的惯性矩,m55为ζ方向的惯性矩;
外界干扰力或外界干扰力矩τd=Aδix+Bδiu+ai,Aδi为相应规则所对应的状态干扰系数矩阵,Bδi为相应规则所对应的输入干扰系数矩阵,ai为相应规则所对应的外界干扰系数矩阵;
ey为状态观测误差;
P为变换矩阵;
为C的伪逆;
设为估计误差,则状态观测误差ey=Ce,结合式(8)、(9),可得误差更新律为:
其中
证明:由式(12),取Lyapunov函数为如下形式:
定理:如果存在有P=PT>0,Q=QT>0,Li,i=1,2,...,n且满足
未建模动态观测更新律应用式(11),则式(12)渐近趋于0。式中max||Aδi||≤umax为未建模动态的界。
对上式进行求导,有:
式中Gi=(Ai-LiC+Aδi)TP+P(Ai-LiC+Aδi),i=1,2,...,n。
由式(12)可知Gi<0,i=1,2,...,n。因此,要使得只需
上述条件即为未建模动态更新律式(10)。此时系统渐近稳定。
结合图4,基于T-S模糊观测器补偿的UUV控制方法,包括如下步骤:
步骤一:获取UUV下一步的期望航迹
步骤二:姿态控制器根据期望轨迹进行跟踪误差,解算出下一步垂直舵与水平舵的舵角信息,获得水平舵作用力矩Mporp和垂直舵作用力矩Nporp;
步骤三:T-S模糊观测器根据海流干扰、当前UUV状态信息和航迹位置误差对UUV进行观测,估计出UUV下一步的状态信息;
所述航迹位置误差为期望轨迹与T-S模糊观测器当前估计出的状态信息和UUV当前的状态信息的差值;
图3中M为艇体坐标系{B}下的线速度[u v w]T到固定坐标系{E}下的位移[X Y Z]T的转换矩阵,将步骤六中UUV实际运动状态转换为UUV在惯性坐标系下的位置作为求航迹位置误差时所需的航迹位置误差。
步骤四:将步骤三获得的UUV下一步的状态信息作为航速控制器的输入信号,获得推进器的下一步的推力Xporp;
步骤五:根据获得的垂直舵水平舵作用力矩Mporp、垂直舵作用力矩Nporp和推力Xporp作用到UUV执行机构上,执行机构控制UUV得到UUV实际运动状态[u v w q r]T;
步骤六:根据步骤五获得的实际运动状态确定UUV的航迹,判断该航迹是否达到期望轨迹,若是,转入步骤一,若否,则转入步骤二。
若航迹达到期望轨迹则达到航迹点的精确跟踪,结束本次跟踪继续进行下一步跟踪;否则返回姿态控制器重新解算,直到达到航迹准确跟踪。
Claims (2)
1.一种基于T-S模糊观测器补偿的UUV控制方法,所述方法包括如下步骤:
步骤一:获取UUV下一步的期望航迹;
步骤二:姿态控制器根据期望轨迹进行跟踪误差,解算出下一步垂直舵与水平舵的舵角信息;
步骤三:T-S模糊观测器根据海流干扰、当前UUV状态信息和航迹位置误差对UUV进行观测,估计出UUV下一步的状态信息;
所述航迹位置误差为期望轨迹与T-S模糊观测器当前估计出的状态信息和UUV当前的状态信息的差值;
步骤四:将步骤三获得的UUV下一步的状态信息作为航速控制器的输入信号,获得推进器的下一步的推力;
步骤五:根据步骤二获得的垂直舵与水平舵的舵角信息和步骤三获得的推力,对UUV进行控制,并获得UUV的运动状态;
步骤六:根据步骤五获得的运动状态确定UUV的航迹,判断该航迹是否达到期望轨迹,若是,转入步骤一,若否,则转入步骤二;
所述步骤三中,T-S模糊观测器为:
所述T-S模糊观测器是针对UUV近水面航行建立,忽略UUV的横倾角;
其中,选取未建模动态的观测更新律为:
n为T-S模糊观测器建立规则的数量,i=1,2,...,n;
为UUV下一步在{B}下的线速度和角速度矢量;
y为UUV当前状态输出;
为UUV下一步的状态输出;
wi(z)为相应规则的归一化权值函数,z=[u,v,w,q,r,(v2+w2)2]T,u、v和w为UUV线速度矢量在艇体坐标系{B}下的三个分量;p、q和r分别为UUV角速度矢量在艇体坐标系{B}下的三个分量,p=0;
Ai为相应规则所对应的UUV动力学模型的非线性项线性化的常量矩阵;
Di相应规则所对应的输入矩阵;
Mi为相应规则的外界干扰的增益矩阵;
τ为控制力或控制力矩;
Li为相应规则所对应的增益矩阵;
T为UUV的系统惯性矩阵,含附加质量,
m11为ξ方向的惯性质量,m22为η方向的惯性质量,m33为ζ方向的惯性质量,m44为η方向的惯性矩,m55为ζ方向的惯性矩;
外界干扰力或外界干扰力矩τd=Aδix+Bδiu+ai,Aδi为相应规则所对应的状态干扰系数矩阵,Bδi为相应规则所对应的输入干扰系数矩阵,ai为相应规则所对应的外界干扰系数矩阵;
ey为状态观测误差;
P为变换矩阵;
为C的伪逆;
C=I为线性化后的常矩阵;
˙表示求导;
其特征在于,所述T-S模糊观测器的获取方法包括:
步骤A:建立UUV动力学模型;
步骤B:根据动力学模型,获得UUV动力学方程式,并依据模糊规则将UUV动力学方程式转换为T-S模糊模型为:
其中,x=[u,v,w,q,r]T∈R5×1表示UUV当前在艇体坐标系{B}下的线速度和角速度矢量,τd为外界干扰力或外界干扰力矩;Ai∈R5×5,Mi∈R5×5,Di∈R5×5;
步骤C:将UUV所受τd表示为τd=Aδx+Bδu+a,将其带入步骤二中T-S模糊模型得出含有未建模动态的T-S模糊模型为:
其中,Aδ为模糊前的状态干扰系数矩阵,Bδ为模糊前的输入干扰系数矩阵,a为模糊前的外界干扰系数矩阵;Aδi∈R5×5,Bδi∈R5×5,ai∈R5×5;
步骤D:根据步骤C得出的T-S模糊模型得到模糊观测器:
其中,选取未建模动态的观测更新律为:
2.根据权利要求1所述的基于T-S模糊观测器补偿的UUV控制方法,其特征在于,所述动力学模型:
式中mvr、mwq、mur和muq均是水动力项系数,分别为mvr=1/2ρL3Xv′r、mwq=1/2ρL3X′wq、mur=1/2ρL3Yr′和muq=1/2ρL3Zq′,L为UUV长度,ρ为水密度,Xv′r为v和r的耦合系数,X′wq为w和q的耦合系数,Yr′为艏项角速度系数,Zq′为纵倾角速度系数,du、dv、dw、dq和dr分别为在五个自由度上的非线性水动力阻尼项,Xporp、Mporp和Nporp分别表示推进器推力、水平舵作用力矩和垂直舵作用力矩,w1、w2、w3、w4和w5分别为在五个自由度上的外界干扰力或外界干扰力矩,所述外界干扰力或外界干扰力矩不且为τd减去输入不确定性和状态不确定性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610177334.5A CN105807789B (zh) | 2016-03-24 | 2016-03-24 | 基于t-s模糊观测器补偿的uuv控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610177334.5A CN105807789B (zh) | 2016-03-24 | 2016-03-24 | 基于t-s模糊观测器补偿的uuv控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105807789A CN105807789A (zh) | 2016-07-27 |
CN105807789B true CN105807789B (zh) | 2018-09-04 |
Family
ID=56453868
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610177334.5A Expired - Fee Related CN105807789B (zh) | 2016-03-24 | 2016-03-24 | 基于t-s模糊观测器补偿的uuv控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105807789B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106154835B (zh) * | 2016-08-23 | 2018-11-16 | 南京航空航天大学 | 一种基于时延估计的水下运载器终端滑模控制方法 |
CN106444796B (zh) * | 2016-10-08 | 2019-03-05 | 哈尔滨工程大学 | 一种不确定时变时滞的欠驱动uuv深度自适应全局滑模控制方法 |
CN107561940A (zh) * | 2017-09-01 | 2018-01-09 | 哈尔滨理工大学 | 一种基于t‑s模糊系统的动力定位船舶控制方法 |
CN107741744B (zh) * | 2017-11-15 | 2020-09-25 | 哈尔滨工程大学 | 一种海洋观测平台的最优艏向控制方法 |
CN108427414B (zh) * | 2018-03-31 | 2020-10-27 | 西北工业大学 | 一种自主水下航行器水平面自适应轨迹跟踪控制方法 |
CN109270837B (zh) * | 2018-07-31 | 2021-12-24 | 哈尔滨工程大学 | 一种水下超高速航行体级联控制方法 |
CN109407671B (zh) * | 2018-12-11 | 2021-06-29 | 大连海事大学 | 一种欠驱动无人船目标包围控制器结构及设计方法 |
CN109693774B (zh) * | 2018-12-29 | 2020-11-03 | 中国科学院声学研究所 | 一种水下航行器轨迹的控制方法和系统 |
CN109814393B (zh) * | 2019-03-08 | 2021-11-02 | 哈尔滨理工大学 | 一种悬吊漂浮物随动系统的降维观测器和控制器设计方法 |
CN111650832B (zh) * | 2020-05-28 | 2022-04-15 | 哈尔滨工程大学 | 一种水下多足步行机器人机械足姿态跟踪控制方法 |
CN111736612A (zh) * | 2020-07-14 | 2020-10-02 | 大连海事大学 | 一种基于多项式模糊模型的usv航迹跟踪控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102298326A (zh) * | 2011-06-30 | 2011-12-28 | 哈尔滨工程大学 | 欠驱动auv自适应轨迹跟踪控制装置及控制方法 |
CN102722177A (zh) * | 2012-06-27 | 2012-10-10 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN102768539A (zh) * | 2012-06-26 | 2012-11-07 | 哈尔滨工程大学 | 基于迭代的自主水下航行器三维曲线路径跟踪控制方法 |
CN104076821A (zh) * | 2014-06-19 | 2014-10-01 | 哈尔滨工程大学 | 基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制系统 |
CN104881038A (zh) * | 2015-04-22 | 2015-09-02 | 哈尔滨工业大学 | 环境干扰下的水下无人航行器航迹跟踪控制优化方法 |
CN104932517A (zh) * | 2015-05-15 | 2015-09-23 | 哈尔滨工业大学 | 环境干扰下的水下无人航行器航迹跟踪动态面控制优化方法 |
-
2016
- 2016-03-24 CN CN201610177334.5A patent/CN105807789B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102298326A (zh) * | 2011-06-30 | 2011-12-28 | 哈尔滨工程大学 | 欠驱动auv自适应轨迹跟踪控制装置及控制方法 |
CN102768539A (zh) * | 2012-06-26 | 2012-11-07 | 哈尔滨工程大学 | 基于迭代的自主水下航行器三维曲线路径跟踪控制方法 |
CN102722177A (zh) * | 2012-06-27 | 2012-10-10 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN104076821A (zh) * | 2014-06-19 | 2014-10-01 | 哈尔滨工程大学 | 基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制系统 |
CN104881038A (zh) * | 2015-04-22 | 2015-09-02 | 哈尔滨工业大学 | 环境干扰下的水下无人航行器航迹跟踪控制优化方法 |
CN104932517A (zh) * | 2015-05-15 | 2015-09-23 | 哈尔滨工业大学 | 环境干扰下的水下无人航行器航迹跟踪动态面控制优化方法 |
Non-Patent Citations (1)
Title |
---|
UUV航速自适应切换控制方法研究;虎兴林;《中国优秀硕士论文全文数据了》;20150817;正文第4-5章 * |
Also Published As
Publication number | Publication date |
---|---|
CN105807789A (zh) | 2016-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105807789B (zh) | 基于t-s模糊观测器补偿的uuv控制方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
Miao et al. | Spatial curvilinear path following control of underactuated AUV with multiple uncertainties | |
CN111650948B (zh) | 一种可底栖式auv的水平面轨迹快速跟踪控制方法 | |
Gao et al. | Sliding mode adaptive neural network control for hybrid visual servoing of underwater vehicles | |
CN106773713A (zh) | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 | |
Vervoort | Modeling and control of an unmanned underwater vehicle | |
CN109583144B (zh) | 一种无人海洋航行器的动力学优化控制器结构及设计方法 | |
Zhang et al. | APF-based intelligent navigation approach for USV in presence of mixed potential directions: Guidance and control design | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
CN104076688A (zh) | 一种自主式水下航行器主从式协同控制方法 | |
Rigatos | Sensor fusion-based dynamic positioning of ships using Extended Kalman and Particle Filtering | |
CN114967714A (zh) | 一种自主式水下机器人抗扰运动控制方法及系统 | |
Lamraoui et al. | Path following control of fully actuated autonomous underwater vehicle based on LADRC | |
CN116300998A (zh) | 一种rov水下高精度姿态控制方法 | |
CN108829126A (zh) | 一种考虑通讯延时的auv集群协调控制方法 | |
Li et al. | Formation control of a group of AUVs using adaptive high order sliding mode controller | |
Allotta et al. | Development and online validation of an UKF-based navigation algorithm for AUVs | |
CN112904719B (zh) | 一种适用于水下机器人位置环形区域跟踪控制方法 | |
CN115480580A (zh) | 一种基于nmpc的水下机器人路径跟踪与避障的控制方法 | |
Gao et al. | Backstepping adaptive docking control for a full-actuated autonomous underwater vehicle with onboard USBL system | |
CN113110428A (zh) | 一种基于受限反步法控制的舰载机着舰固定时间轨迹跟踪方法 | |
Liu et al. | Steady State Analysis and Optimization for AUV Using Washout Filter Root Locus Correction Method | |
Bai et al. | A fuzzy adaptive drogue control method in autonomous aerial refueling | |
Rosario et al. | Experimental variable structure trajectory tracking control of a surface vessel with a motion capture system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180904 Termination date: 20190324 |