郎需林, 靳东, 张承瑞, 张岳, 王云飞, 刘亚男. 基于实时以太网的DELTA并联机械手控制系统设计[J]. 机器人, 2013, 35(5): 576-581.DOI: 10.3724/SP.J.1218.2013.00576.
LANG Xulin, JIN Dong, ZHANG Chengrui, ZHANG Yue, WANG Yunfei, LIU Ya'nan. Control System Design of DELTA Parallel Manipulator Based on Real-time Ethernet. ROBOT, 2013, 35(5): 576-581. DOI: 10.3724/SP.J.1218.2013.00576.
摘要
针对DELTA并联机械手现有控制器开放性和可扩展性不足的缺陷,提出了基于实时以太网运动控制平台Ether MAC(Ethernet for Manufacture Automation Control)的控制系统设计方案.该方案通讯总线采用独特的从节点同步与时钟校正技术,使用标准以太网,可在无需专用网卡和强实时操作系统的情况下,实现同步实时控制;通过从节点FPGA_IP核模块化结构和组件分层式软件架构,实现不同分拣包 装工艺下DELTA机械手的快速开发.根据样机工作环境下控制器响应时间的测试,该方案满足实时同步控制的要求.
To overcome the shortages of current DELTA parallel manipulator controllers in openness and expansibility, a control system design is proposed using motion control platform EtherMAC (Ethernet for Manufacture Automation Control), which is based on real-time Ethernet. In this method, synchronous real-time control is realized under standard Ethernet without special network adapter and hard real-time operation system by communication bus using slave node synchronization and clock correction technology. Furthermore, with the modular-structured slave node FPGA _IP core and component-based layered software architecture, DELTA manipulator can be developed quickly to adapt to different sorting and packaging situations. According to controller response time under prototype working condition, this method is proved to meet the requirements of synchronous real-time control.
[1] Vischer P, Clavel R. Kinematic calibration of the parallel delta robot[J]. Robotica, 1998, 16(2): 207-218. [2] ABB Robot in China. IRB 360 Data sheet_CN[EB/OL]. [2013-04-25]. http://www05.abb.com/global/scot/scot241.nsf/veritydisplay/86a16145c1b08944482576db002adfd7/ile/IRB%20360_2009_C.pdf.[3] 刘鑫,闵华松,陈友东,等.基于EtherCAT的工业机器人控制器设计[J].计算机工程,2012,38(11):290-292.Liu X, Min H S, Chen Y D, et al. Design of industrial robot controller based on EtherCAT[J]. Computer Engineering, 2012, 38(11): 290-292.[4] 王攀峰,梅江平,陈恒军,等.基于多并联机械手的锂离子电池自动分拣装备控制系统设计[J].机械工程学报,2007,43(11):63-68. Wang P F, Mei J P, Chen H J, et al. Control system design for automatic sorting of lithiumion battery using multiple parallel manipulators[J]. Chinese Journal of Mechanical Engineering, 2007, 43(11): 63-68.[5] 梁辉,李红芳.基于PMAC运动学的并联机构力控制研究[J].机械设计与制造,2011(8):124-126.Liang H, Li H F. Research on force control of parallel mechanism based on PMAC[J]. Machinery Design & Manufacture, 2011(8): 124-126.[6] 夏卫生,张海鸥,王桂兰,等.基于Ethernet的开放式机器人等离子熔射成形系统研究[J].机器人,2008,30(1):17-21.Xia W S, Zhang H O, Wang G L, et al. An open architecture robotic plasma spray forming system based on Ethernet[J]. Robot, 2008, 30(1): 17-21.[7] Piggin R S H. Developments in real-time control with Ethernet/IP[J]. Assembly Automation, 2007, 27(2): 109-117. [8] Phan R C W. Authenticated modbus protocol for critical infrastructure protection[J]. IEEE Transactions on Power Delivery, 2012, 27(3): 1687-1689. [9] 高路,于海斌,王宏,等.EPA网络体系结构[J].计算机工程,2004,30(17):81-82.Gao L, Yu H B, Wang H, et al. Architecture of EPA network[J]. Computer Engineering, 2004, 30(17): 81-82.[10] Jansen D, Buttner H. Real-time Ethernet-the EtherCAT solution[J]. IEE Computing & Control Engineering, 2004, 15(1): 16-21. [11] Cena G, Seno L, Valenzano A, et al. Performance analysis of Ethernet Powerlink networks for distributed control and automation systems[J]. Computer Standards and Interfaces, 2009, 31(3): 566-572. [12] Schemm E. SERCOS to link with Ethernet for its third generation[J]. IEE Computing & Control Engineering, 2004, 15(2): 30-33. [13] Hanzalek Z, Burget P, Sucha P. Profinet IO IRT message scheduling with temporal constraints[J]. IEEE Transactions on Industrial Informatics, 2010, 6(3): 369-380. [14] 张承瑞,王金江.基于标准以太网的实时同步网络及其工作方法,中国:200710013313.0[P].2007-08-15.Zhang C R, Wang J J. Real-time and synchronous control network and working method based on standard Ethernet, China: 200710013313.0[P]. 2007-08-15.[15] 姬帅,胡天亮,张承瑞.基于实时以太网的高速精插补算法及其实现[J].计算机集成制造系统,2012,18(10):2211-2216.Ji S, Hu T L, Zhang C R. High speed fine interpolation algorithm and its implement based on real-time Ethernet[J]. Computer Integrated Manufacturing Systems, 2012, 18(10): 2211-2216.[16] 吴强,姜春英,孙元.一种基于RTLinux的五自由度开放式并联激光加工数控系统[J].机器人,2010,32(1):13-17.Wu Q, Jiang C Y, Sung Y. An open CNC system based on RTLinux for the 5-DOF parallel laser processing machine[J]. Robot, 2010, 32(1): 13-17.[17] 陈友东,魏洪兴,王琦魁.数控系统的直线和S形加减速离散算法[J].中国机械工程,2010,17(5):567-570.Chen Y D, Wei H X, Wang Q K. An algorithm of sampled-data linear and S shape acceleration and deceleration for CNC controller[J]. China Mechanical Engineering, 2010, 17(5): 567-570.[18] Hong J, Yamamoto M. A calculation method of the reaction force and moment for a Delta-type parallel link robot fixed with a frame[J]. Robotica, 2009, 27(4): 579-587. [19] Neumann P. Communication in industrial automation-What is going on?[J]. Control Engineering Practice, 2007, 15(11): 1332-1347.