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

摘要

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