摘要
在我国工业自动化水平不断提高的大背景下,工业机器人的装机总量也逐年增长,在广大工业生产制造现场得到了良好的应用。根据权威预测,国内机器人安装量将以每年25%的速度递增。运动控制器作为工业机器人运动控制系统的核心,在现代工业控制中的作用日益增大,其性能直接关系到被控对象的工作性能和工作效率。
基于实验室自主研发的“钱江一号”6自由度弧焊机器人这一实验平台,以及刘华山、吴剑波等人关于多轴运动控制器的先期工作之上,本课题旨在引入工业现场总线这一通信方式来设计新一款多轴运动控制器,利用其高通用性和高可靠性的特点,实现现有的运动控制器向高开放性和模块化设计方向升级。不仅实现焊接机器人焊接过程中实时轨迹规划以及六个关节协调动作,还能够通过板卡叠加而向更多轴数控制方向的扩展。从长期来看,具有现场总线通信模块的多轴运动控制器可以胜任多机实时交互式通信,从而实现工业现场多机协同作业的功能。
本文对于该新一代运动控制器,在充分调研国内外同产品通用设计架构的前提下,确定PC机+控制器的总体设计方案。控制器依然采用DSP作为主控单元,辅以CPLD最终完成多轴协调运动。控制过程中,依靠DSP强大的数据处理能力进行电机控制,CPLD进行相关的逻辑控制和I/O扩展。通过总线调研,选用具有高兼容性和高可靠性的CAN(Controller Area Network)现场总线作为多轴运动控制器板卡和PC机通信媒介,所有实时数据和控制指令通过CAN现场总线传输,完全能够满足其传输的速率和稳定性要求。
伺服电机控制方面,论文在简要介绍伺服电机控制模式后,确定控制器采用速度控制模式。并就电机控制策略上,针对机器人系统在仅有位置传感、驱动器饱和、存在建模不确定性及干扰等条件下的轨迹跟踪控制问题,提出了一种新的自适应PID控制方案。通过仿真结果比较得出该方案在系统具有干扰和不确定性因素下具有良好的控制性能。
软件上,完成对运动控制器功能的实现,包括CAN现场总线的通信协议实现;PC上位机操作界面的扩展性设计;以及运动控制上的单电机控制算法实现等。
最后,运动控制器设计成功后硬件的调试,以及在基于此硬件系统的控制算法上机实验过程和出现的问题,均在本文中得以体现。并且为下一步的研究提供参考。
With the development of industrial automation equipment, industrial robot (IR), as one of the most significant manufacturing facilities, has seen dramatically growing these years. According to authoritative estimate, the amount of domestic robot manipulators will increase by 25% every year. While being the core component of IR control system, multi-axis controllers are playing more and more important roles in industrial producing fields. The working performance and efficiencies of IR are largely depended on the quality of Multi-axis controllers. Based on the very experimental platform-- "Qianjiang-Ⅰ" 6-DOF Arc-welding IR and prior effective works by Huashan Liu and Jianbo Wu, this project aims at designing an update multi-axis motion controller(MAMC) by introducing in fielbus, in that case endows this control system more stability and make it a standardized module. The new edition of MAMC board has several advantages over previous and other kind of motion controllers, such as stronger capabilities to get it integrated into other systems and being more appropriate for self-expanding by connecting certain number of controllers together by fieldbus.
The new MAMC system not only achieves real-time trajectory planning and coordination of 6 joints in welding process, but can be applied in the occasion where more than 6 joints controlling is needed. Before long, the new MAMC will be suitable for multi-robot communications in fully automatic manufacturing areas, because of fieldbus'ability of real-time data exchange.
After full investigation into motion controllers both domestically and abroad, it is determined to adopt the PC+MAMC structure as the final solution. The MAMC system consists of two parts:main control board and port board. Main control board chooses DSP+CPLD as feature implementation chips, while port board functions as power supply isolator and signal filter. With the powerful data-processing capabilities of DSP and excellent logical control programming performance of CPLD, the new MAMC can be qualified to achieve motion controlling with high accuracy. Besides, CPLD can be used for I/O ports expand, which can receive more signals from servo units at one time.
When it comes to fieldbus, CAN (Controller Area Network) fieldbus became the best choice due to its wide compatibility and reliability. All the instructions from PC to MAMC and feedback data are transferred through CAN bus.
As to servo-motor control, this paper presents some algorithms for control strategy, after discussing control mode and introducing the methodology. The realization of these algorithms by programming together with debugging is also elaborated. Moreover, for trajectory tracking of robot manipulators with only position measurement, limited torques modeling uncertainties and disturbances, it proposed a novel adaptive PID control algorithm. Finally this algorithm is proved to be well performed in two-joint robot manipulator.
The set of software achieves several functions:firstly, completing basic motor-controlling of MAMC, like CPLD and DSP instructions programming; then PC human-machine interaction interface and realization of CAN fieldbus communication protocols; and finally, the motion control algorithm.
At the end of this paper, the problems during debugging both in hardware and software as well as respective solutions are demonstrated, for the sake of future improvement.
引文
[1]朱世强,王宣银.机器人技术及其应用[M].浙江大学出版社.2001
[2]IFR. Executive summary of world robotics.2010.
[3]朱显新.基于DSP高速高精度运动控制器研究[D].武汉理工大学硕士学位论文2005.7
[4]孔慧勇.基于运动控制卡的全闭环控制系统研究[D].四川大学硕士学位论文2003.5
[5]武传宇.基于PC+DSP模式的开放式机器人控制系统及其应用研究[D].浙江大学,2002
[6]丁亮.基于PCI和USB总线的开放式运动控制器开发[D].哈尔滨理工大学硕士学位论文,2006.3
[7]宋钢.基于DSP和CPLD的运动控制器的设计与研究[D].电子科技大学,2004
[8]李可.基于DSP的四轴运动控制卡硬件设计[D].天津大学,2005
[9]刘丽丽.基于μC/OS-Ⅱ的多轴运动控制器的研究与应用[D].中国海洋大学,2005
[10]鲍伟.基于PCI总线和DSP的五轴运动控制卡的研究[D].合肥工业大学,2006
[11]蔡利东.基于IPC+DSP的机器人运动控制系统的设计[D].东南大学,2006
[12]丁亮.基于PCI和USB总线的开放式运动控制器开发[D].哈尔滨理工大学,2006
[13]李可.基于DSP的四轴运动控制卡硬件设计[D].天津大学硕士毕业论文2005.1
[14]余昌盛.基于PCI总线数据采集与运动控制系统研究[D].浙江大学硕士毕浙江大学硕士毕业论文2005.2
[15]邹继荣.基于DSP运动控制卡的研究与开发[D].南京航空航天大学硕士毕业论文2006.2
[16]Matsui N. DSO-based intelligent motor/motion control[C].IEEE Proceedings of the 1995 American Control Conference- ACC'95.1995:490-494
[17]Ford W E. What is an Open Architecture Robot Controller[C]. IEEE International Symposium on Intelligent Control,1994,16-18:27-32
[18]蒋仕龙,吴宏,吕恕,龚晓云.通用运动控制器技术现状、发展及其应用[J].电工文摘/综述,2009(1)7-11
[19]Fleury S., Herrb M., Chatila R.,Genom:A tool for the specification and the implementation of operating modules in a distributed robot architecture [C].//Proceedings of the 1997 IEEE International Conference on Intelligent Robots and Systems. Grenoble, France, IEEE,1997: 842-848
[20]闫莎莎.基于DSP+CPLD的多轴运动控制器平台设计及单轴伺服运动控制算法研究[D].浙江大学硕士毕业论文2010.1
[21]吴剑波.多轴运动控制器的PCI驱动研究及其在工业机器人中的应用[D].浙江大学硕士毕业论文2010.1
[22]刘华山.旋转关节串联机器人多轴运动控制技术研究[D].浙江大学博士毕业论文2010.4
[23]Yoram koren,Zbigniegs J.Pasek,A.Galip Ulsoy,Uri Benchetrit.Real-Time Open Control Architecture and System performance[C]. Annals of the CIRP.1996(1):377-380
[24]李宏宇.基于PCI总线的多轴运动控制器的研究与开发[D].吉林大学硕士毕业论文2005.8
[25]曹遂军,王会良.国内外开放式数控系统的研究与现状[J].机电工程技术2003(32-5)20-22
[26]陶尚华.浅谈数控技术发展趋势[J].机械与电子2009(19)92
[27]Pritshow G. Open System Controllers- a Chanllenge for the Future of the Machine Tool Industry [C].Annals of the CIRP.1993,42(1):449-452
[28]周立功单片机,PCA82C250 CAN收发器应用指南[M],2009
[29]杨国军,崔平远.机械手时间最优轨迹规划方法研究[J].中国机械工程.2002.13(20):1715-1717
[30]王金敏,崔奇等.运用三次样条曲线拟合机器人运动路径[J].机械设计.2005.22(7):44-46
[31]BOSCH. CAN SPECIFICATION(Version2.0),1991.9
[32]郗志刚,周宏甫.运动控制器的发展与现状[J].电气传动自动,2005(27)10-14
[33]吴宏,蒋仕龙,龚小云等.运动控制器的现状与发展[J].CMES2003年会专辑,24-27
[34]张富元,方江龙,汤季安.对我国数控技术发展的思考[J].中国机械工程,1999.101100-1102
[35]叶培华.数字控制技术[M].北京:清华大学出版社,2002.5
[36]饶运涛,邹继军,郑勇芸.现场总线CAN原理与应用技术[M].北京航空航天大学出版社,2003 14~19
[37]黎新亮,关沫,马君璞.基于SJA1000的CAN总线通讯模块的设计[J].沈阳工业大学学报,2004,26(1):17~21
[38]刘洪泳.四轴伺服运动控制卡的研制[D].南京航空航天大学硕士学位论文2004.3
[39]陈建有.基于CAN总线的电液伺服控制器的设计.兰州理工大学硕士学位论文.2005
[40]张云.基于CAN总线的多轴运动控制器的研究.哈尔滨理工大学硕士学位论文.2006
[41]孙剑.基于DSP-CAN总线的数字伺服控制系统设计.西北工业大学硕士学位论文.2008
[42]李渊.基于DSP的CAN总线技术研究.华中科技大学硕士学位论文.2008
[43]佟俪.基于DSP的CAN总线通信及监测系统的设计.中北大学硕士学位论文.2008
[44]Smith Nick. Practical Fieldbus. Control and Instrumentation,1998,30(1):56-61
[45]OMAC Architecture Working Group. OMAC Baseline Architecture Functional Requirements Version 1.0[J].2002(01):1-20
[46]OSACA Work Group. Open System Architecture for Controls within Aulomation System[J], EP6375&EP9115.OSACA Ⅰ & Ⅱ Final Report.1996:1-10
[47]OSACA Work GROUP.OSACA Handbook Part:How to Develop Ⅱ OSACA application[J]. 1996:15-20
[48]陈鹏.基于DSP的运动控制器开发及其运动控制算法研究[D].吉林大学硕士毕业论文2007.6
[49]邬宽明.CAN总线原理和应用系统设计.北京航空航天大学出版社,1996:21~28
[50]聂素华,余芸珍.运动控制器的概述及应用[J].科技信息,2006.5:196-198
[51]TPS75733 DATA SHEET, Texas Instruments,2002.5
[52]TMS320F2812 Digital Signal Processor Data Manual, Texas Instruments,2005.10
[53]www.altera.com.cn
[54]Peng L, Peng-Yung Woo. Neural-Fuzzy Control System for Robotic Manipulators [J]. Control Systems Magzine, IEEE.2002,22(1):53-63
[55]尹勇,李宇PCI总线设备开发宝典[M].北京:北京航空航天大学出版社,2005.2
[56]朱惠静.PCI9054及其在高速数据采集系统中的应用应用天地[J].27(2)2008.2
[57]丁亮.基于PCI和USB总线的开放式运动控制器开发[D].哈尔滨理工大学硕士毕业论文2006.2
[58]苟煜林,曹荣,徐俊起.双端口RAM在双DSP数据通讯中的应用[J].通讯技术与设备,2003.4(29):9-10
[59]∑-Ⅱ系列SGM□H/SGDM用户手册,安川电机株式会社,2004.1
[60]杨全胜,胡友彬等.现代微机原理与接口技术[M].北京:电子工业出版社,2002.3
[61]Ian Grout,基于FPGA和CPLD的数字系统设计[M].北京:电子工业出版社,2009.2
[62]郑亚民,董晓舟.可编程逻辑器件开发软件QuartusⅡ [M]北京:国防工业出版社2006.9
[63]尹勇,欧光军,关荣锋.DSP集成开发环境CCS开发指南[M].北京:北京航空航天大学出版社2004.7
[64]仇慎谦.PID调节规律和过程控制[M].南京:江苏科学技术出版社1987
[65]刘金琨.先进PID控制及其MATLAB仿真[M].北京:电子工业出版社2003
[66]王会方.串联机器人多目标轨迹优化与运动控制研究[D].浙江大学硕士学位论文2011.4
[67]曾光奇,胡均安,王东,刘春玲.模糊控制理论与工程应用[M].武汉:华中科技大学出版社2006.1
[68]赵巍.数控系统的插补算法及加减速控制方法研究[D].天津大学博士学位论文2004.12
[69]穆记锁.高性能插补算法的研究与运动控制程序库的实现[D].暨南大学硕士学位论文2006.6
[70]刘新山,贾庆祥,袁修华.NURBS曲线插补算法及加减速控制研究[J].组合机床与自动化加工技术,2007.5:60-64
[71]陈宗海,詹昌辉.基于“感知-行为”的智能模拟技术的现状及展望.机器人.2001,23(2):187-192
[72]www.iRobot.com
[73]http://tio.cc/news.asp?id=58887
[74]http://www.vacbots.com/
[75]http://www.neatorobotics.com/