Sorting System Algorithms Based on Machine Vision for Delta Robot
NI Hepeng1,2, LIU Ya'nan1,2, ZHANG Chengrui1,2, WANG Yunfei1,2, XIA Feihu1,2, QIU Zhengshi1,2
1. School of Mechanical Engineering, Shandong University, Jinan 250061, China;
2. Key Laboratory of High Efficiency and Clean Mechanical Manufacturing, Shandong University, Jinan 250061, China
To overcome the repeat shooting to workpieces by vision system in sorting process, an image deduplication algorithm based on time and workpieces' positions is proposed. The running time of the real-time sorting system is used as basis of each sorting module, and the predicted time that workpieces arrive at a fixed reference position is combined with its current location into a set of coordinates to uniquely identify a part. So the duplicate image information can be found and removed by comparing those coordinates periodically. At the same time, in order to improve sorting efficiency, a dynamic picking algorithm based on Newton-Raphson method is proposed. The non-linear mathematical model is established for workpiece tracking, which is solved by Newton-Raphson iteration. Finally, the proposed dynamic picking algorithm is verified by MATLAB. In prototype test the maximum sorting speed can reach 110 times per minute, mistaken-grab rate is lower than 2‰, missing-grab rate is 0, which proves that the algorithms can meet the real-time, the accuracy and the stability requirements.
[1] Vischer P, Clavel R. Kinematic calibration of the parallel Delta robot[J]. Robotica, 1998, 16(2): 207-218. [2] 郎需林,靳东,张承瑞,等.基于实时以太网的DELTA并联机械手控制系统设计[J].机器人,2013,35(5): 576-581. Lang X L, Jin D, Zhang C R, et al. Control system design of DELTA parallel manipulator based on real-time Ethernet[J]. Robot, 2013, 35(5): 576-581.[3] 王攀峰,梅江平,陈恒军,等.基于多并联机械手的锂离子电池自动分拣装备控制系统设计[J].机械工程学报,2007,43(11):63-68. Wang P F, Mei J P, Chen H J, et al. Control system design for automatic sorting of lithium ion battery using multiple parallel manipulators[J]. Journal of Mechanical Engineering, 2007, 43(11): 63-68.[4] 庄开岚,王吉忠,周洁.机器视觉技术在角度检测方面的应用研究[J].装备制造技术,2011(4):9-10. Zhuang K L, Wang J Z, Zhou J. Application of machine vision in angle inspection[J]. Equipment Manufacturing Technology, 2011(4): 9-10.[5] 张策.高速包装机械手视觉控制系统研究与开发[D].天津:天津大学,2008. Zhang C. R&D of vision control system for a high speed packaging robot[D]. Tianjin: Tianjin University, 2008.[6] 张文昌.Delta高速并联机器人视觉控制技术及视觉标定技术研究[D].天津:天津大学,2012. Zhang W C. Control technique and kinematic calibration of Delta robot based on computer vision[D]. Tianjin: Tianjin University, 2012.[7] 邓明星,刘冠峰,张国英.基于Delta并联机器人的传送带动态跟踪[J].机械工程与自动化,2015(1):153-154. Deng M X, Liu G F, Zhang G Y. Dynamic conveyor tracking for Delta robot [J]. Mechanical Engineering & Automation, 2015(1): 153-154.[8] 叶敏,肖龙翔.分析力学[M].天津:天津大学出版社,2001. Ye M, Xiao L X. Analytical mechanics[M]. Tianjin: Tianjin University Press, 2001[9] 于东,胡韶华,盖荣丽,等.基于滤波技术的数控系统加减速研究[J].中国机械工程,2008,19(7):804-807. Yu D, Hu S H, Gai R L, et al. Research on acceleration and deceleration for CNC machine tools based on filtering [J]. China Mechanical Engineering, 2008, 19(7): 804-807.[10] 石川,赵彤,叶佩青,等.数控系统 S 曲线加减速规划研究[J].中国机械工程,2007,18(12):1421-1425. Shi C, Zhao T, Ye P Q, et al. Study on S-shape curve acceleration and deceleration control on NC system[J]. Chine Mechanical Engineering, 2007, 18(12): 1421-1425.[11] 于金刚,林浒,张晓辉,等.一种新型的Jerk连续加减速控制方法研究[J].组合机床与自动化加工技术,2009(8):61-64. Yu J G, Lin X, Zhang X H, et al. Research on a novel acceleration and deceleration control method of continuous jerk[J]. Modular Machine Tool & Automatic Manufacturing Technique, 2009(8): 61-64.[12] 王云飞,郎需林,张承瑞,等.高速并联机械手最优加减速控制算法研究[J].机械设计与制造,2014(11):85-88. Wang Y F, Lang X L, Zhang C R, et al. The optimal accel- eration-deceleration control research of high-speed parallel manipulator[J]. Machinery Design & Manufacture, 2014 (11): 85-88.[13] 孙好春,张承瑞,胡天亮.基于SMP的总线式软运动控制引擎设计[J].农业机械学报,2014,45(3):288-292. Sun H C, Zhang C R, Hu T L. Design of bus-style soft motion control engine based on SMP[J]. Transactions of the Chinese Society for Agricultural Machinery, 2014, 45(3): 288-292.[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.