1.一种基于扰动观测的深海液压机械臂自适应滑模控制方法,其特征在于,包括如下步骤:步骤一:考虑多自由度深海液压机械臂的模型参数不定、非线性和未知外部扰动,建立多自由度深海液压机械臂的动力学状态空间模型;
步骤二:根据多自由度深海液压机械臂的动力学状态空间模型,结合期望速度信号设计自适应律对未知参数进行估计,并构建自适应扩张状态观测器估计系统的未知扰动和关节速度,同时将观测器估计得到的外界扰动和关节速度补偿至自适应滑模控制器中;结合自适应律和自适应扩张状态观测器,基于反步控制方法和趋近律设计,设计自适应滑模控制器,得到虚拟控制推力和伺服阀阀口的控制律;
步骤三:根据虚拟控制推力和伺服阀阀口控制律实现多自由度深海液压机械臂的运动控制,将多自由度深海液压机械臂的输出信号,即关节角度和推力实时反馈到自适应滑模控制器中实现闭环控制,最终确保多自由度深海液压机械臂的精确运动控制;
步骤二具体如下:
2.1)基于步骤1)所建立的机械臂动力学状态空间模型,设计自适应律,建立过程具体如下:为了便于自适应律设计,将动力学状态空间模型重构为如下形式:其中
为了抑制在参数估计过程中传感器噪声产生的消极影响,准确估计未知参数,定义滤波变量x其中k=diag[k
其中
其中l表示矩阵的收敛增益系数,满足l>0;因此,公式(11)满足:定义
其中
在满足系统的扰动f有界的条件下,矩阵U中包含了参数估计误差其中Γ为自适应律矩阵
2.2)根据步骤一建立的机械臂动力学状态空间模型和步骤2.1)中设计的参数自适应律,设计自适应扩张状态观测器对扰动信号进行估计;此外,由于多自由度深海液压机械臂未安装速度传感器,通过设计基于期望速度信号的自适应扩张状态观测器估计不同关节处的速度信号,具体如下:其中η
其中τ
2.3)根据动力学状态空间模型,结合步骤2.1)和2.2),基于反步控制方法和趋近律设计,设计自适应滑模控制器,分别得到虚拟控制推力和伺服阀阀口的控制律;
步骤2.3)具体过程如下:
定义机械臂关节角跟踪误差e
e
其中x
其中k
构造非奇异终端滑模流形如下:
其中a
其中k
结合公式(8)、(21)和(22),对公式(23)进行微分运算可得:采用反步控制方法,建立/设计机械臂的虚拟控制推力α其中α
其中速度估计
基于虚拟控制推力α
其中a
为了提升滑模控制的瞬态性能,抑制抖振现象,设计如下所示的滑模趋近律并引入到自适应滑模控制器伺服阀阀口控制律设计过程中,其具体形式如下:其中k
结合伺服阀阀口控制律设计过程中公式(30)的趋近律设计,可得伺服阀阀口的控制律u如下:其中u
其中扰动估计
2.根据权利要求1所述的一种基于扰动观测的深海液压机械臂自适应滑模控制方法,其特征在于,步骤一具体为:建立多自由度深海液压机械臂的非线性动力学状态空间模型,包括多自由度深海液压机械臂的机构动力学模型、关节角与液压缸活塞杆位移的动力学关系、液压传动系统的压力-流量非线性动力学模型、流量-伺服阀阀口开度的动力学关系构成。
3.根据权利要求2所述的一种基于扰动观测的深海液压机械臂自适应滑模控制方法,其特征在于,建立多自由度深海液压机械臂的机构动力学模型,满足以下公式:其中M(q)∈R
4.根据权利要求3所述的一种基于扰动观测的深海液压机械臂自适应滑模控制方法,其特征在于,建立机械臂关节角与液压缸活塞杆的动力学关系,具体如下:机械臂的关节角与液压缸活塞杆位移的动力学关系包含以下两类:a.当所述的机械臂为通过齿轮齿条结构将液压缸活塞杆位移转换为关节角度的机械臂时,每个关节的角度q其中,m
b.当所述的机械臂为通过三角形映射关系将液压缸活塞杆位移转换为关节角度的机械臂时,其每个关节的角度q其中,
5.根据权利要求4所述的一种基于扰动观测的深海液压机械臂自适应滑模控制方法,其特征在于,建立液压传动系统的压力-流量非线性动力学模型,具体如下:其中V
6.根据权利要求5所述的一种基于扰动观测的深海液压机械臂自适应滑模控制方法,其特征在于,建立各个液压缸腔室流量-伺服阀阀口开度的动力学关系,其满足:其中k
其中P
7.根据权利要求6所述的一种基于扰动观测的深海液压机械臂自适应滑模控制方法,其特征在于,建立机械臂的动力学状态空间模型,其具体如下:在考虑机械臂非线性、参数时变和扰动的情况下,定义状态变量其中θ
8.根据权利要求1-7中任意一项所述的一种基于扰动观测的深海液压机械臂自适应滑模控制方法,其特征在于,步骤三具体方法如下:所述多自由度深海液压机械臂由液压系统和机械臂本体所构成,在机械臂中仅安装了位置传感器,液压系统中仅有压力传感器;通过将传感器获得的位置、压力信号实时反馈至自适应滑模控制器中,此外结合期望速度信号迭代更新时变参数θ