利索能及
我要发布
收藏
专利号: 2024112614351
申请人: 燕山大学
专利类型:发明专利
专利状态:已下证
更新日期:2026-06-16
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种基于预设时间干扰观测器的AUV二阶滑模三维轨迹跟踪控制方法,其特征在于:包括步骤如下:

步骤1:根据AUV控制系统的控制输入、非线性模型参数及外部未知洋流扰动,搭建含有外部扰动的AUV控制系统的动力学数学模型;步骤1中数学模型具体如下:建立带外部扰动的AUV控制系统的动力学数学模型:T

其中,v=[u,v,w,q,r] 为载体坐标系下的速度,u,v,w分别为AUV的纵荡、横荡、垂荡速T度,q,r则分别为AUV的纵倾和艏摇角速度;η=[x,y,z,θ,ψ]为大地坐标系下的位置坐标,τT T=[τ1,τ2,τ3,τ4,τ5]为输入力和力矩,τw=[τw1,τw2,τw3,τw4,τw5]为外界扰动;

5×5 5×5 5×5

M∈R 为包含附加质量的矩阵;D(v)∈R 为粘性阻尼矩阵;C(v)∈R 为科氏力附加

5×5

矩阵;惯性g(η)∈R 为AUV的恢复力和力矩矢量;

T

D(v)=diag(d11,d22,d33,d44,d55);g(η)=[g1,g2,g3,g4,g5];

其中d11=‑Xu‑X|u|u|u|,d22=‑Yv‑Yv|v|v|,d33=‑Zw‑Z|w|w|w|,d44=‑Mq‑M|q|q|q|,d55=‑Nr‑N|r|r|r|,g1=(P‑B)sinθ,g2=0,g3=‑(P‑B)cosθ,g4=‑ZBBsinθ,g5=0;

其中

J(η)为旋转矩阵见下式:

步骤2:利用预设时间稳定性理论,再结合AUV控制系统的动力学数学模型的误差状态,设计用于观测并逼近外部扰动情况的预设时间干扰观测器;步骤2中干扰观测器表示具体如下:‑1

首先是定义v和M τw的估计值分别为z1(t)和 则估计误差可以‑1

分别定义为e1(t)=v‑z1和e2(t)=M τw‑z2;由模型替换关系得到速度的定义为则预设时间干扰观测器模型可以表示为:选择合适的预设时间干扰观测器的参数γ ,σ,TP,使估计误差e1,e2收敛于零,设定系数

0<γ<1,σ>0,TP>0则可以在预设时间T1内估计出外部扰动,e2即在预设时间内收敛于‑1零;设定扰动满足李普希茨条件||M τw(t)||≤δ2(t‑t0),它们的一阶导数是以||Dw(t)||≤δ2为界,其中δ2>0;

‑1

由于 和||e2(0)||=||M τw(0)‑z2(0)||=0,故而e2,i(0)=0,从而得到e1,i(0)>0;表示在e1,i改变符号之前,sgn(e1,i(t))保持与sgn(e2,i(t))T的符号相反,则可得: 其中,e1=[e1,1,e1,2,e1,3,e1,4,e1,5]和e2=[e2,1,T

e2,2,e2,3,e2,4,e2,5],i=1,2...5;同时收敛时间可以提前计算出:步骤3:根据AUV控制系统的动力学模型以及跟踪误差,融合预设时间稳定性理论和二阶滑模技术,构建可以提高系统稳定性和鲁棒性的预设时间二阶滑模轨迹跟踪控制器;步骤3中构建轨迹跟踪控制器的具体步骤如下:步骤3.1:定义跟踪误差:

其中,η为实际轨迹,ηd为期望轨迹; 分别为实际和期望轨迹的一阶导数;

步骤3.2:定义滑模面S1为:

S1=E2+F0

其中,

步骤3.3:定义滑模面S2为:

其中, 而滑模面S1求一阶导得到

得到预设时间二阶滑模轨迹跟踪控制器的τ如下:其中, 同时所给定的参

数0<β0<1,0<β1<1,0<β2<1,T0>0,T1>0,T2>0;

步骤4:结合已经构建好的预设时间干扰观测器、二阶滑模控制器以及AUV控制系统的动力学模型,对AUV控制系统的控制性能进行验证测试;步骤4中结合已经构建好的模型,对AUV控制系统的控制性能进行验证测试过程如下:首先给出AUV跟踪的期望轨迹和外部未知扰动,再将各个模型部分进行合并,对整个AUV系统的预设时间收敛性和稳定性进行仿真验证,整个AUV系统在预设时间内收敛且抗抖振能力和鲁棒性强。

2.根据权利要求1所述的一种基于预设时间干扰观测器的AUV二阶滑模三维轨迹跟踪控制方法,其特征在于:

期望轨迹由下式组成:

外部未知扰动由洋流和海浪在内的复杂环境决定由下式组成: