CN105867417B - 一种dvl测速失效时的uuv反步滑模动力定位控制方法 - Google Patents
一种dvl测速失效时的uuv反步滑模动力定位控制方法 Download PDFInfo
- Publication number
- CN105867417B CN105867417B CN201610252029.8A CN201610252029A CN105867417B CN 105867417 B CN105867417 B CN 105867417B CN 201610252029 A CN201610252029 A CN 201610252029A CN 105867417 B CN105867417 B CN 105867417B
- Authority
- CN
- China
- Prior art keywords
- uuv
- vector
- sliding mode
- speed
- dvl
- 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 25
- 238000009415 formwork Methods 0.000 title abstract 5
- 239000013598 vector Substances 0.000 claims abstract description 74
- 238000005259 measurement Methods 0.000 claims abstract description 32
- 239000011159 matrix material Substances 0.000 claims description 24
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 4
- 239000000853 adhesive Substances 0.000 claims description 3
- 230000001070 adhesive effect Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 238000010276 construction Methods 0.000 abstract 1
- 101100171403 Arabidopsis thaliana DVL9 gene Proteins 0.000 description 4
- 238000004088 simulation Methods 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000004064 recycling Methods 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种DVL测速失效时的UUV反步滑模动力定位控制方法,涉及一种UUV动力定位控制方法。为了解决在UUV反步滑模动力定位控制中测速传感器DVL测量失效的问题。包括:在DVL测速失效时,测量UUV北向、东向位置和艏向角,速度估计器在线估计出北向、东向速度和艏向角。根据北向、东向、艏向角测量值与期望值的误差和估计的北向、东向速度、艏向角,构造使UUV渐进稳定的反步滑模控制律,解算出UUV在纵荡、横荡和艏摇三个自由度上的控制向量。控制向量经过推力分配,得到UUV主推进器、水平辅助推进器的推力,从而使UUV达到期望的北向、东向位置和艏向角,实现在DVL测速失效时UUV在水平面内的反步滑模动力定位控制。
Description
技术领域
本发明涉及一种UUV动力定位控制方法,特别涉及一种DVL测速失效时的UUV反步滑模动力定位控制方法。
背景技术
UUV在执行水面定点拍照、水面区域值守、水面布放回收时的位置保持等任务时,需要通过安装的推进器完成位置和姿态的控制,实现动力定位。而UUV在水面的动力定位是具有一定非线性的特点,而且在水面也会受到风、浪、流干扰的影响,因此设计一个具有一定非线性、鲁棒性的控制器,对UUV水面动力定位的任务而言是十分必要的。
基于反步法设计的滑模动力定位控制方法,一方面可以保证***的渐进稳定性,另一方面可以在UUV动力学模型非线性、不确定性的情况保证一定的控制精度。在CNKI中检索发现,西北工业大学高剑等在《机械科学与技术》(2006年第6期)发表的文章《基于自适应反演滑模控制的AUV水平面动力定位方法》针对AUV水平面动力定位问题,提出了自适应反演控制方法,提高了在海流扰动下控制***的鲁棒性。但是,在UUV反步滑模动力定位控制方法中,通常需要UUV的速度信息。但是,工程应用速度传感器DVL时有失效现象,例如DVL设备软硬件故障、软质海底、海底深度超过速度传感器DVL的量程等,这将导致依赖于速度传感器DVL的反步滑模动力定位控制方法失效。
发明内容
本发明的目的是为了解决在UUV反步滑模动力定位控制中,测速传感器DVL测量失效的问题,本发明提供一种DVL测速失效时的UUV反步滑模动力定位控制方法。
本发明的一种DVL测速失效时的UUV反步滑模动力定位控制方法,所述方法包括如下步骤:
步骤1:UUV在水面进行纵荡、横荡和艏摇的三自由度反步滑模动力定位控制,获得期望向量ηd=[xd yd ψd]T,xd、yd和ψd分别表示UUV在大地坐标下的北向位置、东向位置和艏向角的期望值;
步骤2:对UUV的经纬度和艏向角进行采集,同时采用速度传感器DVL对UUV进行速度采集,确定向量η=[x y ψ]T,x、y和ψ分别表示采集的UUV在大地坐标下的北向位置、东向位置和艏向角的值;
步骤3:故障检测模块实时检测,当检测到测速无效时,产生触发信息启动速度估计器对UUV的速度信息进行估计,速度估计器是以UUV的水平面三自由度动力学模型为基础,以采集的北向位置x、东向位置y和艏向角ψ作为速度估计器的输入,并且引入了北向位置、东向位置和艏向角估计误差的滑模面函数以消除速度估计器模型的不确定性:
其中,为UUV在大地坐标系下的北向位置、东向位置和艏向角的估计向量,J∈R3×3是大地坐标系与UUV坐标系之间的变换矩阵,为UUV坐标下的北向速度、东向速度和艏向角速度估计向量,sat(*)为饱和函数,为速度估计器的滑模面函数,φ1为边界层厚度;M∈R3×3为UUV的惯性质量矩阵;C∈R3×3为UUV离心力和哥式力矩阵;D∈R3×3为粘性矩阵,为外界环境的扰动估计向量,τ∈R3×1为控制力向量;L1、L2、L3∈R3×3为速度估计器增益对角矩阵;
饱和函数sat(*)具体形式如下:
其中,φ1为正常数,表示边界层的厚度,i=1,2,3;
步骤4:根据期望向量ηd与向量获得偏差向量反步滑模动力定位控制器再根据向量和偏差向量ηe,获得控制力向量τ;
步骤5:根据获得的控制力向量τ进行推力分配,使UUV的主推进器和水平辅助推进器在分配得到的推力下工作,从而使UUV北向位置、东向位置和艏向角达到期望值。
所述步骤4中,控制力向量τ:
误差向量中间虚拟镇定向量α1=c1z1,c1为α1的增益矩阵,表示第一个误差向量的比例系数,误差向量控制器的滑模面函数s2=Kz1+z2,K为滑模面函数s2中误差向量z1与误差向量z2的比例系数;h为控制器滑模面函数s2的增益矩阵,κ为滑模面饱和切换函数增益矩阵,φ1、φ2为边界层厚度。
所述步骤5中,根据获得的控制力向量τ进行推力分配:
Fml=0.5(τx+βτN/Lm),-γ1F1max≤Fml≤γ1F1max (8)
Fmr=0.5(τx-βτN/Lm),-γ1F1max≤Fmr≤γ1F1max (9)
Fbh=0.5(τy-(1-β)τN/Lh),-γ2F2max≤Fbh≤γ2F2max (10)
Fsh=0.5(τy+(1-β)τN/Lh),-γ2F2max≤Fsh≤γ2F2max (11)
其中,Fml、Fmr、Fbh、Fsh分别表示左主推进器、右主推进器、艏水平辅助推进器、艉水平辅助推进器分配的推力;Lm、Lh分别表示左主推进器和右主推进器间距、艏水平辅助推进器和艉水平辅助推进器间距;γ1、γ2分别为主推进器、水平辅助推进器限额比,F1max、F2max分别为主推进器、水平辅助推进器能够提供的最大推力,β表示推力分配系数;β=0时完全由水平辅助推进器来提供转艏力矩,β=1时完全由主推进器来提供转艏力矩。
所述步骤2中,采用位置测量传感器GPS和姿态传感器罗经对UUV的经纬度和艏向角进行采集。
本发明的有益效果在于,可以在速度测量传感器DVL测量失效时,利用速度估计器估计出UUV较精确的速度信息。反步滑模控制器可以提高UUV动力定位的控制精度,并且在一定的外界环境的干扰下具有一定的鲁棒性,满足作业任务动力定位控制的需求。实用性强,在工程实现中简单易用,可以根据UUV推进器的健康状态调整推力分配系数,控制主推占转艏力矩的比例;采用基于速度估计器的反步滑模动力定位控制方法解决了DVL测速失效时反步滑模控制律中速度信息缺失的问题。
可以在速度测量传感器DVL测量失效时,利用速度估计器估计出UUV较精确的速度信息,为UUV反步滑模控制器提供速度输入,使UUV能在一定的外界环境干扰下实现动力定位功能,且具有一定的鲁棒性。另外,本发明可以根据UUV推进器的工作于健康状态调整推力分配系数,调整主推进器占转艏力矩的比例,实用性强,在工程实现中简单易用。
附图说明
图1为具体实施方式中的一种DVL测速失效时的UUV反步滑模动力定位控制方法的原理示意图;
图2为UUV推进器配置示意图;
图3为北向位置的测量值及北向位置、速度估计值的对比图;
图4为东向位置的测量值及东向位置、速度估计值的对比图;
图5为艏向角的测量值及艏向角、角速度的估计值的对比图;
图6为推力分配完成后左、右主推进器的推力变化图;
图7为推力分配完成后艏、艉水平辅助推进器的推力变化图。
具体实施方式
结合图1至图7说明本实施方式,本实施方式所述的一种DVL测速失效时的UUV反步滑模动力定位控制方法,所述方法包括如下步骤:
步骤1:UUV6在水面进行纵荡、横荡和艏摇的三自由度反步滑模动力定位控制,首先初始化北东坐标系的原点,并且开始启动位置测量传感器GPS12、姿态传感器罗经11和速度传感器DVL9,位置测量传感器GPS12获得UUV的经纬度;姿态传感器罗经11获得UUV6的艏向角ψ;速度传感器DVL9获得UUV的速度;
步骤2:位置测量传感器GPS12采集到的UUV6的经纬度信息lon和lat,经过坐标变换10,获得UUV6在大地坐标下的北向位置x和东向位置y;姿态传感器罗经11获得UUV6的艏向角ψ;向量η=[x y ψ]T,x、y和ψ分别表示采集的UUV6在大地坐标下的北向位置、东向位置和艏向角的值;速度传感器DVL9获得UUV6的速度;
步骤3:DVL故障检测模块8实时检测,当检测到速度传感器DVL9测速失效的状态时,立刻发送启动速度估计器7的触发信息,速度估计器7开始启动;
步骤4:速度估计器7是以UUV6的水平面三自由度动力学模型为基础,以北向位置x、东向位置y和艏向角ψ作为速度估计器7的输入,并且引入了北向位置、东向位置和艏向角估计误差的滑模面函数以消除速度估计器模型的不确定性,确定速度估计器模型:
其中,为UUV6在大地坐标系下的北向位置、东向位置和艏向角的估计向量,J∈R3×3是大地坐标系与UUV6坐标系之间的变换矩阵,为UUV6坐标下的北向速度、东向速度和艏向角速度估计向量,sat(*)为饱和函数,为速度估计器7的滑模面函数,φ1为边界层厚度;M∈R3×3为UUV6的惯性质量矩阵;C∈R3×3为UUV6离心力和哥式力矩阵;D∈R3×3为粘性矩阵,为外界环境的扰动估计向量,τ∈R3×1为控制力向量;L1、L2、L3∈R3×3为速度估计器7增益对角矩阵;
饱和函数sat(*)具体形式如下:
其中,φ1为正常数,表示边界层的厚度,i=1,2,3;
根据UUV6的水平面3自由度动力学模型、GPS测量、转换后的北东坐标以及罗经测量到的艏向角,设计速度估计器模型。为抵抗速度估计器模型的不确定性,选取北向、东向位置和艏向角的估计误差作为滑模面,使得估计值按照滑模面上轨迹逐渐逼近位姿的真实值,这样也会使得速度的估计逐渐逼近于速度的真实值,为控制器提供精确的状态信息,为高精度的控制性能提供可能。为防止抖振,采用了饱和函数sat(.)。
步骤5:根据采集的北向位置x、东向位置y和艏向角ψ,解算速度估计器模型,估计出UUV6的速度信息并且得到向量
步骤6:通过比较器1,计算期望向量ηd与向量之间的偏差向量偏差向量ηe和向量同时输入至反步滑模动力定位控制器2中;期望向量ηd=[xd yd ψd]T,xd、yd和ψd分别表示UUV6在大地坐标下的北向位置、东向位置和艏向角的期望值;
步骤7:北向、东向和艏向角估计值与期望向量的偏差为误差向量中间虚拟镇定向量α1=c1z1,c1为α1的增益矩阵,表示第一个误差向量的比例系数,K为滑模面函数s2中误差向量z1与误差向量z2的比例系数;得到
步骤8:设定误差向量
步骤9:定义第一个Lyapunov函数V1,并对V1求导进行误差向量z1的稳定性分析:
然后,对误差向量z2求导:
设计第二个Lyapunov函数:
s2=Kz1+z2 (16)
其中,s2为反步滑模控制器的滑模面函数,K为控制器的滑模面增益矩阵,K∈R3×3为3阶正定对角阵;
对V2进行求导:
根据Lyapunov稳定性理论,为使***渐进稳定,设计如下滑模控制律:
其中,h为控制器滑模面函数增益矩阵,κ为滑模面饱和切换函数增益矩阵,φ1、φ2为边界层厚度;
在DVL测速失效情况下,根据位置测量传感器GPS12采集得到的UUV经纬度信息,姿态传感器罗经采集的艏向角信息,速度估计器7估计的UUV6速度信息推算得到具有鲁棒性的反步滑模控制律。反步滑模控制律是基于反步法设计的,并且在控制律中添加误差向量z1和z2的组合滑模面函数来抵消模型的不确定性以及外界扰动。
步骤10:反步滑模动力定位控制器2的参数初始化完成后,解算得到了一个时间拍内的控制力向量τ,经过推力分配模型3,把纵荡、横荡、艏摇三个自由度上的控制合力分配到UUV6装配的主推进器4和水平辅助推进器5上,如图2所示,UUV6的推进器包括主推进器4、水平辅助推进器5和垂直辅助推进器,主推进器4包括左主推进器13和右主推进器14,水平辅助推进器5包括艏水平辅助推进器18和艉水平辅助推进器17;垂直辅助推进器包括UUV艉部垂直辅助推进器15和艏部垂直辅助推进器16;推力分配模型3如下:
Fml=0.5(τx+βτN/Lm),-γ1F1max≤Fml≤γ1F1max
Fmr=0.5(τx-βτN/Lm),-γ1F1max≤Fmr≤γ1F1max
Fbh=0.5(τy-(1-β)τN/Lh),-γ2F2max≤Fbh≤γ2F2max
Fsh=0.5(τy+(1-β)τN/Lh),-γ2F2max≤Fsh≤γ2F2max
其中,Fml、Fmr、Fbh、Fsh分别表示左主推进器13、右主推进器14、艏水平辅助推进器18、艉水平辅助推进器17分配的推力;Lm、Lh分别表示左主推进器13和右主推进器14间距、艏水平辅助推进器18和艉水平辅助推进器17间距;γ1、γ2分别为主推进器4、水平辅助推进器5限额比,F1max、F2max分别为主推进器4、水平辅助推进器5能够提供的最大推力,β表示推力分配模型3的系数;β=0时完全由水平辅助推进器5来提供转艏力矩,β=1时完全由主推进器4来提供转艏力矩;
步骤11:完成一个时间拍的控制作用后,从步骤5至步骤9开始下一个时间拍对UUV6进行反步滑模动力定位控制;
在仿真平台下,使UUV6从北东坐标下的初始位置(0m,1m,10°)、初始速度(0m/s,0/s,0rad/s)动力定位至目标位置(5m,5m,30°)。速度估计器7、反步滑模控制器的各个参数,在反复调试下观察估计效果及控制效果后,选择最佳的参数如下:
L1=diag(10,10,10)、L2=diag(10,10,1000)、L3=diag(10,10,10);
K=diag(0.5,0.5,0.5)、c1=diag(0.41,0.35,0.41)、φ1=1、φ2=1;
h=diag(1,1,1)、κ=diag(0.3,0.3,0.3)、β=0、γ1=0.8、γ2=0.8;
仿真结果如图3至图7,图3至图5显示了采用速度估计器7的北向、东向位置、艏向角的估计值和测量值的对比,可以看到位置估计值与测量值误差很小,从而保证了速度估计值趋于实际的速度。图6和图7显示了主推和水平辅推的推力实际变化曲线,可以看到推力变化平滑,有利于推进器健康长久的工作。仿真结果表明,速度估计器7的估计误差很小,可以在DVL失效时在线估计出UUV6的速度,推力分配模型3方法能够有效的把广义控制向量分配到各个推进器上,实现了UUV6的反步滑模动力定位控制。
Claims (4)
1.一种DVL测速失效时的UUV反步滑模动力定位控制方法,其特征在于,所述方法包括如下步骤:
步骤1:UUV在水面进行纵荡、横荡和艏摇的三自由度反步滑模动力定位控制,获得期望向量ηd=[xd yd ψd]T,xd、yd和ψd分别表示UUV在大地坐标下的北向位置、东向位置和艏向角的期望值;
步骤2:对UUV的经纬度和艏向角进行采集,同时采用速度传感器DVL对UUV进行速度采集,确定向量η=[x y ψ]T,x、y和ψ分别表示采集的UUV在大地坐标下的北向位置、东向位置和艏向角的值;
步骤3:故障检测模块实时检测,当检测到速度传感器DVL测速无效时,产生触发信息启动速度估计器对UUV的速度信息进行估计,速度估计器是以UUV的水平面三自由度动力学模型为基础,以采集的北向位置x、东向位置y和艏向角ψ作为速度估计器的输入,并且引入了北向位置、东向位置和艏向角估计误差的滑模面函数以消除速度估计器模型的不确定性:
其中,为UUV在大地坐标系下的北向位置、东向位置和艏向角的估计向量,J∈R3×3是大地坐标系与UUV坐标系之间的变换矩阵,为UUV坐标下的北向速度、东向速度和艏向角速度估计向量,sat(*)为饱和函数,为速度估计器的滑模面函数,φ1为边界层厚度;M∈R3×3为UUV的惯性质量矩阵;C∈R3×3为UUV离心力和哥式力矩阵;D∈R3×3为粘性矩阵,为外界环境的扰动估计向量,τ∈R3×1为控制力向量;L1、L2、L3∈R3×3为速度估计器增益对角矩阵;
饱和函数sat(*)具体形式如下:
其中,φ1为正常数,表示边界层的厚度,i=1,2,3;
步骤4:根据期望向量ηd与向量获得偏差向量将向量和偏差向量ηe输入至反步滑模动力定位控制器中,
步骤5:设定误差向量根据Lyapunov稳定性理论,获得稳定的控制力向量τ;
误差向量中间虚拟镇定向量α1=c1z1,c1为α1的增益矩阵,表示第一个误差向量的比例系数,K为反步滑模控制器的滑模面函数s2中误差向量z1与误差向量z2的比例系数;
步骤6:反步滑模动力定位控制器的参数初始化完成后,解算得到了一个时间拍内的控制力向量τ,经过推力分配模型,把纵荡、横荡、艏摇三个自由度上的控制合力分配到UUV装配的主推进器和水平辅助推进器上;
步骤7:完成一个时间拍的控制作用后,从步骤3至步骤5开始下一个时间拍对UUV进行反步滑模动力定位控制。
2.根据权利要求1所述的一种DVL测速失效时的UUV反步滑模动力定位控制方法,其特征在于,所述步骤4中,控制力向量τ:
误差向量中间虚拟镇定向量α1=c1z1,c1为α1的增益矩阵,表示第一个误差向量的比例系数,误差向量控制器的滑模面函数s2=Kz1+z2,K为滑模面函数s2中误差向量z1与误差向量z2的比例系数;h为控制器滑模面函数s2的增益矩阵,κ为滑模面饱和切换函数增益矩阵,φ1、φ2为边界层厚度。
3.根据权利要求1或2所述的一种DVL测速失效时的UUV反步滑模动力定位控制方法,其特征在于,所述步骤5中,根据获得的控制力向量τ进行推力分配:
Fml=0.5(τx+βτN/Lm),-γ1F1max≤Fml≤γ1F1max (8)
Fmr=0.5(τx-βτN/Lm),-γ1F1max≤Fmr≤γ1F1max (9)
Fbh=0.5(τy-(1-β)τN/Lh),-γ2F2max≤Fbh≤γ2F2max (10)
Fsh=0.5(τy+(1-β)τN/Lh),-γ2F2max≤Fsh≤γ2F2max (11)
其中,Fml、Fmr、Fbh、Fsh分别表示左主推进器、右主推进器、艏水平辅助推进器、艉水平辅助推进器分配的推力;Lm、Lh分别表示左主推进器和右主推进器间距、艏水平辅助推进器和艉水平辅助推进器间距;γ1、γ2分别为主推进器、水平辅助推进器限额比,F1max、F2max分别为主推进器、水平辅助推进器能够提供的最大推力,β表示推力分配系数;β=0时完全由水平辅助推进器来提供转艏力矩,β=1时完全由主推进器来提供转艏力矩。
4.根据权利要求3所述的一种DVL测速失效时的UUV反步滑模动力定位控制方法,其特征在于,所述步骤2中,采用位置测量传感器GPS和姿态传感器罗经对UUV的经纬度和艏向角进行采集。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610252029.8A CN105867417B (zh) | 2016-04-21 | 2016-04-21 | 一种dvl测速失效时的uuv反步滑模动力定位控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610252029.8A CN105867417B (zh) | 2016-04-21 | 2016-04-21 | 一种dvl测速失效时的uuv反步滑模动力定位控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105867417A CN105867417A (zh) | 2016-08-17 |
CN105867417B true CN105867417B (zh) | 2018-09-28 |
Family
ID=56632780
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610252029.8A Expired - Fee Related CN105867417B (zh) | 2016-04-21 | 2016-04-21 | 一种dvl测速失效时的uuv反步滑模动力定位控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105867417B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444794B (zh) * | 2016-09-20 | 2019-03-05 | 哈尔滨工程大学 | 一种无参数欠驱动uuv垂直面路径跟踪滑模控制方法 |
CN106227223A (zh) * | 2016-09-27 | 2016-12-14 | 哈尔滨工程大学 | 一种基于动态滑模控制的uuv轨迹跟踪方法 |
CN109298632A (zh) * | 2018-09-01 | 2019-02-01 | 哈尔滨工程大学 | 基于滑模算法与推力二次调整的自主式水下机器人推进器容错控制方法 |
CN109739089B (zh) * | 2019-01-07 | 2021-08-10 | 大连海事大学 | 一种无人驾驶船舶非周期采样远程操控***及设计方法 |
CN110687918A (zh) * | 2019-10-17 | 2020-01-14 | 哈尔滨工程大学 | 一种基于回归型神经网络在线逼近的水下机器人轨迹跟踪控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102385316A (zh) * | 2011-09-16 | 2012-03-21 | 哈尔滨工程大学 | 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法 |
CN102722177A (zh) * | 2012-06-27 | 2012-10-10 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN103324195A (zh) * | 2013-06-14 | 2013-09-25 | 哈尔滨工程大学 | 基于反步法的船舶自适应鲁棒航向跟踪控制方法 |
CN103777635A (zh) * | 2014-01-13 | 2014-05-07 | 哈尔滨工程大学 | 动力定位船舶鲁棒自适应航迹跟踪控制*** |
CN104635509A (zh) * | 2014-12-03 | 2015-05-20 | 陕西科技大学 | 多轴联动***精度控制的反步-滑模控制器及控制方法 |
-
2016
- 2016-04-21 CN CN201610252029.8A patent/CN105867417B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102385316A (zh) * | 2011-09-16 | 2012-03-21 | 哈尔滨工程大学 | 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法 |
CN102722177A (zh) * | 2012-06-27 | 2012-10-10 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN103324195A (zh) * | 2013-06-14 | 2013-09-25 | 哈尔滨工程大学 | 基于反步法的船舶自适应鲁棒航向跟踪控制方法 |
CN103777635A (zh) * | 2014-01-13 | 2014-05-07 | 哈尔滨工程大学 | 动力定位船舶鲁棒自适应航迹跟踪控制*** |
CN104635509A (zh) * | 2014-12-03 | 2015-05-20 | 陕西科技大学 | 多轴联动***精度控制的反步-滑模控制器及控制方法 |
Non-Patent Citations (1)
Title |
---|
基于UUV动力学模型的导航方法;严浙平;《华中科技大学学报》;20131130;第41卷(第11期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN105867417A (zh) | 2016-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105867417B (zh) | 一种dvl测速失效时的uuv反步滑模动力定位控制方法 | |
CN105807789B (zh) | 基于t-s模糊观测器补偿的uuv控制方法 | |
Karmozdi et al. | INS-DVL navigation improvement using rotational motion dynamic model of AUV | |
CN106773713A (zh) | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 | |
CN102862666B (zh) | 一种基于自适应ukf的水下机器人状态和参数联合估计方法 | |
CN104236586B (zh) | 基于量测失准角的动基座传递对准方法 | |
Hua et al. | Stability analysis of velocity-aided attitude observers for accelerated vehicles | |
CN108303079B (zh) | 一种水下usbl反向应用的数据平滑方法 | |
Randeni P et al. | Parameter identification of a nonlinear model: replicating the motion response of an autonomous underwater vehicle for dynamic environments | |
CN109945895B (zh) | 基于渐消平滑变结构滤波的惯性导航初始对准方法 | |
CN111024124B (zh) | 一种多传感器信息融合的组合导航故障诊断方法 | |
JP2007232443A (ja) | 慣性航法装置およびその誤差補正方法 | |
CN112015086B (zh) | 一种欠驱动水面船有限时间路径跟踪输出反馈控制方法 | |
Yoon et al. | Estimation of the roll hydrodynamic moment model of a ship by using the system identification method and the free running model test | |
CN105606093A (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
KR20170071440A (ko) | 파라미터 적응형 백스테핑 제어 auv 시스템 | |
Ko et al. | Fault detection and diagnosis of sensors and actuators for unmanned surface vehicles | |
CN103616026B (zh) | 一种基于h∞滤波的auv操纵模型辅助捷联惯导组合导航方法 | |
CN110873813B (zh) | 一种水流速度估算方法、组合导航方法及装置 | |
Ghorbani | Line of sight waypoint guidance for a container ship based on frequency domain identification of Nomoto model of vessel | |
Hou et al. | Improved exponential weighted moving average based measurement noise estimation for strapdown inertial navigation system/Doppler velocity log integrated system | |
CN113984045B (zh) | 水下机器人移动式对接目标运动状态估计方法及*** | |
CN116185024A (zh) | 一种无人艇的艏向抗扰控制方法 | |
CN113190025B (zh) | 一种适用于变结构水下机器人的运动控制方法 | |
JP5315585B2 (ja) | 航跡生成システム、その誤差共分散行列初期値設定装置、航跡生成方法およびその誤差共分散行列初期値設定方法 |
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 |
Granted publication date: 20180928 Termination date: 20200421 |
|
CF01 | Termination of patent right due to non-payment of annual fee |