1.一种绳驱下肢康复外骨骼自抗扰学习控制方法,其特征在于,所述方法包括以下步骤:步骤1、分析电机驱动力矩与关节控制力矩之间的关系,建立绳驱下肢康复外骨骼动态模型;
步骤2、设计滑模面,避免差分速度信号的误差放大效应;
步骤3、设计自抗扰学习控制器并分析系统性能,实现下肢绳驱康复外骨骼轨迹跟踪控制;
所述步骤1的过程如下:
1.1 双套索传动系统模型建立,(1);
式 (1) 中,表示双套索系统中鲍登绳的初始预紧力大小;表示时刻电机端的驱动力矩; 和 分别表示时刻及上一时刻外骨骼关节处的控制力矩;分别表示电机端驱动轮和外骨骼关节驱动轮的半径;是符号函数,定义顺时针传动时为正,逆时针传动时为负,不传动时为零;是套管与鲍登绳之间的库伦摩擦系数;表示套索微元的曲率,是套管长度;
1.2 下肢外骨骼动力学建模,(2);
式 (2) 中,分别表示外骨骼各关节的角度、角速度和角加速度向量;为对称正定惯性矩阵,为哥氏力与向心力矩阵,为重力矩阵;表示电机减速器及机构安装产生的关节摩擦力矩;表示人机交互力矩;
下肢外骨骼关节与驱动电机之间通过套索传动,联系公式 (1) 和 公式 (2),绳驱下肢康复外骨骼的动力学模型为,(3);
式 (3) 中,;
1.3 定义状态变量,,外骨骼系统的状态空间表达式为,(4);
式 (4) 中,分别表示的一阶导数;此外,给定周期为的光滑有界轨迹,存在期望输入满足,(5);
式 (5) 中,为有界周期性信号,分别表示的一阶导数;结合式 (5),系统状态空间表达式 (4) 变为,(6);
式 (6) 中,;;
所述步骤2的过程如下:
2.1 计算系统轨迹跟踪误差,(7);
2.2设计滑模面,
(8);
式 (8) 中,为可调正参数;是的估计值;是的一阶导数;表示的观测误差;
所述步骤3的过程如下:
3.1 定义控制器,
(9);
式 (9) 中,为期望输入的估计值,为鲁棒控制项;
3.2 设计重复学习律估计系统 (6) 中的周期不确定性,(10);
式 (10) 中,和分别表示在和时刻的估计值;为重复学习增益;为限幅函数,定义为,(11);
式 (11) 中,表示的限幅值,为符号函数;
此外,式 (10) 中为定义在上的连续函数,(12);
3.3 设计扩张状态观测器估计系统未知状态,为此,将式(6) 改写为,(13);
式 (13) 中,,其中是的逆矩阵,,表示的估计误差;为系统已知部分,通过先验知识得到;表示的一阶导数,为有界函数;
针对式 (13)所描述的系统,设计线性扩张状态观测器为,(14);
式 (14) 中,分别表示观测器状态的一阶导数;表示带宽常数;
3.4 设计自抗扰控制器补偿系统中的非周期不确定性,(15);
式 (15) 中,为可调正参数;
将式 (15) 代入式 (9),自抗扰学习控制器为,(16);
3.5 构造李雅普诺夫函数,分析系统性能,(17);
对公式 (17) 进行求导,有,(18);
式 (18) 中,分别表示的一阶导数;和分别表示在和时刻的估计误差;基于不等式,以及性质,其中,表示任意实数;有,(19);
式 (19) 中,表示的一阶导数;为正常数,满足,表示的观测误差,;为有界参数,;,;
当时,成立,故最终收敛至区间,此时,(20);
由此可知,系统一致有界,跟踪误差最终收敛到零附近的领域内。