[发明专利]基于输出位置的多双连杆机械臂包含控制器及设计方法

说明书

本发明公开了基于输出位置的多双连杆机械臂包含控制器及设计方法，将N个含未知动态的双连杆机械臂视为跟随者，其与M个领导者通过单向拓扑图连接成的网络化系统作为被控对象，领导者构成一个静态凸包，利用跟随者各自的关节1和2输出的位置设计包含控制器，使得跟随者的输出收敛于该静态凸包内。与现有技术相比，本发明的有益效果在于：在每一个子控制器中都利用跟随者的输入和输出设计扩张状态观测器来重构双连杆机械臂的系统状态，并通过扩张状态量的估计实时补偿未知动态，使得设计的输出反馈的包含控制器具有抗扰性；克服了计算复杂性爆炸的问题；能够有效的处理系统中的未知动态、简化复杂的求导运算等问题。

技术领域

本发明属于工业过程控制技术领域，具体涉及基于输出位置的多双连杆机械臂包含控制器及设计方法。

背景技术

近年来，多机械臂系统的协调控制是当今机器人领域的研究热点。与单个的机械臂系统相比,多机械臂系统具有更大的灵活性、更高的可靠性，能够完成更复杂的任务。而Kosuge、Ahmad等人提出的多机械臂系统的主/从控制协调方式是最早的控制方案，其也是目前应用于工业机械臂领域的最为简单有效的协调策略。该方法只需要协调系统中的某一机械臂指定为“领导者”，其余的跟踪领导者的相对位姿的机械臂称为“跟随者”群体。当存在多个机械臂充当领导角色来引导群体运动，实现被控群体进入领导者群体所形成的范围或由领导者包围被控群体的控制问题，称之为包含控制问题。在2008年，M.Ji等针对多机器人的包含控制问题提出的stop-and-go控制方法，其实现多机器人进入到由多个领导者构成的目标区域。进而在针对多双连杆机械臂协调控制网络中，把机械臂的关节1和2的角位移作为输出量，让多个领导者的输出量形成一个静态的凸包，其它双连杆机械臂的输出量根据领导者和跟随者传来的信息移动到领导者组成的静态凸包中。但在很多的实际生产中，由于无法获知准确的双连杆机械臂系统模型，且只能检测到部分系统的状态。因此，本发明利用自抗扰技术(Active Disturbance Rejection Control,ADRC)和反演技术，使得对多双连杆机械臂输出反馈的包含控制的研究具有最直接的现实意义。

在针对具有未知动态和部分系统状态不可获取的n阶仿射型系统控制中，赵志良等提出了一种将未知动态作为系统扩张状态的n+1阶非线性扩张状态观测器(Extendedstate observer,ESO)，其是通过被控对象的输入和输出来估计出系统中的未知动态和重构系统状态。ESO最初是韩京清教授提出的，凭借其能够实时的估计被控对象中的各种未知不确定性因素组成的总扰动，并将系统补偿为积分串联器标称模型的形式来控制。随之，黄一等人对ESO收敛性和稳定性完善，以及杨晓霞等人讨论了能被ESO观测且存在有界观测误差的扰动的范围。郭宝珠等人在2011年针对一类含不确定性的非线性系统设计了ESO，并严格的证明了ESO的收敛性。在2002年，郭宝珠等人还提出一种简单的线性的跟踪微分器(Tracking differentiator,TD)，而TD同样最早是由韩京清教授在1989年提出的，并给出其收敛性的分析。TD使得在经典意义下不可微的函数却有其广义导数，这一特性被广泛的应用到对复杂非线性函数的求导中。在2014年，程春华等人利用TD得到反演设计中虚拟控制律的导数，从而克服了计算复杂性爆炸的问题。反演技术是Kanellakopoulos等人在1991年提出的，是针对每个子系统构造相应的Lyapunov函数,并设计虚拟控制律使前一子系统稳定，但无法避免对虚拟控制律求导困难的难题。Yoo等人研究了不确定非线性严格反馈系统在有向图拓扑下的包含控制策略，利用反演技术设计分布式自适应包含控制器来驱动跟随者进入领导者的凸包内。王巍在2015年针对不确定非线性多智能体系统利用反演技术设计了状态反馈的包含控制器，并通过一阶滤波器避免了虚拟控制律求导复杂的难题。

在实际的应用中，对多双连杆机械臂的包含控制时，由于每个双连杆机械臂系统中存在着未知动态和部分系统状态是不可获取的，以及在利用反演设计中对虚拟控制律求导复杂的难题，所以对多双连杆机械臂输出反馈的包含控制研究具有重要的理论意义和现实意义。

发明内容