1.一种机械臂预定义时间轨迹跟踪滑模控制方法,其特征在于,包括以下步骤:S1、获取机械臂期望轨迹信息,包括机械臂各关节期望角位置和期望角速度信息;
S2、建立n自由度机械臂动力学模型,给出机械臂动力学模型标称部分、不确定部分形成的集总扰动之后,对机械臂动力学模型进行形式变换,获取变换之后的n自由度机械臂动力学模型;
S3、设定预定义时间扩展状态观测器,估计补偿系统不确定和外界干扰形成的集总扰动,获取集总扰动估计值,估计实际速度信息,获取速度估计值;
S4、基于S1所获得的关节期望角位置和期望角速度信息建立位置跟踪误差和速度跟踪误差,设计非奇异预定义时间滑模面,根据滑模面与S3获得的速度估计信息和集总扰动估计值,设计预定义时间滑模控制器,得到预定义时间滑模控制律实现机械臂轨迹跟踪;
S5、基于S3~S4,得到基于预定义时间扩展状态观测器的预定义时间滑模控制器律;
所述S3包括以下子步骤:
S3.1、首先定义如下估计误差:;(7)
其中,为的估计值,为估计误差,;
设计如下形式的滑模面:
;(8)
其中,为正常数;
S3.2、结合滑模面,设计如下预定义时间扩展状态观测器,如下所示:;(9)
其中,为常数,,为系统收敛时间常数,,和为可调正常数,为常数,;
根据系统状态空间表达式(6)和预定义时间扩展状态观测器(9)得出预定义时间扩展状态观测器的误差观测系统表达式为:;(10)
其中,为待设计辅助控制律;
对辅助控制律进行设计,对式(8)进行求导得:;(11)
辅助控制律表达式为:
;(12)
其中,,为正常数;
S3.3、利用S3.2设计的预定义时间扩展状态观测器,观测机械臂轨迹跟踪控制过程中由系统不确定性和外界干扰形成的合成扰动和实际速度信息,构建李雅普诺夫函数,如下所示:;(13)
根据预定义时间理论和李雅普诺夫定理,证明估计误差能够在辅助控制律的控制下收敛到滑模面上;滑模面上的估计误差在预定义时间内能够收敛到零。
2.根据权利要求1所述的一种机械臂预定义时间轨迹跟踪滑模控制方法,其特征在于,所述S2包括以下子步骤:S2.1、建立n自由度机械臂动力学模型,如下所示:;(1)
式中,表示关节角位置,表示关节角速度,表示关节角加速度,表示系统惯性矩阵,表示离心力和哥氏力,表示重力,表示关节力矩,表示外界环境干扰;
S2.2、机械臂动力学模型参数改写为标称部分和不确定部分,表示如下:;(2)
其中,、和为标称部分,、和为不确定部分;
系统集总扰动为:
;(3)
n自由度机械臂动力学模型改写为如下形式:;(4)
针对系统(4),给出对应的状态空间表达式如下:令,,则:
;(5)
令且,,为扩展状态的导数值,为常数即的上界值,所以系统(4)的扩展状态空间表达式如下:(6)。
3.根据权利要求2所述的一种机械臂预定义时间轨迹跟踪滑模控制方法,其特征在于,所述S4包括以下子步骤:S4.1、定义如下形式非线性函数:;(14)
其中,为自变量,为可调参数,,为可调参数,,为可调参数,,为可调参数,;
根据S1获得的期望角位置信息和期望角速度信息、S2获得的实际位置估计信息定义如下轨迹跟踪误差和速度跟踪误差,如下所示:;(15)
S4.2、根据非线性函数式(14)设计如下预定义时间滑模面:;(16)
其中,为非线性函数形成的矩阵,为针对第个关节的跟踪误差, ,为常数,;为系统趋近阶段收敛时间参数;
S4.3、设计预定义时间滑模控制器:;(17)
;(18)
其中,为预定义时间稳定趋近律,为等效控制律,为常数,为滑动阶段收敛时间参数,为正常数, ,。
4.根据权利要求3所述的一种机械臂预定义时间轨迹跟踪滑模控制方法,其特征在于,所述S5具体为:基于S3的预定义时间扩张状态观测器、S4的预定义时间滑模控制,构建李雅普诺夫函数,如下所示:;(19)
使李雅普诺夫函数趋于稳定,得到基于预定义时间扩展状态观测器的预定义时间滑模控制律,即关节力矩,如下所示:(20)。