FROG-LEG型真空机械手的动力学控制研究  

Study of FROG-LEG Vacuum Manipulators' Dynamics Control

作　　者：黄玉钏[1,2] 曲道奎[1,3] 徐方[1,3] 

机构地区：[1]中国科学院沈阳自动化研究所机器人学国家重点实验室,辽宁沈阳110016 [2]中国科学院研究生院,北京100049 [3]沈阳新松机器人自动化股份有限公司,辽宁沈阳110168

出　　处：《四川大学学报（工程科学版）》2013年第3期158-163,共6页Journal of Sichuan University (Engineering Science Edition)

基　　金：国家科技重大专项资助项目(2009ZX02012)

摘　　要：为了解决FROG-LEG型真空机械手平稳运行的控制问题,首先根据机械手的结构特点,将该类机械手动力学分为水平和垂直2个方向进行讨论,利用拉格朗日动力学方程建立了2个方向的动力学模型;其次在真空机械手的动力学模型上分析了真空机械手动力源的控制模型——永磁同步电机转子磁链定向的控制模型;最后利用MATLAB的robot工具箱对机械手的运动学进行了仿真,并利用simulink工具箱对真空机械手的动力学补偿进行了仿真实验。仿真结果说明了动力学电流前馈补偿是实现机械手平稳控制的一种有效途径。In order to solve the problem of FROGLEG vacuum manipulators＇ dynamic compensation, based on its stnicture, the dynam ics in the level and upright direction was discussed, respectively, by using NewEuler method to give dynamics equations. Rotor flux o riented of PMSM was ana/yzed, which was the dynamic source of vacuum manipulators. Robot tool of MATLAB was utilized to simulate the kinematics and dynamics of vacuum manipulators, proving that dynamic current feed forward compensation is an effective way to re alize vacuum manioulators＇ smooth control.

关 键 词：真空机械手 动力学 拉格朗日方程 转子磁链定向 动力学仿真 

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