CN109050835B - 全驱动自主水下机器人结构及回收三维路径跟踪方法 - Google Patents

全驱动自主水下机器人结构及回收三维路径跟踪方法 Download PDF

Info

Publication number
CN109050835B
CN109050835B CN201810885325.0A CN201810885325A CN109050835B CN 109050835 B CN109050835 B CN 109050835B CN 201810885325 A CN201810885325 A CN 201810885325A CN 109050835 B CN109050835 B CN 109050835B
Authority
CN
China
Prior art keywords
tracking
section
bow
sliding mode
recovery
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
Application number
CN201810885325.0A
Other languages
English (en)
Other versions
CN109050835A (zh
Inventor
曾庆军
姚金艺
朱志宇
马国军
戴文文
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu University of Science and Technology
Original Assignee
Jiangsu University of Science and Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Jiangsu University of Science and Technology filed Critical Jiangsu University of Science and Technology
Priority to CN201810885325.0A priority Critical patent/CN109050835B/zh
Publication of CN109050835A publication Critical patent/CN109050835A/zh
Application granted granted Critical
Publication of CN109050835B publication Critical patent/CN109050835B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63CLAUNCHING, HAULING-OUT, OR DRY-DOCKING OF VESSELS; LIFE-SAVING IN WATER; EQUIPMENT FOR DWELLING OR WORKING UNDER WATER; MEANS FOR SALVAGING OR SEARCHING FOR UNDERWATER OBJECTS
    • B63C11/00Equipment for dwelling or working underwater; Means for searching for underwater objects
    • B63C11/52Tools specially adapted for working underwater, not otherwise provided for
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0265Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
    • G05B13/0275Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using fuzzy logic only
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions

Landscapes

  • Engineering & Computer Science (AREA)
  • Artificial Intelligence (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Software Systems (AREA)
  • Automation & Control Theory (AREA)
  • Evolutionary Computation (AREA)
  • Health & Medical Sciences (AREA)
  • Medical Informatics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Mechanical Engineering (AREA)
  • Ocean & Marine Engineering (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种全驱动自主水下机器人结构及回收三维路径跟踪方法,提供一种三段式回收三维路径跟踪方法,以及一种用于机器人回收直线归位阶段与直线跟踪阶段的改进的非奇异终端模糊滑模控制算法。所采用的三维路径跟踪方法,将回收路径分为三段,将每段曲线转化为空间离散点序列对其跟踪控制。所采用的改进的非奇异终端模糊滑模算法,在滑模控制中,设计分段切换函数,实现多个滑动模态,并通过模糊算法对滑模增益进行实时优化,使其能快速、平稳地追踪目标点,增强回收三维路径跟踪性能,提高回收成功率。

Description

全驱动自主水下机器人结构及回收三维路径跟踪方法
技术领域
本发明涉及自主水下机器人,尤其涉及全驱动自主水下机器人结构及回收三维路径跟踪阶段方法,属于机器人控制技术领域。
背景技术
随着信息技术的不断发展,自主式水下无人航行器(AUV)作为探索海洋空间的有力工具之一,在军事和科学研究方面起着越来越重要的作用。未来的AUV需要更长的水下工作时间、更大的自主性、更隐蔽的情报收集能力、更高速的数据分析速度以及更强大的通信能力。而这些目标的实现主要受到自身携带能源和水下通信两个因素的限制。由于几十年来电池技术一直没有获得突破性进展,AUV的水下工作时间仍然很短,需要频繁的回收和布放。此外水声通信速率较低,AUV难以及时回传所收集到的数据。两者均极大增加了AUV的使用成本,降低了其工作效率。因此,对AUV的回收对接研究显得尤为重要。在回收过程中,AUV路径跟踪控制非常关键,尤其在复杂的海洋环境下,探究有效的回收路径跟踪控制方法,完成回收任务,成为国内外研究的热点,而且在军事、科研等方面具有现实意义。
全驱动自主水下机器人的执行机构一般采用多推进器操纵的设计方式,通过改变多推进器的推力来实现自主水下机器人的纵向运动,转艏运动以及升沉运动。由于全驱动自主水下机器人自身运动具有高度的非线性以及强耦合性,并且在水下航行时容易受到海流以及信号传输干扰等问题,这些因素给运动控制带来很大难度。这些都成为全驱动AUV三维空间跟踪控制器设计的难点。
目前,国内外就三维路径的跟踪问题研究的较少,研究多针对于水平面、垂直面的二维平面控制。本发明首先将三维路径分解为均匀的离散点序列,与传统的航路点跟踪方法相比,本方法对于曲线点的规划及选取更加快捷、平滑。在控制器的选择上,由于全驱动自主水下机器人模型的高度非线性与不确定性的特点,本发明采用改进的非奇异终端模糊滑模控制算法。目前应用于自主水下机器人三维路径跟踪控制多为模糊控制、滑模控制等智能控制算法。模糊控制算法虽然具有鲁棒性强,抗干扰性强等特点,但是模糊控制器参数难以直接确定;滑模控制算法可以不依赖系统模型,但系统本身所带来的抖振问题难以消除,影响了系统的控制精度。申请号为“201210490435.X”的专利文献公开了一种“用于喷药移动机器人的轨迹跟踪滑模控制系统和控制方法”,滑模控制带来的抖振问题没有得到解决,跟踪精度较差;申请号为“201610835447.X”的专利文献公开了“一种基于自适应滑模控制的UUV路径跟踪方法”,其将滑模控制与自适应控制相结合,但控制器仍然存在对机器人惯量及不确定性的依赖。
发明内容
本发明的目的在于提供一种全驱动自主水下机器人结构及回收三维路径跟踪方法,应用于全驱动自主水下机器人回收控制过程,提供全驱动自主水下机器人回收直线归位与直线跟踪阶段的三维路径跟踪控制方法,以及提供一种全驱动自主水下机器人回收直线归位阶段与直线跟踪阶段的改进的非奇异终端模糊滑模控制算法。
本发明的目的通过以下技术方案予以实现:
一种全驱动自主水下机器人结构,包括艏段2,艏部推进段7,电子舱段12,艉部推进段15和主推进段18五大部分;整体采用鱼雷形流线型结构,艏段2与艏部推进段7、艏部推进段7与电子舱段12,电子舱段12与艉部推进段15、艉部推进段15与主推进段18同心密封相连;艏段2包括探测仪1、避碰声纳4和艏段壳体3,探测仪1通过密封安装于艏段2前部,避碰声呐4通过水密接插件安装于艏段2上部,艏段壳体3采用铝合金6061制造并进行表面硬质氧化处理,艏段壳体3采用半球形外形以保证水下机器人具有良好的流线型并兼顾艏部的安装空间;艏部推进段7由艏部侧向推进器5、艏部垂向推进器8和艏部推进段壳体6组成,侧向推进器5水平放置,安装于艏部推进段7前侧方,垂向推进器8垂直放置,安装于艏部推进段7后上方,驱动电机与推进螺旋桨之间采用磁耦合联轴器连接;电子舱段12由锂电池9、抛载10、天线导流罩13、电子舱段壳体11组成,天线导流罩13包括超短基线接收器和天线,锂电池9环绕相连于电子舱段12前部,下部通过电磁铁将抛载10垂直固定,后上部通过水密接插件与天线导流罩13相连;艉部推进段15包括艉部垂向推进器14、艉部侧向推进器17和艉部推进段壳体16组成,垂向推进器14垂直放置,安装于艉部推进段15前上方,侧向推进器17水平放置,安装于艉部推进段15后侧方,驱动电机与推进螺旋桨之间采用磁耦合联轴器连接;主推进段14由主推进器19组成,主推进器19采用桨后舵设计。
一种全驱动自主水下机器人的回收三维路径跟踪方法,回收控制过程包括:
过程1:直线归位阶段20,这个阶段是指回收装置24用超短基线定位到AUV开始,进入对接中轴线21的跟踪过程;利用超短基线提供的相对位置、姿态信息来调整AUV与对接装置的位置,使得在消耗较短对接中轴线距离的情况下,将AUV航行至中轴线上,使AUV的姿态与中轴线一致,利于进一步实时对接;
过程2:直线跟踪阶段22,这个阶段指是指AUV重心进入中轴线21开始直到距离对接口3-5米的阶段,在这个阶段要保证AUV沿中轴线航行,且艏向角指向对接口;
过程3:艏向调整阶段23,这个阶段是指过程2结束到对接成功的阶段,进入此阶段需要满足两个条件:一是AUV与对接装置轴线距离小于5米,二是相对位置、姿态偏差超出预设值;如果直线跟踪阶段保持的位置、姿态偏差一直未超过预设值,则可以略过此阶段,直接完成对接,即只有在出现足够误差时,才会触发艏向调整阶段。
本发明的目的还可以采用以下技术措施进一步实现:
前述全驱动自主水下机器人的回收三维路径跟踪方法,其中机器人回收直线归位阶段20与直线跟踪阶段22的三维路径跟踪控制方法包括以下步骤:
步骤1:将回收路径三维曲线转化为空间点序列;
步骤2:将空间点序列描述为自主水下航行器的目标跟踪点,将其转化为自主水下航行器的惯性坐标系下的坐标,对其进行目标跟踪;
步骤3:全驱动控制形式的自主水下航行器,对单个目标点进行跟踪控制,将水下机器人的位置和艏向角与目标点位置和期望艏向值进行对比得到跟踪误差,采用改进的非奇异终端模糊滑模算法,输出为各推进器的推力;
步骤4:进行步骤2所述目标跟踪点的更替,并依次运行步骤3完成每个目标点的跟踪,最终完成空间点序列的跟踪,实现回收三维路径跟踪。
前述全驱动自主水下机器人的回收三维路径跟踪方法,其中改进的非奇异终端模糊滑模控制算法包括以下步骤:
步骤1:全驱动自主水下机器人的运动学数学模型表示为:
Figure BDA0001755503130000041
式中,η=[x y z θ ψ]T,为水下机器人相对于惯性坐标系中的位置和姿态角,其中θ为俯仰角,ψ为航向角,此处不考虑横滚角对机器人的影响;v=[u v w q r]T,为水下机器人在载体坐标系内的线速度和角速度,其中u,v,w分别为x,y,z坐标轴方向的线速度,q,r为y,z坐标轴方向的角速度;J(η)为坐标转换矩阵;M为包含附加质量的惯量矩阵且满足对称性M=MT>0,
Figure BDA0001755503130000045
C(v)v为包含了质量矩阵和附加质量矩阵引起的科氏力与向心力且满足反对称性;D(v)为黏性水动力系数矩阵且D(v)>0;v为去除环境干扰力时水下机器人的速度;g(η)是恢复力和力矩;τ是各自由度的力和力矩;ξ为环境干扰;
步骤2:改进的非奇异终端模糊滑模控制器根据当前水下机器人的位置和艏向角与目标点位置和期望艏向值得到位置跟踪误差和艏向跟踪误差,通过模糊控制器对滑模增益进行优化,得出各推进器的推力;
位置跟踪误差为:
Figure BDA0001755503130000042
其中,ep为位置跟踪误差,xd,yd,zd分别为目标点三轴方向上的位置坐标,x,y,z分别为当前水下机器人三轴方向上的位置坐标;
艏向跟踪误差为:
eψ=ψd-ψ (3)
其中,eψ为艏向跟踪误差,ψd为期望艏向值,ψ为当前水下机器人的艏向角;
定义n=[x y z θ ψ]T,与η等同,是机器人实时的位置和姿态,则
Figure BDA0001755503130000044
表示三轴方向上线速度和角速度,
Figure BDA0001755503130000043
表示三轴方向上线加速度和角加速度,令常数nd为目标点,那么跟踪误差表示为ne=n-nd,算法实现目标为寻找适当的控制律,使水下机器人的位置n能够尽快地到达期望值nd,即ne要在有限时间内快速收敛到零;
定义运算
Figure BDA0001755503130000051
其中,sgn为符号函数,x1,…x5为各状态变量,γ1,…γ5为状态变量系数;
设计非奇异终端滑模面:
Figure BDA0001755503130000052
为了使连接点处的速度连续,即ne=ε时
Figure BDA0001755503130000053
要相等,所以有
ε=βq/p-q (6)
式中,ε=diag{ε1,…ε5},β=diag{β1,…β5},βi∈R+,s=[s1,…s5]T,ne,
Figure BDA0001755503130000054
pi,qi∈N+,i=1,2…5且1<pi/qi<2;
以|s|和d|s|/dt作为模糊控制器的输入,滑模增益优化项Δk作为模糊控制器的输出,设计一个双输入单输出的模糊控制器;其中|s|,d|s|/dt,均为三角形隶属度函数;
描述输入输出变量的子集分别为d|s|=[NB=负大,NM=负中,NS=负小,ZO=零,PS=正小,PM=正中,PB=正大],|s|=[S0,S1,S2,S3,S4,S5,S6],Δk=[K0,K1,K2,K3,K4,K5,K6],其中S0,S1,S2,S3,S4,S5,S6,K0,K1,K2,K3,K4,K5,K6均为模糊数;
采取的控制规则为:
如果d|s|是A,|s|是B,则Δk是C;
优化后开关函数的增益为:
k=η×(1+Δk)+d (7)
采用如下终端吸引子作为趋近率:
Figure BDA0001755503130000055
其中,
Figure BDA0001755503130000056
k1=diag(k11,…k15),k2=diag(k21,…,k25),k1i,k2i∈R+,i=1,2,…5;
式(5)的一阶导数表示如下:
Figure BDA0001755503130000061
其中,I∈R5×5,i=1,2,···,5,
Figure BDA0001755503130000062
由式(4)~(9)可得,对于AUV的非线性动力学模型公式(1),如果变量非奇异终端滑模选取式(5),趋近率选取式(8),采用如下控制率:
Figure BDA0001755503130000063
Figure BDA0001755503130000064
u=u1+u2 (12)
其中,为了减轻当|ne|>ε时,滑模控制器中的颤振现象,利用饱和函数sat(s/Δ)替代滑模控制器中的指数趋近率的符号函数sig(s),并取边界层Δ=0.01,α=diag{β1,···β5},αi∈R+
前述全驱动自主水下机器人的回收三维路径跟踪方法,改进的非奇异终端模糊滑模控制算法中模糊控制器的滑模增益值选取,具体为:
控制器运动点远离滑模面,即|s|>0时,滑模增益选取为30,提高控制器运动点的趋近速度;在靠近滑模面的区域内,即s→0时,滑模增益不应超过25,以此减弱因为s的正负性频繁变化造成的高频抖振。
与现有技术相比,本发明的有益效果是:
1.本发明的用于回收的全驱动自主水下机器人结构具有易拆装、模块化特点。采用多推进器设计,控制灵活。
2.将回收路径规划为三段式,分别对三段曲线进行三维路径跟踪,针对性设计不同阶段的跟踪控制策略,提高回收成功率。
3.将每段回收空间曲线规划成点序列进行跟踪控制,可满足回收高精度跟踪性能的需求,提高回收成功率。
4.本发明在回收三维路径跟踪中采用的改进的非奇异终端模糊滑模算法,在滑模控制基础上,设计分段切换函数,实现多个滑动模态,并通过模糊算法对滑模增益进行实时优化,使其能快速、平稳地追踪目标点,增强回收三维路径跟踪性能,提高回收成功率。
附图说明
图1是本发明的机器人外形结构框图;
图2是本发明的机器人回收对接流程框图;
图3是本发明的机器人回收对接三维路径跟踪流程框图;
图4是本发明的机器人回收三维路径跟踪改进的非奇异终端模糊滑模算法流程框图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明。
如图1所示,全驱动自主水下机器人结构,包括艏段2,艏部推进段7,电子舱段12,艉部推进段15和主推进段18五大部分;整体采用鱼雷形流线型结构,艏段2与艏部推进段7、艏部推进段7与电子舱段12,电子舱段12与艉部推进段15、艉部推进段15与主推进段18同心密封相连;艏段2包括探测仪1、避碰声纳4和艏段壳体3,探测仪1通过密封安装于艏段2前部,避碰声呐4通过水密接插件安装于艏段2上部,艏段壳体3采用铝合金6061制造并进行表面硬质氧化处理,艏段壳体3采用半球形外形以保证水下机器人具有良好的流线型并兼顾艏部的安装空间;艏部推进段7由艏部侧向推进器5、艏部垂向推进器8和艏部推进段壳体6组成,侧向推进器5水平放置,安装于艏部推进段7前侧方,垂向推进器8垂直放置,安装于艏部推进段7后上方,驱动电机与推进螺旋桨之间采用磁耦合联轴器连接取代以往的动密封结构来提供系统的可靠性;电子舱段12由锂电池9、抛载10、天线导流罩13、电子舱段壳体11组成,天线导流罩13包括超短基线接收器和天线,锂电池9环绕相连于电子舱段12前部,下部通过电磁铁将抛载10垂直固定,后上部通过水密接插件与天线导流罩13相连;艉部推进段15包括艉部垂向推进器14、艉部侧向推进器17和艉部推进段壳体16组成,垂向推进器14垂直放置,安装于艉部推进段15前上方,侧向推进器17水平放置,安装于艉部推进段15后侧方,驱动电机与推进螺旋桨之间采用磁耦合联轴器连接取代以往的动密封结构来提供系统的可靠性;主推进段14由主推进器19组成,主推进器19采用桨后舵设计,避免了传统十字舵或X字舵的缺点,防止水下机器人在收放过程中,碰伤舵板。
如图2所示,全驱动自主水下机器人回收对接流程框图。回收分为3个过程:
过程1:直线归位阶段20,这个阶段是指回收装置24用超短基线定位到AUV开始,进入对接中轴线21的跟踪过程;利用超短基线提供的相对位置、姿态信息来调整AUV与对接装置的位置,使得在消耗较短对接中轴线距离的情况下,将AUV航行至中轴线上,使AUV的姿态与中轴线一致,利于进一步实时对接;
过程2:直线跟踪阶段22,这个阶段指是指AUV重心进入中轴线21开始直到距离对接口3-5米的阶段,在这个阶段要保证AUV沿中轴线航行,且艏向角指向对接口;
过程3:艏向调整阶段23,这个阶段是指过程2结束到对接成功的阶段,进入此阶段需要满足两个条件:一是AUV与对接装置轴线距离小于5米,二是相对位置、姿态偏差超出预设值;如果直线跟踪阶段保持的位置、姿态偏差一直未超过预设值,则可以略过此阶段,直接完成对接,即只有在出现足够误差时,才会触发艏向调整阶段。
如图3所示,全驱动自主水下机器人回收对接三维路径跟踪流程框图,具体步骤如下:
步骤1:将回收路径三维曲线转化为空间点序列;
步骤2:将空间点序列描述为自主水下航行器的目标跟踪点,将其转化为自主水下航行器的惯性坐标系下的坐标,对其进行目标跟踪;
步骤3:全驱动控制形式的自主水下航行器,对单个目标点进行跟踪控制,首先将位置偏差转化为参考艏向角,然后将期望艏向角和期望深度作为输入,采用改进的非奇异终端模糊滑模算法,输出为各推进器的推力;
步骤4:进行步骤2目标跟踪点的更替,并依次运行步骤3完成每个目标点的跟踪,最终完成空间点序列的跟踪,实现回收三维路径跟踪。
如图4所示,全驱动自主水下机器人回收三维路径跟踪改进的非奇异终端模糊滑模算法流程框图,其特征是:
步骤1:全驱动自主水下机器人的运动学数学模型可以表示为:
Figure BDA0001755503130000081
Figure BDA0001755503130000082
式中,η=[x y z θ ψ]T,为水下机器人相对于惯性坐标系中的位置和姿态角,其中θ为俯仰角,ψ为航向角,此处不考虑横滚角对机器人的影响;v=[u v w q r]T,为水下机器人在载体坐标系内的线速度和角速度,其中u,v,w分别为x,y,z坐标轴方向的线速度,q,r为y,z坐标轴方向的角速度;J(η)为坐标转换矩阵;M为包含附加质量的惯量矩阵且满足对称性M=MT>0,
Figure BDA0001755503130000094
C(v)v为包含了质量矩阵和附加质量矩阵引起的科氏力与向心力且满足反对称性;D(v)为黏性水动力系数矩阵且D(v)>0;v为去除环境干扰力时水下机器人的速度;g(η)是恢复力和力矩;τ是各自由度的力和力矩;ξ为环境干扰;
步骤2:多模态、多变量非奇异终端模糊滑模控制器根据当前水下机器人的位置和艏向角与目标点位置和期望艏向值进行对比得到位置跟踪误差和艏向跟踪误差,通过模糊控制器对滑模增益进行优化,得到各推进器的推力;
位置跟踪误差为:
Figure BDA0001755503130000091
其中,ep为位置跟踪误差,xd,yd,zd分别为目标点三轴方向上的位置坐标,x,y,z分别为当前水下机器人三轴方向上的位置坐标;
艏向跟踪误差为:
eψ=ψd-ψ (3)
其中,eψ为艏向跟踪误差,ψd为期望艏向值,ψ为当前水下机器人的艏向角;
定义n=[x y z θ ψ]T,与η等同,是机器人实时的位置和姿态,则
Figure BDA0001755503130000095
表示三轴方向上线速度和角速度,
Figure BDA0001755503130000092
表示三轴方向上线加速度和角加速度,令常数nd为目标点,那么跟踪误差表示为ne=n-nd,算法实现目标为寻找适当的控制律,使水下机器人的位置n能够尽快地到达期望值nd,即ne要在有限时间内快速收敛到零;
定义运算
Figure BDA0001755503130000093
其中,sgn为符号函数,x1,…x5为各状态变量,γ1,…γ5为状态变量系数;
设计非奇异终端滑模面:
Figure BDA0001755503130000101
为了使连接点处的速度连续,即ne=ε时
Figure BDA0001755503130000102
要相等,所以有
ε=βq/p-q (6)
式中,ε=diag{ε1,…ε5},β=diag{β1,…β5},βi∈R+,s=[s1,…s5]T,ne,
Figure BDA0001755503130000103
pi,qi∈N+,i=1,2…5且1<pi/qi<2;
以|s|和d|s|/dt作为模糊控制器的输入,滑模增益优化项Δk作为模糊控制器的输出,设计一个双输入单输出的模糊控制器。其中|s|,d|s|/dt,均为三角形隶属度函数;
控制器运动点远离滑模面,即|s|>0时,滑模增益选取为30,提高控制器运动点的趋近速度;在靠近滑模面的区域内,即s→0时,滑模增益不应超过25,以此减弱因为s的正负性频繁变化造成的高频抖振。为了达到以上效果,设计出了模糊推理规则:
Figure BDA0001755503130000104
其中,描述输入输出变量的子集分别为d|s|=[NB=负大,NM=负中,NS=负小,ZO=零,PS=正小,PM=正中,PB=正大],|s|=[S0,S1,S2,S3,S4,S5,S6],Δk=[K0,K1,K2,K3,K4,K5,K6],其中S0,S1,S2,S3,S4,S5,S6,K0,K1,K2,K3,K4,K5,K6为模糊数;
采取的模糊规则为:
如果d|s|是A,|s|是B,则Δk是C;
优化后开关函数的增益为:
k=η×(1+Δk)+d (7)
采用如下终端吸引子作为趋近率:
Figure BDA0001755503130000111
其中,
Figure BDA0001755503130000112
k1=diag(k11,…k15),k2=diag(k21,…,k25),k1i,k2i∈R+,i=1,2,…5;
式(5)的一阶导数表示如下:
Figure BDA0001755503130000113
其中,I∈R5×5,i=1,2,···,5,
Figure BDA0001755503130000114
由式(4)~(9)可得,对于AUV的非线性动力学模型公式(1),如果变量FNTSM选取式(5),趋近率选取式(8),采用如下控制率:
Figure BDA0001755503130000115
Figure BDA0001755503130000116
u=u1+u2 (12)
其中,为了减轻当|ne|>ε时,滑模控制器中的颤振现象,利用饱和函数sat(s/Δ)替代滑模控制器中的指数趋近率的符号函数sig(s),并取边界层Δ=0.01,α=diag{β1,···β5},αi∈R+
除上述实施例外,本发明还可以有其他实施方式,凡采用等同替换或等效变换形成的技术方案,均落在本发明要求的保护范围内。

Claims (4)

1.一种全驱动自主水下机器人结构的回收三维路径跟踪方法,全驱动自主水下机器人结构包括艏段(2),艏部推进段(7),电子舱段(12),艉部推进段(15)和主推进段(18)五大部分;整体采用鱼雷形流线型结构,艏段(2)与艏部推进段(7)、艏部推进段(7)与电子舱段(12),电子舱段(12)与艉部推进段(15)、艉部推进段(15)与主推进段(18)同心密封相连;艏段(2)包括探测仪(1)、避碰声呐(4)和艏段壳体(3),探测仪(1)通过密封安装于艏段(2)前部,避碰声呐(4)通过水密接插件安装于艏段(2)上部,艏段壳体(3)采用铝合金6061制造并进行表面硬质氧化处理,艏段壳体(3)采用半球形外形以保证水下机器人具有良好的流线型并兼顾艏部的安装空间;艏部推进段(7)由艏部侧向推进器(5)、艏部垂向推进器(8)和艏部推进段壳体(6)组成,侧向推进器(5)水平放置,安装于艏部推进段(7)前侧方,垂向推进器(8)垂直放置,安装于艏部推进段(7)后上方,驱动电机与推进螺旋桨之间采用磁耦合联轴器连接;电子舱段(12)由锂电池(9)、抛载(10)、天线导流罩(13)、电子舱段壳体(11)组成,天线导流罩(13)包括超短基线接收器和天线,锂电池(9)环绕相连于电子舱段(12)前部,下部通过电磁铁将抛载(10)垂直固定,后上部通过水密接插件与天线导流罩(13)相连;艉部推进段(15)包括艉部垂向推进器(14)、艉部侧向推进器(17)和艉部推进段壳体(16)组成,垂向推进器(14)垂直放置,安装于艉部推进段(15)前上方,侧向推进器(17)水平放置,安装于艉部推进段(15)后侧方,驱动电机与推进螺旋桨之间采用磁耦合联轴器连接;主推进段(18)由主推进器(19)组成,主推进器(19)采用桨后舵设计;其特征在于,回收控制过程包括以下3个过程:
过程1:直线归位阶段,这个阶段是指回收装置用超短基线定位到AUV开始,进入对接中轴线跟踪过程,这个过程重点在于利用超短基线提供的相对位置/姿态信息来调整AUV与对接装置的位置,使得在消耗较短对接中轴线距离的情况下,将AUV航行至中轴线上,同时要考虑到AUV的姿态尽可能的与中轴线一致,利于进一步实时对接;
过程2:直线跟踪阶段,这个阶段指是指AUV重心进入中轴线开始直到距离对接口3到5米的阶段,在这个阶段要保证AUV沿中轴线航行,且艏向角指向对接口;
过程3:艏向调整阶段,这个阶段是指过程2结束到对接成功的阶段,进入此阶段需要满足两个条件:一是AUV与对接装置轴线距离小于5米,二是相对位置/姿态偏差超出预设值,如果直线跟踪阶段保持的位置/姿态偏差一直未超过预设值,则略过此阶段,直接完成对接,即只有在出现足够误差时,才会触发艏向调整阶段。
2.如权利要求1所述的全驱动自主水下机器人结构的回收三维路径跟踪方法,其特征在于,其中机器人回收直线归位阶段与直线跟踪阶段的三维路径跟踪控制方法包括以下步骤:
步骤1:将回收路径三维曲线转化为空间点序列;
步骤2:将空间点序列描述为自主水下航行器的目标跟踪点,将其转化为自主水下航行器的惯性坐标系下的坐标,对其进行目标跟踪;
步骤3:全驱动控制形式的自主水下航行器,对单个目标点进行跟踪控制,将水下机器人的位置和艏向角与目标点位置和期望艏向值进行对比得到跟踪误差,采用改进的非奇异终端模糊滑模算法,输出为各推进器的推力;
步骤4:进行步骤2目标跟踪点的更替,并依次运行步骤3完成每个目标点的跟踪,最终完成空间点序列的跟踪,实现回收三维路径跟踪。
3.如权利要求2所述的全驱动自主水下机器人结构的回收三维路径跟踪方法,其特征在于,改进的非奇异终端模糊滑模控制算法包括以下步骤:
步骤1:全驱动自主水下机器人的运动学数学模型表示为:
Figure FDA0003064433670000021
Figure FDA0003064433670000022
式中,η=[x y z θ ψ]T,为水下机器人相对于惯性坐标系中的位置和姿态角,其中θ为俯仰角,ψ为航向角,此处不考虑横滚角对机器人的影响;v=[u v w q r]T,为水下机器人在载体坐标系内的线速度和角速度,其中u,v,w分别为x,y,z坐标轴方向的线速度,q,r为y,z坐标轴方向的角速度;J(η)为坐标转换矩阵;M为包含附加质量的惯量矩阵且满足对称性M=MT>0,
Figure FDA0003064433670000023
C(v)v为包含了质量矩阵和附加质量矩阵引起的科氏力与向心力且满足反对称性;D(v)为黏性水动力系数矩阵且D(v)>0;v为去除环境干扰力时水下机器人的速度;g(η)是恢复力和力矩;τ是各自由度的力和力矩;ξ为环境干扰;
步骤2:改进的非奇异终端模糊滑模控制器根据当前水下机器人的位置和艏向角与目标点位置和期望艏向值进行对比得到位置跟踪误差和艏向跟踪误差,通过模糊控制器对滑模增益进行优化,得到各推进器的推力;
位置跟踪误差为:
Figure FDA0003064433670000031
其中,ep为位置跟踪误差,xd,yd,zd分别为目标点三轴方向上的位置坐标,x,y,z分别为当前水下机器人三轴方向上的位置坐标;
艏向跟踪误差为:
eψ=ψd-ψ (3)
其中,eψ为艏向跟踪误差,ψd为期望艏向值,ψ为当前水下机器人的艏向角;
定义n=[x y z θ ψ]T,与η等同,是机器人实时的位置和姿态,则
Figure FDA0003064433670000032
表示三轴方向上线速度和角速度,
Figure FDA0003064433670000033
表示三轴方向上线加速度和角加速度,令常数nd为目标点,那么跟踪误差表示为ne=n-nd,算法实现目标为寻找适当的控制律,使水下机器人的位置n能够尽快地到达期望值nd,即ne要在有限时间内快速收敛到零;
定义运算
Figure FDA0003064433670000034
其中,sgn为符号函数,x1,…x5为各状态变量,γ1,…γ5为状态变量系数;
设计非奇异终端滑模面:
Figure FDA0003064433670000035
为了使连接点处的速度连续,即ne=ε时
Figure FDA0003064433670000036
要相等,所以有
ε=βq/p-q (6)
式中,ε=diag{ε1,…ε5},β=diag{β1,…β5},βi∈R+,s=[s1,…s5]T
Figure FDA0003064433670000041
pi,qi∈N+,i=1,2…5且1<pi/qi<2;
以|s|和d|s|/dt作为模糊控制器的输入,滑模增益优化项Δk作为模糊控制器的输出,设计一个双输入单输出的模糊控制器;其中|s|,d|s|/dt,均为三角形隶属度函数;
描述输入输出变量的子集分别为d|s|=[NB=负大,NM=负中,NS=负小,ZO=零,PS=正小,PM=正中,PB=正大],|s|=[S0,S1,S2,S3,S4,S5,S6],Δk=[K0,K1,K2,K3,K4,K5,K6],其中S0,S1,S2,S3,S4,S5,S6,K0,K1,K2,K3,K4,K5,K6为模糊数;
采取的控制规则为:
如果d|s|是A,|s|是B,则Δk是C;
优化后开关函数的增益为:
k=η×(1+Δk)+d (7)
采用如下终端吸引子作为趋近率:
Figure FDA0003064433670000042
其中,
Figure FDA0003064433670000043
k1=diag(k11,…k15),k2=diag(k21,…,k25),k1i,k2i∈R+,i=1,2,…5;
式(5)的一阶导数表示如下:
Figure FDA0003064433670000044
其中,I∈R5×5,i=1,2,···,5,
Figure FDA0003064433670000045
由式(4)~(9)可得,对于AUV的非线性动力学模型公式(1),如果变量非奇异终端滑模选取式(5),趋近率选取式(8),采用如下控制率:
Figure FDA0003064433670000046
Figure FDA0003064433670000047
u=u1+u2 (12)
其中,为了减轻当|ne|>ε时,滑模控制器中的颤振现象,利用饱和函数sat(s/Δ)替代滑模控制器中的指数趋近率的符号函数sig(s),并取边界层Δ=0.01,α=diag{β1,···β5},αi∈R+
4.如权利要求3所述的全驱动自主水下机器人结构的回收三维路径跟踪方法,其特征在于,改进的非奇异终端模糊滑模控制算法中模糊控制器的滑模增益值选取为:
控制器运动点远离滑模面,即|s|>0时,滑模增益选取为30,提高控制器运动点的趋近速度;在靠近滑模面的区域内,即s→0时,滑模增益不应超过25,以此减弱因为s的正负性频繁变化造成的高频抖振。
CN201810885325.0A 2018-08-06 2018-08-06 全驱动自主水下机器人结构及回收三维路径跟踪方法 Active CN109050835B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810885325.0A CN109050835B (zh) 2018-08-06 2018-08-06 全驱动自主水下机器人结构及回收三维路径跟踪方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810885325.0A CN109050835B (zh) 2018-08-06 2018-08-06 全驱动自主水下机器人结构及回收三维路径跟踪方法

Publications (2)

Publication Number Publication Date
CN109050835A CN109050835A (zh) 2018-12-21
CN109050835B true CN109050835B (zh) 2021-07-13

Family

ID=64831603

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810885325.0A Active CN109050835B (zh) 2018-08-06 2018-08-06 全驱动自主水下机器人结构及回收三维路径跟踪方法

Country Status (1)

Country Link
CN (1) CN109050835B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109976384B (zh) * 2019-03-13 2022-02-08 厦门理工学院 一种自治水下机器人及路径跟随控制方法、装置
CN110275439B (zh) * 2019-06-28 2020-05-26 四川大学 自平衡小车的控制方法、控制器的设计方法及装置
CN111830832B (zh) * 2020-07-27 2021-08-31 中国科学院自动化研究所 仿生滑翔机器海豚平面路径跟踪方法及系统
CN112034865B (zh) * 2020-08-12 2021-10-08 浙江大学 基于优化算法的全驱动水下航行器航迹跟踪控制方法
CN111959722B (zh) * 2020-08-21 2022-05-17 广东海洋大学 一种基于船舶stl三维模型的rov船底自主巡检方法
CN112025725B (zh) * 2020-08-25 2021-07-23 中国人民解放军海军工程大学 一种一次性无缆遥控水下排爆机器人及其设计方法
CN112148022B (zh) * 2020-09-18 2023-10-03 江苏科技大学 全驱动自主水下机器人回收三维路径跟踪控制系统及方法
CN113492956A (zh) * 2021-07-22 2021-10-12 中电科海洋信息技术研究院有限公司 一种水下机器人
CN113895594B (zh) * 2021-09-22 2023-04-07 中国船舶重工集团公司第七0七研究所九江分部 一种基于水下动态回收平台的auv回收方法
CN114771778A (zh) * 2022-04-12 2022-07-22 株洲中车时代电气股份有限公司 一种用于水下机器人的回收方法、回收装置及水下机器人

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101234665A (zh) * 2008-03-03 2008-08-06 中国科学院光电技术研究所 一种小型水下观测机器人
CN102722177A (zh) * 2012-06-27 2012-10-10 哈尔滨工程大学 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法
CN105628016A (zh) * 2014-10-30 2016-06-01 中国科学院沈阳自动化研究所 一种基于超短基线的导航定位方法
CN105644742A (zh) * 2014-11-10 2016-06-08 中国科学院沈阳自动化研究所 一种长期定点垂直剖面观测型水下机器人
CN106054607A (zh) * 2016-06-17 2016-10-26 江苏科技大学 水下检测与作业机器人动力定位方法
CN106444838A (zh) * 2016-10-25 2017-02-22 西安兰海动力科技有限公司 一种自主水下航行器的精确航路跟踪控制方法
WO2018065723A1 (fr) * 2016-10-04 2018-04-12 Ixblue Système de mesure pour milieu aquatique comportant un navire de surface et un engin subaquatique
CN207622804U (zh) * 2017-12-29 2018-07-17 浙江省水利水电勘测设计院 一种有压输水隧洞智能探测装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101234665A (zh) * 2008-03-03 2008-08-06 中国科学院光电技术研究所 一种小型水下观测机器人
CN102722177A (zh) * 2012-06-27 2012-10-10 哈尔滨工程大学 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法
CN105628016A (zh) * 2014-10-30 2016-06-01 中国科学院沈阳自动化研究所 一种基于超短基线的导航定位方法
CN105644742A (zh) * 2014-11-10 2016-06-08 中国科学院沈阳自动化研究所 一种长期定点垂直剖面观测型水下机器人
CN106054607A (zh) * 2016-06-17 2016-10-26 江苏科技大学 水下检测与作业机器人动力定位方法
WO2018065723A1 (fr) * 2016-10-04 2018-04-12 Ixblue Système de mesure pour milieu aquatique comportant un navire de surface et un engin subaquatique
CN106444838A (zh) * 2016-10-25 2017-02-22 西安兰海动力科技有限公司 一种自主水下航行器的精确航路跟踪控制方法
CN207622804U (zh) * 2017-12-29 2018-07-17 浙江省水利水电勘测设计院 一种有压输水隧洞智能探测装置

Also Published As

Publication number Publication date
CN109050835A (zh) 2018-12-21

Similar Documents

Publication Publication Date Title
CN109050835B (zh) 全驱动自主水下机器人结构及回收三维路径跟踪方法
CN108427414B (zh) 一种自主水下航行器水平面自适应轨迹跟踪控制方法
CN109634307B (zh) 一种无人水下航行器复合航迹跟踪控制方法
CN108829099A (zh) 一种基于受限反步法控制的欠驱动无人船轨迹跟踪方法
CN112965371B (zh) 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法
CN112527018A (zh) 一种欠驱动自主水下航行器的三维镇定控制方法
CN114779645B (zh) 一种有向固定通信拓扑下胸鳍拍动式机器鱼编队控制方法
CN112327892B (zh) 一种auv误差受限的抗扰控制方法
CN115657689B (zh) 一种基于轨迹预测的自主水下航行器目标跟踪控制方法
Hu et al. Trajectory tracking and re-planning with model predictive control of autonomous underwater vehicles
CN114564015B (zh) 一种拒止环境下的欠驱动无人艇分布式编队控制方法
CN117111614A (zh) 一种基于改进人工势场法的船舶编队避碰避障与跟踪控制方法
Yang et al. A hybrid autonomous recovery scheme for AUV based dubins path and non-singular terminal sliding mode control method
Liang et al. Economic MPC-based planning for marine vehicles: Tuning safety and energy efficiency
Sun et al. An innovative distributed self-organizing control of unmanned surface vehicle swarm with collision avoidance
CN113296505A (zh) 一种基于速变los的无人船多模式路径跟踪控制方法
CN116027796A (zh) 一种多自治水下机器人编队控制系统及方法
Wang et al. Stepwise cooperative trajectory planning for multiple BUVs based on temporal–spatial Bezier curves
CN116974278A (zh) 基于改进los的滑模无人船路径跟踪控制系统及方法
Yakimenko et al. AUV rendezvous trajectories generation for underwater recovery
CN113110458B (zh) 一种无人船虚拟目标跟踪控制系统
CN115857483A (zh) 一种基于控制障碍函数模型预测控制算法的无人船避障控制方法
Zhang et al. Local path planning of unmanned underwater vehicle based on improved APF and rolling window method
Cui et al. Trajectory re-planning and tracking control of unmanned underwater vehicles on dynamic model
Renjie et al. Underwater robot formation control based on leader-follower model

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