Applying Drive and Control Integrated Technology to Delta Robot
-
摘要: 本文将驱动器与控制器相结合并改进了Delta机器人运动学求解的方法,应用在Delta机器人上实现了一体化驱动技术。该一体化驱控技术采用ARM+DSP的核心架构,以ARM为核心的采用嵌入式开放式控制子系统主要实现机器人的轨迹规划、外围控制以及通讯,以DSP C28为核心的高效运算从控制子系统主要实现伺服电机的驱动和机器人的运动控制。同时,本文利用几何向量法针对Delta机器人运动学正反解的求解方法进行改进,方便一体化驱控技术的软件开发。最后将所得研究结果系统的应用在Delta机器人本体,机器人重复定位精度误差达到了±0.01 mm,各轴的误差较为稳定,可靠性较强,系统的总体性能能够满足运动控制系统的功能要求。Abstract: This article integrates a driver with a controller and improves kinematic mathematical model of a Delta robot to achieve the drive and control integration in the Delta robot. The drive and control integrated technology uses the architecture of ARM + DSP, the ARM core in the master subsystem mainly achieves the trajectory generation, peripheral control and communication. The DSP C28 core in the control subsystem mainly achieves the control of a servo motor and the motion control of the Delta robot. Meanwhile, an improved method which ueses the geometric vector method is presented to desolve the kinematic mathematical model of the Delta robot which makes the software design more convenient. Finally, the application results obtained with the Delta robot system-duplicated robot body shows that the robot's positioning accuracy error is ±0.01 mm, the error for each axis is stable and reliable, and the overall performance of the robot system fulfills the functional requirements of the motion control system.
-
Key words:
- integration /
- drive and control /
- Delta robot /
- kinematic mathematical model
-
[1] 刘志博.工业机器人控制器研究的发展轨迹和体系构建[J].中国仪器仪表,2012,(12):30-32,56 Liu Z W. Industrial robots control development in the research and construction[J]. China Instrumentation, 2012,(12):30-32,56(in Chinese) [2] 刘志伟.四轴工业机器人嵌入式运动控制器的设计[D].哈尔滨:哈尔滨工业大学,2012 Liu Z W. A design of embedded motion controller for 4-axis industrial robot[D]. Harbin:Harbin Institute of Technology, 2012(in Chinese) [3] 赵宵凯,方益民,徐海林.嵌入式四轴运动控制器的设计[J].江南大学学报(自然科学版),2015,14(1):16-21 Zhao X K, Fang Y M, Xu H L. Design and research on embedded four-axis motion controller[J]. Journal of Jiangnan University (Natural Science Edition), 2015,14(1):16-21(in Chinese) [4] 朱远建.驱控一体式运动控制系统研究[D].杭州:浙江理工大学,2015 Zhu J Y. A study on integrated drive motion control system[D]. Hangzhou:Zhejiang Sci-Tech University, 2015(in Chinese) [5] 戚祯祥.驱控一体化工业机器人控制系统研究及软件开发[D].上海:上海交通大学,2015 Qi Z X. Research on industrial robot controller with drivers integrated and its software development[D]. Shanghai:Shanghai Jiaotong University, 2015(in Chinese) [6] 刘博峰.驱控一体化多轴运动控制器的研究[D].上海:上海交通大学,2015 Liu B F. Research of a multi-axis drive and control integrated system[D]. Shanghai:Shanghai Jiaotong University, 2015(in Chinese) [7] 黄瑞宁,楼云江,刘越,等.开放式驱控一体化的工业机器人控制器研发[J].机器人技术与应用,2013,(2):33-36 Huang R N, Lou Y J, Liu Y, et al. Open drive control integrated industrial robot controller R & D[J]. Robot Technique and Application, 2013,(2):33-36(in Chinese) [8] 冯李航,张为公,龚宗洋,等.Delta系列并联机器人研究进展与现状[J].机器人,2014,36(3):375-384 Feng L H, Zhang W G, Gong Z Y, et al. Developments of delta-like parallel manipulators-a review[J]. Robot, 2014,36(3):375-384(in Chinese) [9] 从爽,尚伟伟.并联机器人-建模、控制优化与应用[M].北京:电子工业出版社,2010:7 Cong S, Shang W W. Parallel robots-modeling, control optimization and applications[M]. Beijing:Publishing House of Electronics Industry, 2010:7(in Chinese) [10] 张永骞.基于ARM和运动控制芯片的嵌入式运动控制器设计[D].哈尔滨:哈尔滨工程大学,2013 Zhang Y Q. Design of embedded motion controller based on ARM and motion control chip[D]. Harbin:Harbin Engineering University, 2013(in Chinese) [11] 彭刚,袁兵.基于双ARM Cortex架构的移动机器人控制器设计[J].华中科技大学学报(自然科学版),2013,41(S1):284-288 Peng G, Yuan B. Design of mobile robot controller based on dual ARM Cortex architecture[J]. Journal of Huazhong University of Science and Technology (Nature Science Edition), 2013,41(S1):284-288(in Chinese) [12] 陈禹希.基于DSP和FPGA的六自由度工业机器人运动控制器设计[D].大连:大连理工大学,2013 Chen Y X. The Design of motion control system for industrial robot with six degrees of freedom based by DSP and FPGA[D]. Dalian:Dalian Sci-Tech University, 2013(in Chinese) [13] 徐远泽.基于DSP的运动控制器系统设计[D].成都:西南交通大学,2012 Xu Y Z. The research of motion controller system based on DSP[D]. Chengdu:Southwest Jiaotong University, 2012(in Chinese) [14] 吴基斌.运动控制关键算法及嵌入式实现研究[D].广州:华南理工大学,2010 Wu J B. Research on key algorithms and embedded implementation of motion control[D]. Guangzhou:South China University of Technology, 2010(in Chinese) [15] Poppeová V, Uríček J, Bulej V. Delta robots-robots for high speed manipulation[J]. Technical Gazette, 2011,18(3):435-445 [16] Zhang J J, Shi L H, Gao R Z. The mathematical model and direct kinematics solution analysis of Delta parallel robot[C]//Proceedings of 2nd IEEE International Conference on Computer Science and Information Technology. Beijing:IEEE, 2009:450-454 [17] Olsson A. Modeling and control of a Delta-3 robot[D]. High Virtue:Lund University, 2009
点击查看大图
计量
- 文章访问数: 145
- HTML全文浏览量: 17
- PDF下载量: 5
- 被引次数: 0