基于干扰观测器的欠驱动手指滑模控制

徐玉龙,王学林,张 磊,王 鹏,陈 昊,赵立德,肖 千

齐鲁工业大学(山东省科学院) 山东省科学院自动化研究所,山东省机器人与制造自动化技术重点实验室,山东 济南 250014

欠驱动多指手作为机器人通用化的末端执行器,其控制输入小于控制输出,以整体系统简洁高效、体积小、质量轻等优点,得到了迅速的迭代发展,已经广泛存在于制造业、医疗器械、机器人、航空航天等工业领域。相较于全驱动多指手更符合当下对机器人产业的需求。

欠驱动多指手能够以耦合方式实现相对多样性的抓取任务,其控制方法多样化。针对欠驱动多指手的控制问题,国内外学者进行了广泛的研究,并提出了许多控制方案,主要有比例积分微分(proportional integral derivative,PID)控制[1]、自适应控制[2]、鲁棒控制[3]、神经网络控制[4]、模糊控制[5]、迭代学习控制[6]、滑模变结构控制[7]、反馈线性化[8]等。Richa Sharma等[9]提出了分数阶模糊PID(fractional order fuzzy PID,FOFPID)控制器应用于双连杆平面刚性机械臂轨迹跟踪问题,绝对误差积分和控制器输出绝对变化积分两个性能指标最小化权重,使得机械臂在轨迹跟踪和抑制干扰等方面有着优良的性能。郭永凤[10]通过遗传算法在线优化和调整PID控制器参数,控制液压机械手轨迹跟踪,能抑制外界干扰,提高手指末端定位精度。钱东海等[11]采用终端滑模控制方法,使用多幂次趋近律提高滑模面收敛速度、降低滑模控制中的抖振现象,提高机械手抓取控制的鲁棒性。唐庆顺等[12]采用非奇异终端滑模面设计控制律,引入自适应方法估计未知不确定性,大大削弱了抖振现象,实现了机械手轨迹的高精度追踪。

欠驱动由于其控制变量个数小于系统自由度个数而难以精准控制,将欠驱动多指手单指的二连杆模型简化为单指模型,手指自身重力部分和未知扰动部分合并为干扰项,探讨基于干扰观测器的欠驱动多指手末端手指轨迹跟踪控制问题。首先,设计饱和函数趋近律的滑模控制器,构造干扰观测器,实时估计末端手指受到的外界干扰,并在输入端进行相应的动态补偿,改善末端手指的轨迹跟踪性能。与传统滑模控制器相比,本文设计的基于干扰观测器的滑模控制器,提高了轨迹跟踪精度,削弱了抖振现象,增强了控制器的鲁棒性。

1 欠驱动单指动力学模型

欠驱动多指手手指为二连杆结构,其动力学模型如图1所示,图中m1,m2分别表示两个连杆的质量;θ1,θ2分别表示连杆与水平方向夹角和连杆之间的夹角;l1,l2分别表示二连杆的长度;lc表示连杆质心到坐标原点的距离;τ表示作用在连杆上的控制力矩。l1杆与电机为齿轮传动,传动点固定在机体轴上,电机与l2杆为链条传动,传动链条的一端也固定在机体轴上,故l1杆与l2杆运动转角和转动扭矩存在一定比例关系,比例由两者的传动比确定。由于两杆之间质量存在差距,且l1比l2长,手指整体的质心可以近似地认为在l1杆中心稍微靠上的位置。此外该手指二连杆结构的连接处均是刚性连接,则本欠驱动多指手手指在实际控制方案可以简化为单指控制。

图1 欠驱动单指模型

利用Newton-Euler方程可得到二连杆的动力学方程[13-14]为:

考虑手指建模误差,有:

实际动力学方程为:

整理公式(3),得:

简化后的单手指模型,参数整理为:

2 控制方案

控制方案如图2所示,外界干扰主要来源于机械零部件的设计和装配误差、建模不确定部分和系统外部干扰。这部分外界干扰与欠驱动单指的重力共同构成总干扰,通过设计干扰观测器对总干扰大小进行估计,并在控制器端进行补偿,由滑模控制器进行控制,以提高控制轨迹跟踪精度。

图2 欠驱动单指末端轨迹跟踪控制方案

2.1 传统滑模控制

为了精准的控制手指末端轨迹,现做如下假设:

假设一:期望角度θd及其n阶导数存在且有界。

假设二:不明确干扰项d有界,其上界在系统的承受范围之内,即|d|≤dmax,则f有界。

其中,c>0。

设计传统滑模控制器为:

其中,kf为切换增益,且kf>f。

定义Lyapunov函数为:

对Vt求导,可得:

根据Lyapunov稳定性定理可知传统滑模控制器可以在有限时间内趋于稳定。

2.2 基于干扰观测器的滑模控制器设计

为提高控制性能,对外界干扰进行实时观测,设计干扰观测器为:

设计滑模控制器为:

3 稳定性分析

通过Lyapunov稳定性定理对上述滑模控制器的稳定性进行证明。定义如下Lyapunov函数:

则

取闭环系统的Lyapunov函数为:

V=V1+V2。 (17)

4 仿真分析

为验证所设计控制方法的控制性能,以图1欠驱动单指为例,通过MATLAB进行仿真验证,并与传统滑模控制器进行性能对比。

4.1 仿真参数与初始条件

4.2 控制效果仿真图

图3描述了所设计控制器与传统滑模控制的轨迹跟踪对比曲线,可以看出本文提出的控制方法能够更快的收敛于期望值,且跟踪轨迹稳定。

图3 轨迹跟踪对比图

图4描述了两种滑模控制器的控制量曲线,传统滑模控制的控制量抖振现象明显;基于干扰观测器的滑模控制通过引入干扰观测器和使用饱和函数sat(s)代替符号函数sgn(s)后,极大抑制了抖振现象的发生。

图5描述了实际干扰与估计干扰的实时关系,可以看出干扰观测器可以在极短的时间估计出欠驱动单指运动过程中估计外部干扰,并作出反馈,上述仿真结果验证了本文控制方法就有较强的稳定性能和鲁棒性能。

图5 实际干扰与估计干扰

4.3 干扰观测器的方波响应与误差分析

为测试基于干扰观测器的滑模控制器的干扰估计能力,将外界干扰设置为如图6所示的方波信号,直线表示外界实际干扰值,虚线表示干扰的估计值,可以看出干扰估计值小幅超调后快速收敛于实际值,实际值与估计值的误差很小,表明干扰观测器有能力实时估计出外界干扰。图7为外界干扰是3种频率的慢时变正弦信号时的干扰估计误差值,可以看出误差值稳定后也是正弦信号,误差的频率由干扰的频率决定,误差的估计精度也取决于干扰频率。干扰信号频率越高,估计误差的精度越低,反之,干扰信号频率越低,估计误差的精度越高。仿真结果验证了本文控制方法的精准性。

图6 干扰观测器的方波信号响应

图7 不同频率干扰的估计误差

5 结 论

为了提高控制系统的精准控制性能和鲁棒性能,建立了欠驱动指模型,提出了一种基于干扰观测器的滑模控制器。通过引入干扰观测器和饱和函数滑模趋近律,分别用于实时估计外界干扰值的大小和抑制抖振现象,干扰估计值作用于控制输入端,在控制端给出相应补偿。由仿真实验得出,在存在外界干扰的情况下,设计的基于干扰观测器的滑模控制器有着良好的控制性能和鲁棒性能,可以应用于欠驱动多指手的抓取控制。