基于干扰观测器的平面2RR并联机器人高速运动的滑模控制  

Sliding mode control of high-speed motion of planar 2RR parallel robot based on disturbance observer

作　　者：董楸煌 陈志伟[1] DONG Qiuhuang;CHEN Zhiwei(College of Mechanical and Electrical Engineering,Fujian Agriculture and Forestry University;Modern Agricultural Equipment Engineering Research Center for Fujian Universities;Fujian Key Laboratory of Agriculture Information Sensing Technology,Fuzhou,Fujian 350002,China)

机构地区：[1]福建农林大学机电工程学院 [2]现代农业装备福建省高校工程研究中心 [3]福建省农业信息感知技术重点实验室,福建福州350002

出　　处：《福建农林大学学报（自然科学版）》2022年第3期419-427,共9页Journal of Fujian Agriculture and Forestry University:Natural Science Edition

基　　金：国家自然科学基金(51605091);福建省自然科学基金(2016J05110);福州市科技计划项目(2020-GX-9);福建农林大学科技创新专项项目(CXZX2019128S).

摘　　要：为了实现平面工作空间的目标物自动化快速分拣操作,基于平面五连杆机构,设计平面2RR并联机器人系统进行分拣操作.首先,根据系统的自由度和主动关节的设置,确定系统的广义坐标,利用第二类拉格朗日方程和闭链几何约束关系,建立系统的动力学方程.针对分拣操作的高速运动控制要求,并考虑系统动力学方程的非线性、强耦合和不确定干扰等因素,设计了基于干扰观测器的滑模控制方法.最后,通过李雅普诺夫稳定性证明了所设计的控制方法的稳定性,并通过数值仿真验证了该控制方法有较好的控制效果.In order to realize the automatic and fast sorting operation in the plane workspace, a plane 2 RR parallel robot was designed based on the plane five-link mechanism. Firstly, the generalized coordinates of the system were established based on the degree of freedom and the active joints of the system. The dynamic equation of the system was derived using the second Lagrange equation and closed chain geometric constrains of the system. Considering the high-speed motion control requirements of the sorting operation as well as the factors such as nonlinearity, strong coupling and uncertain disturbance of the system dynamic equation, a sliding mode control law was designed based on a disturbance observer. Finally, the stability of the designed control law was proved by Lyapunov stability theory, and the numerical simulation showed satisfactory control performance.

关 键 词：并联机器人 动力学 滑模控制 干扰观测器 

分 类 号：TP242.2[自动化与计算机技术—检测技术与自动化装置]