摘要
足球机器人涉及到多学科、多领域,为研究多智能体系统、人工智能等理论提供了一个很好的研究平台,引起了越来越多的科研机构和大专院校的关注,也吸引了越来越多的科研人员和学者的参与。
论文主要对RoboCup中型组足球机器人——三轮全向驱动机器人的运动控制进行了研究。首先建立了三轮全向移动机器人非线性系统模型,通过分析它的运动特性,采用基于运动学模型的分层控制方案实现机器人的运动控制。为了验证底层运动控制系统和控制策略的合理性,在分析无刷直流电机数学模型的基础上,利用Matlab/Simulink建立了无刷直流电机转速、电流双闭环控制系统的仿真模型,通过仿真得到了与理论分析相一致的仿真试验结果,证明了该控制方案的可行性。其次,本文设计了三轮全向移动机器人的运动控制算法,包括基于Lyapunov直接法的姿态稳定控制算法和基于输入变换解耦的轨迹跟踪控制算法,使系统具有良好的全局稳定性,实现了移动机器人的位置和方位的跟踪控制。仿真实验中考虑了驱动电机的动态特性,检验了控制算法的鲁棒性和有效性。
最后,根据RoboCup中型组足球机器人底层控制系统的基本任务,采用双DSP构架,选择高性能DSP处理器TMS320LF2407A作为核心进行底层运动控制系统的设计。硬件部分,按照模块化的思想,主要设计了以TMS320LF2407A为核心的控制电路和无刷直流电机驱动模块;软件部分,在硬件平台基础上编制了各个模块的软件程序,给出了各模块的程序框图。
Robot soccer, referring to multi-domain and multi-disciplinary, is a good test bed for multi-agent system and artificial intelligence theory. So far, it has been focused by many research institutes and colleges, more and more researchers and scholars pay attention to it.
This thesis presents the research on motion control system of omni-directional mobile robots with three wheels for the RoboCup's Middle Size Robot League. The thesis, firstly, builds the dynamic models of omni-directional robots, and decides to use the control based on dynamics model to achieve motion control of soccer robots by analyzing the characteristics of its movement. In order to verify the whole control system and the control strategy, a simulation model of motor control system had been founded on base of BLDCM mathematical model with Matlab/Simulink. The results of simulation were consistent with the theoretical analysis, which proved the control system was feasible. Secondly, some control algorithms for omni-directional mobile robots with three wheels are designed, including posture stabilization controller base on the input decoupling and the trajectory tracking controller base on Lyapunov stability theory, so the tracking performance of system has the global stability and the independent control of both position and orientation for a mobile robot is realized. Simulation experiments validate the stabilities of all control algorithms, and the robustness and practicability of all algorithms are also verified.
Finally, the motion control system used a double DSP structure, and DSP microprocessor TMS320LF2407A with high advanced capacity is used as the chief chip to design the bottom movement control system from the basic tasks of RoboCup's middle-league soccer robots. For hardware part, the control system of the microprocessor and BLDCM controller modular are designed according to the modular thought. For software part, the whole modules are programmed in foundation of the hardware platform, and the program flow charts of the various modules are given.
引文
[1]王文学,徐心和.机器人足球:高科技的对抗[J],百科知识,2000.10:16-17
[2]范永,谭民.机器人控制器的现状及展望[J].机器人,1999, 21(1):75-77
[3]徐国保,尹怡欣,周美娟.智能移动机器人技术现状及展望[J].机器人技术与应用,2007(2):29-34
[4] Kue TY, BaekSM. Proc of The Fourth Int Sympon Artificial Life and Robotics(AROB4th'99)[C]. Japan,1999.658-664
[5] G.Oriolo A.De Luca,M.Venditelli. Control of Wheeled Mobile Robots: An Experimental Overview[J],RAMSETE: Articulated and Mobile Robotics for Services and Technologies.2001:181-226.
[6] A.K.Mack worth. On seeing robots. Computer Vision: System, Theory and Applications[M],World Science Press Singapore,1993: 1-13
[7]邱秉权.分析力学[M].北京:中国铁道出版社,1998年8月第一版.
[8] Tomas Kumar-Nagy, Rafaela D Andrea, Puritan Gangly: Near-optimal dynamic trajectory generation and control of an omni-directional vehicle[J].Robotics and Autonomous Systems,2003,46:47-64.
[9] Raul Rojas.Omni-directional Control[M].Freie University Berlin, 2005.09
[10]牟学刚,朱劲,蒋平.三轮全向足球机器人结构设计与系统模型研究[J].机械与电子,2006,6(6):38-41.
[11] Krishnan H and McCTamnxh N H. Tracking in nonlinear differential algebraic control systems with applications to constrained robot systems [ J] .A ntomatica.1994,30 (12):1885-1897
[12]龚振邦.等.机器人机械设计[M].北京:电子工业出版社.1995.
[13] Lages, W. F. and Hemerly, E. M. Smooth Time-invariant Control of Wheeled Mobile Robots[C]. In 7th International Conference on Systems Science, Wroclaw, Poland, September, 1998.
[14] J. M. Yang and J. H. Kim. Sliding Mode Control for Trajectory Tracking of Non-homonymic Wheeled Mobile Robots[J]. In IEEE Transactions on Robotics and Automation, 1999, vo1.15, no. 3, 578-587
[15]张深.无刷直流电动机原理及应用[M].北京:机械工业出版社.2004.第2版
[16]韩安太,刘峙飞,黄海编著.DSP控制器原理及其在运动控制系统中的应用[M].北京:清华大学出版社,2003, 10
[17] PillayP, Krishnan R. Modeling, simulation, and analysis of permanent-magnet motor drives, Part II: The brushless DC motor drive[J]. IEEE Trans. on Industry Applications,1989, 25(2): 274-279
[18]纪志成.基于Matlab无刷直流电机系统仿真建模的新方法[J].系统仿真学报.2003. 12(15): 1745-1748
[19] Evans PD, Brown D. Simulation of brushless DC drive[J]. IEEE Pt.B. Elect. Power PROC. APPI(UK)Sep,1990,137:290-08
[20] Jeon Y S, Mok H.S, Choe G.H, et al. A New Simulation Model of BLDC Motor with Real Back EMF Waveform[J]. Proceeding from Computers in Power Electronics,2000,18(2): 17-20
[21] Thomas Salem, Tim A Haskew. Simulation of the Brushless DC machine[J]. Proceeding from System Theory,1995,12 (14):18-22
[22]薛定宇,陈阳泉.基于Matlab/Simulink的系统仿真技术与应用[M].北京:清华大学出版社.2002
[23] Ionel D M, Eastham J F, Betzer T. Finite element analysis of a novel brushless DC motor with flux barriers[J]. IEEE Trans on Magnetics, 1995 ,31(6):3749-3751.
[24] Jeon Y S,Mok H S,Choe G.H. A new simulation model of BLDC motor with real back EMF waveform[J]. Proceeding from Computers in Power Electronics,2000,16(18):217-220
[25]王季铁,曲家骐.执行电动机[M].北京:电子工业出版社,1997:74-91
[26]刘金琨.先进PID控制MATLAB仿真[M].北京:电子工业出版社,2004
[27]张世韬,杨风,郝骞.单神经元PID控制器研究及仿真[J].机械工程与自动化,2009.6,154(3):69-70
[28]季秀才.RoboCup小型组机器人运动控制研究,国防科技大学硕士学位论文,2003年
[29] Murray,R., Li, Z. and Sastry, S. A Mathematical Introduction to Robotic Manipulation[M]. CRC Press, 1994
[30]胡跃明.非线性控制系统理论与应用[M],国防工业出版社,2002年
[31] Aicardi M, Casalino G., Bicchi A, Balestrino A, Closed Loop Steering of Unicycle-like Vehicles via Lapunov techniques[J]. In IEEE Robotics & Automation Magazine 2(1) 1995.
[32] Warren E D ,Darren M D ,Erkan Z ,et al. Nonlinear control of wheeled mobile robots [ M ] . London: Springer ,2001
[33]李艳,林廷圻,黄玉美,高峰.基于神经网络的3自由度移动机器人跟踪方法研究[J].西安交通大学学报,2003.7(37):711-714
[34]王学慧,柳林.足球机器人小车总体设计思想及其单片机选型[J],机器人技术与应用,2001 (5):10-14.
[35]刘和平,严利平,张学锋,卓清锋. TMS320LF240XDSP结构原理及应用[M],北京:北京航空航天大学出版社,2002.
[36]王晓明,王玲.电动机的DSP控制-TI公司的DSP应用[M].北京:北京航空航天大学出版社,2004.
[37] IR2132S.pdf, http://www.irf.com/product-info/datasheets/data/ir2130.pdf.
[38]谢运祥.IR2130驱动器及其在逆变器中的应用[J].微电机,2001, 34(2):50-52
[39]张培仁,张志坚.16/31位DSP机器人控制系统设计与实现[M].北京:清华大学出版社,2006
[40]谈世哲,梅志千,杨汝清.基于DSP的工业机器人控制器的设计与实现[J].机器人,2002,24(2):134-137
[41]彭启琼,管庆等编著.DSP集成开发环境[M].北京:电子工业出版社,2004
[42] Chapuis Y A, Roye D. Direct Torque Control and Current Limitation Method in Start up of an Induction Machine[J]. Power Electronics and Variable SpeedDrives, Conference Publication,1998(456):21-23