1.一种用于两关节机械臂的固定时间动态预设性能控制方法,其特征是:所述两关节机械臂包括立柱、转臂和小车,转臂与立柱转动连接,转臂相对于立柱的转动由第一电机驱动;小车与转臂直线滑动连接,小车的直线移动由第二电机驱动;
包括如下步骤:
步骤1:构建两关节机械臂的系统模型,经系统变换将两关节机械臂的系统模型转换为系统状态方程;
步骤2:分别以第一电机和第二电机为控制对象,构建固定时间动态预设性能函数及其参数规则;基于两关节机械臂的系统模型和目标轨迹构建跟踪误差模型;基于跟踪误差模型和固定时间动态预设性能函数构建调整判据;基于调整判据设计固定时间动态预设性能函数的调整规则;
步骤3:基于跟踪误差模型和固定时间动态预设性能函数定义变换式,构建第一个李雅普诺夫函数,进而设计虚拟控制信号;
步骤4:构建第二个李雅普诺夫函数,并基于虚拟控制信号设计实际控制信号;
步骤5:利用所设计的实际控制信号,使两关节机械臂的实际轨迹跟踪目标轨迹,并且将跟踪误差约束在固定时间动态预设性能函数之内;
步骤1中,所述两关节机械臂的系统模型为:式(1)中,t为实时时间,式(2)中,
步骤1中,所述系统状态方程为:式(3)中,
步骤2中,以第一电机为控制对象,构建转臂的固定时间动态预设性能函数及其参数规则如下:系统运行初始阶段固定时间动态预设性能函数A为:其中,
第一阶段固定时间动态预设性能函数A为:第二阶段固定时间动态预设性能函数A为:其中,
其中,
对于第
步骤2中,以第二电机为控制对象,构建小车的固定时间动态预设性能函数及其参数规则如下:系统运行初始阶段固定时间动态预设性能函数B为:其中,
第一阶段固定时间动态预设性能函数B为:第二阶段固定时间动态预设性能函数B为:其中,
其中,
对于第
步骤2中,所述跟踪误差模型为:则,
其中,
步骤2中,对于第j次调整,以第一电机为控制对象时,所述调整判据为:对于第
其中,
2.根据权利要求1所述的用于两关节机械臂的固定时间动态预设性能控制方法,其特征是:步骤2中,所述固定时间动态预设性能函数的调整规则为:以第一电机为控制对象,则当
如果第j次调整满足调整判据式(18),则当
当
如果第j次调整不满足调整判据式(18),则不执行调整;
以第二电机为控制对象,则当
如果第
当
当
如果第
3.根据权利要求2所述的用于两关节机械臂的固定时间动态预设性能控制方法,其特征是:步骤3中,所述变换式为:其中,
其中,
由(21)可以得到:其中:
矩阵
构建第一个李雅普诺夫函数:虚拟控制信号为:
其中:
其中,
4.根据权利要求3所述的用于两关节机械臂的固定时间动态预设性能控制方法,其特征是:构建第二个李雅普诺夫函数:将式(27)带入式(26),得:利用杨氏不等式得:其中,
将式(31)带入式(30)得:实际控制信号为:
其中,
其中,