移动机器人控制系统设计及规划研究
|
摘要
足球机器人涉及计算机、人工智能、机器视觉、信号处理、无线通讯、机器人学等多个学科,是人工智能与机器人领域的研究热点,是一个极富挑战性的高科技项目。目前,研制足球机器人主要有两方面困难,一方面是感知与控制,另一方面是决策、规划和推理。本文以RoboCup小型组足球机器人为研究对象,针对机器人控制系统设计及路径规划进行了深入的研究,本论文的研究工作主要包括以下几个方面:
首先,介绍RoboCup小型组足球机器比赛的系统组成,以及广泛使用的全方位移动机器人的系统结构。在世界坐标系和机器人坐标系下,推导出全方位移动机器人的运动学方程、动力学方程,找到机器人控制量与状态量之间的关系,从而得到机器人的系统方程,并且代入实际机器人的具体参数,通过MATLAB仿真验证模型的有效性。
其次,重点研究了RoboCup小型组足球机器人控制系统,通过参阅众多小型组足球机器人的设计文献,结合当前小型组足球机器人的发展趋势,选择DSP TMS320F2812作为主控制器,以它为核心设计出足球机器人驱动板和主控板。在驱动板上完成了机器人的运动、击球、带球等电路设计,在控制板上完成了外围接口、通讯等电路设计工作,并完成了各部分的程序设计及性能测试。
最后,对足球机器人的路径规划进行了研究,并以RoboCup小型组足球机器人比赛为模型,用栅格法进行环境建模,并结合蚁群算法进行路径搜索,在较短的时间内找到一条无碰撞的最优路径,实验仿真表明:采用栅格法建模,结合蚁群算法进行路径搜索的新方法可以使足球机器人快速到达目标。
Soccer robot refers to computer,artificial intelligent,machine vision,signal processing, wireless communication,robotics and many other subjects etc.It is not only a research hotspot in the field of artificial intelligent and robot,but also a very challenging high-tech project.At present,two aspects of difficulties emerge from the developing soccer robot: one is in the research of sensor and control,and the other one exists in decision-making,planning and inference.This paper chooses RoboCup small-size soccer robot as the object of the study and conducts an in-depth study on the design of the robot control system and path planning.Study work of this paper includes the following parts:
At first,the paper introduces the system components of the RoboCup small-size robot competition and system structure of the omni-directional mobile robot which has been widely used in robot soccer competition recently,then deduces the kinematics function and dynamic function of the robot in the world coordinate system and the robot coordinate system,find relations between the robot control quantity and the condition quantity,correspondingly proposes the system function of the robot.Furthermore,the effectiveness of the model using detailed parameter of real robot can be testified by MATLAB simulation
Then the paper puts an emphases on the study of the control system of RoboCup small-size robot soccer game.By referring to the papers on the design of the small size soccer robot and analyzing the developing trend,DSP TMS320F2812 was chosen as main controller and used as the core in the drive board and the main-control board of the robot which was designed.The electrical circuit design of the robot motion,kick and dribble was located in drive-board.And the design of the peripheral interface and the communication interface was located in main-control board.And what’s more,the programming design and the performance test of every part was accomplished.
At last,the paper conducts an in-depth research on the path planning of soccer robot.Taking the venue of RoboCup small-size league competition as model,environment modeling was carried with the Grid Model,and combined with the Ant Colony Algorithm to carry on the path search,as a result,a non-collision optimized path can be found within shorter time.It is demonstrated by research simulation that the new method which builds an environment model with Grid Model and carries out the path search with Ant Colony Algorithm can make the soccer robot get to the target faster.
首先,介绍RoboCup小型组足球机器比赛的系统组成,以及广泛使用的全方位移动机器人的系统结构。在世界坐标系和机器人坐标系下,推导出全方位移动机器人的运动学方程、动力学方程,找到机器人控制量与状态量之间的关系,从而得到机器人的系统方程,并且代入实际机器人的具体参数,通过MATLAB仿真验证模型的有效性。
其次,重点研究了RoboCup小型组足球机器人控制系统,通过参阅众多小型组足球机器人的设计文献,结合当前小型组足球机器人的发展趋势,选择DSP TMS320F2812作为主控制器,以它为核心设计出足球机器人驱动板和主控板。在驱动板上完成了机器人的运动、击球、带球等电路设计,在控制板上完成了外围接口、通讯等电路设计工作,并完成了各部分的程序设计及性能测试。
最后,对足球机器人的路径规划进行了研究,并以RoboCup小型组足球机器人比赛为模型,用栅格法进行环境建模,并结合蚁群算法进行路径搜索,在较短的时间内找到一条无碰撞的最优路径,实验仿真表明:采用栅格法建模,结合蚁群算法进行路径搜索的新方法可以使足球机器人快速到达目标。
Soccer robot refers to computer,artificial intelligent,machine vision,signal processing, wireless communication,robotics and many other subjects etc.It is not only a research hotspot in the field of artificial intelligent and robot,but also a very challenging high-tech project.At present,two aspects of difficulties emerge from the developing soccer robot: one is in the research of sensor and control,and the other one exists in decision-making,planning and inference.This paper chooses RoboCup small-size soccer robot as the object of the study and conducts an in-depth study on the design of the robot control system and path planning.Study work of this paper includes the following parts:
At first,the paper introduces the system components of the RoboCup small-size robot competition and system structure of the omni-directional mobile robot which has been widely used in robot soccer competition recently,then deduces the kinematics function and dynamic function of the robot in the world coordinate system and the robot coordinate system,find relations between the robot control quantity and the condition quantity,correspondingly proposes the system function of the robot.Furthermore,the effectiveness of the model using detailed parameter of real robot can be testified by MATLAB simulation
Then the paper puts an emphases on the study of the control system of RoboCup small-size robot soccer game.By referring to the papers on the design of the small size soccer robot and analyzing the developing trend,DSP TMS320F2812 was chosen as main controller and used as the core in the drive board and the main-control board of the robot which was designed.The electrical circuit design of the robot motion,kick and dribble was located in drive-board.And the design of the peripheral interface and the communication interface was located in main-control board.And what’s more,the programming design and the performance test of every part was accomplished.
At last,the paper conducts an in-depth research on the path planning of soccer robot.Taking the venue of RoboCup small-size league competition as model,environment modeling was carried with the Grid Model,and combined with the Ant Colony Algorithm to carry on the path search,as a result,a non-collision optimized path can be found within shorter time.It is demonstrated by research simulation that the new method which builds an environment model with Grid Model and carries out the path search with Ant Colony Algorithm can make the soccer robot get to the target faster.
引文
1.宋健.智能控制超越世界的目标[J].中国自动化学会通讯,1999(104):7
2. The Robocup Federation.RoboCup Brief Introduction[EB/OL].http://www.robocup.org/, 2008-01-05
3. Mockworth A.0n seeing robots in Computer Vision:Systems,theory,and application[J]. World Scientific,Singapore,1993:1-13
4.洪炳镕.机器人足球的意义、最终目标及发展规划[EB/OL].http://www.firachina.net. 2007-03-11
5.张海英,刘祚时.群体机器人研究的现状和发展[J].机器人技术及应用,2004,1:38―41
6. The Robocup Federation.RoboCupSoccer.http://www.robocup.org/02.html.2007-09-01
7. RoboCup China Committee.RoboCup China Open 2007 Official Report[EB/OL]. http://www.robocupchina.org/,2007-11-06
8. Muir P F.Neuman,C P.Kinematic.Modeling of Wheeled Mobiled Robots[J]. Journal of Robotic Systems,1987,4(2):281-340
9.王磊,孙增圻.足球机器人结构设计研究[J].机械电子工程,2004,20(5):29-34
10.李振波,张琛等.微型全方位移动机器人的研制[J].机器人,2000,22(5):354-358
11.徐勇明,张培仁,郑旭东.四轮F180型机器人的设计与控制[C].2004机器人足球赛研讨会会议论文集,2004,广州:164-168
12.海丹,刘玉鹏,郑志强.四轮全向机器人的设计与控制方法[C].2005中国机器人大赛论文集,2005,常州:225-232
13. Luca Caracciolo,Alessandro De Luca,Stefano Iannitti.Trajectory tracking control of a four wheel differentially driven mobile robot[J].International Conference on Robotics and Automation1999:2632-2638
14.徐秀娜,赖汝.移动机器人路径规划技术的现状与发展[J].计算机仿真,2006,23(10):1-4
15. The Robocup Federation.Laws of the F180 League 2007[EB/OL].http://www.robocup.org, 2007-03-08
16.洪炳熔,韩学东,孟伟.机器人足球比赛研究[J].机器人,2003,25(4):373-377
17.赵冬斌,易建强.全方位移动机器人结构和运动分析[J].机器人,2003,25(5):394-398
18.薛方正,徐心和.集控式足球机器人决策与控制系统设计[J].机器人,2005,27(6):431-434
19. Jorge Angeles著.机器人机械系统原理理论、方法和算法[M].宋伟刚译.北京:机械工业出版社,2004,13-350
20.曹卫华,吴敏,陈鑫.基于DSP控制的足球机器人小车的设计与实现[J].机器人技术与应用,2002,3:19-21
21.宋铁群,杜华生,王德新.一种小型移动机器人的控制系统研究[J].机械研究与应用,2004,17(6):37-8
22.张翮.全方位移动机器人的运动建模与控制[D]:[硕士学位论文].杭州:浙江大学,2005
23. Raul Rojas.Omnidirectional Control[EB/OL].http://robocup.mi.fu-berlin.de/pmwiki/Main/, 2006
24.熊蓉,张翮等.四轮全方位移动机器人的建模与最优控制[J].控制理论与应用,2006, 23(1):93-98
25.张翮,熊蓉等.一种全方位移动机器人的运动分析与控制实现[J].浙江大学学报,2004, 38(12):1650-1653
26.谭民,徐德.先进机器人控制[M].北京:高等教育出版社,2007,4-8
27.郭旭,熊蓉.全方位移动机器人的运动预测控制[J].电机与控制学报,2007,11(1):79-82
28.王晓明.电动机的单片机控制[M].北京:北京航空航天大学出版社,2002,125-148
29.李策.基于DSP和FPGA的小型足球机器人控制系统的研究[D]:[硕士学位论文].大连:大连理工大学,2006
30.徐勇明.基于TMS320F2812的足球机器人底层控制[J].自动化与仪表,2004,6:10-14
31.赵臣,尚旭辉,耿淑琴.微型足球机器人底层控制系统研究[J].哈尔滨工业大学学报, 2003,35(9):1033-1035
32.张雄伟,曹铁勇.DSP芯片的原理与开发应用[M].北京:电子工业出版社,2000
33.刘和平,严利平.TMS320LF240x DSP结构原理及应用[M].北京:北京航空航天大学出版社,2002
34.闻亭科技公司.TDS510USB驱动大全[DB/OL].http://www.wintechdigital.com.cn/,2006
35.胡波.足球机器人系统中无线通讯网络和主板系统设计[D]:[硕士学位论文].西安:西北工业大学,2006
36.徐璟业,陈继荣.F-180小型足球机器人的无线通信系统设计[J].电子技术应用,2004, 30(5):60-63
37.黄新宇.基于DSP的足球机器人小车控制系统的研究与开发[D]:[硕士学位论文].成都:西华大学,2005
38.苏州钧和伺服科技有限公司.MAXON04/05[DB/OL].http://www.maxonmotor.com,2005
39.王晓明.电动机的单片机控制[M].北京:北京航空航天大学出版社,2002,26-177
40.刘赞.基于ARM7的足球机器人底层控制系统的设计[D]:[硕士学位论文].大连:大连理工大学,2005
41.张杰,吴敏.基于S3C2410的足球机器人小车系统设计[J].微型机与应用,2005,3:19-21
42.关慧贞,刘赞.LPC2106在足球机器人控制中的应用设计[J].单片机与嵌入式系统应用, 2005,1:47-49
43.郑旭东,张培仁,徐勇明.TMS320F2812在足球机器人上的应用[J].电子技术应用,2005, 8:65-68
44. Alexander Gloye,Fabian Wiesel.Learning to Drive and Simulate Autonomous Robots with Reinforcement Learning[EB/OL].http://robocup.mi.fu-berlin.de/buch/learning3.pdf,2006-5
45.郭路生.足球机器人路径规划研究与实现[D]:[硕士学位论文].北京:中国地质大学, 2006
46.张杰.基于嵌入式系统的足球机器人小车控制器设计与研究[D]:[硕士学位论文].长沙:中南大学,2005
47.刘国栋,谢宏斌,李春光.动态环境中基于遗传算法的移动机器人路径规划的方法[J].机器人,2003,25(4):327-329
48.李有梅,王文剑,徐宗本.关于求解难组合优化问题的蚁群算法[J].计算机科学,2002, 29(3):115-118
49.丁滢颍,何衍,蒋静坪.基于蚁群算法的多机器人协作策略[J].机器人,2003,25(5):414-418
50.戴博,肖晓明,蔡自兴.移动机器人路径规划技术的研究现状与展望[J].控制工程,2005, 12(3):198-202
51. James Bruce,Manuela Veloso.Safe Multi-Robot Navigation within Dynamics Constraints[J]. Proceedings of the IEEE,http://www.cs.cmu.edu/~coral/publications/index.html,2006
52.谢园园,朱庆宝.动态环境下基于蚁群算法的机器人路径规划[J].南京师范大学学报(工程技术版),2006,6(3):45-49
53.李果.基于改进蚁群算法的移动机器人路径规划[J].控制工程,2005,12(5):473-477
54.刘雪飘,李孝安.足球机器人动态路径规划方法研究[J].计算机测量与控制,2006,14(8): 1103-1107
55. Marco Dorigo,Gianni Di Caro,Thomas Stutzle.Special Issue on Ant Algorithms[A].Future Generation Computer System,2002,16(8):851-871
2. The Robocup Federation.RoboCup Brief Introduction[EB/OL].http://www.robocup.org/, 2008-01-05
3. Mockworth A.0n seeing robots in Computer Vision:Systems,theory,and application[J]. World Scientific,Singapore,1993:1-13
4.洪炳镕.机器人足球的意义、最终目标及发展规划[EB/OL].http://www.firachina.net. 2007-03-11
5.张海英,刘祚时.群体机器人研究的现状和发展[J].机器人技术及应用,2004,1:38―41
6. The Robocup Federation.RoboCupSoccer.http://www.robocup.org/02.html.2007-09-01
7. RoboCup China Committee.RoboCup China Open 2007 Official Report[EB/OL]. http://www.robocupchina.org/,2007-11-06
8. Muir P F.Neuman,C P.Kinematic.Modeling of Wheeled Mobiled Robots[J]. Journal of Robotic Systems,1987,4(2):281-340
9.王磊,孙增圻.足球机器人结构设计研究[J].机械电子工程,2004,20(5):29-34
10.李振波,张琛等.微型全方位移动机器人的研制[J].机器人,2000,22(5):354-358
11.徐勇明,张培仁,郑旭东.四轮F180型机器人的设计与控制[C].2004机器人足球赛研讨会会议论文集,2004,广州:164-168
12.海丹,刘玉鹏,郑志强.四轮全向机器人的设计与控制方法[C].2005中国机器人大赛论文集,2005,常州:225-232
13. Luca Caracciolo,Alessandro De Luca,Stefano Iannitti.Trajectory tracking control of a four wheel differentially driven mobile robot[J].International Conference on Robotics and Automation1999:2632-2638
14.徐秀娜,赖汝.移动机器人路径规划技术的现状与发展[J].计算机仿真,2006,23(10):1-4
15. The Robocup Federation.Laws of the F180 League 2007[EB/OL].http://www.robocup.org, 2007-03-08
16.洪炳熔,韩学东,孟伟.机器人足球比赛研究[J].机器人,2003,25(4):373-377
17.赵冬斌,易建强.全方位移动机器人结构和运动分析[J].机器人,2003,25(5):394-398
18.薛方正,徐心和.集控式足球机器人决策与控制系统设计[J].机器人,2005,27(6):431-434
19. Jorge Angeles著.机器人机械系统原理理论、方法和算法[M].宋伟刚译.北京:机械工业出版社,2004,13-350
20.曹卫华,吴敏,陈鑫.基于DSP控制的足球机器人小车的设计与实现[J].机器人技术与应用,2002,3:19-21
21.宋铁群,杜华生,王德新.一种小型移动机器人的控制系统研究[J].机械研究与应用,2004,17(6):37-8
22.张翮.全方位移动机器人的运动建模与控制[D]:[硕士学位论文].杭州:浙江大学,2005
23. Raul Rojas.Omnidirectional Control[EB/OL].http://robocup.mi.fu-berlin.de/pmwiki/Main/, 2006
24.熊蓉,张翮等.四轮全方位移动机器人的建模与最优控制[J].控制理论与应用,2006, 23(1):93-98
25.张翮,熊蓉等.一种全方位移动机器人的运动分析与控制实现[J].浙江大学学报,2004, 38(12):1650-1653
26.谭民,徐德.先进机器人控制[M].北京:高等教育出版社,2007,4-8
27.郭旭,熊蓉.全方位移动机器人的运动预测控制[J].电机与控制学报,2007,11(1):79-82
28.王晓明.电动机的单片机控制[M].北京:北京航空航天大学出版社,2002,125-148
29.李策.基于DSP和FPGA的小型足球机器人控制系统的研究[D]:[硕士学位论文].大连:大连理工大学,2006
30.徐勇明.基于TMS320F2812的足球机器人底层控制[J].自动化与仪表,2004,6:10-14
31.赵臣,尚旭辉,耿淑琴.微型足球机器人底层控制系统研究[J].哈尔滨工业大学学报, 2003,35(9):1033-1035
32.张雄伟,曹铁勇.DSP芯片的原理与开发应用[M].北京:电子工业出版社,2000
33.刘和平,严利平.TMS320LF240x DSP结构原理及应用[M].北京:北京航空航天大学出版社,2002
34.闻亭科技公司.TDS510USB驱动大全[DB/OL].http://www.wintechdigital.com.cn/,2006
35.胡波.足球机器人系统中无线通讯网络和主板系统设计[D]:[硕士学位论文].西安:西北工业大学,2006
36.徐璟业,陈继荣.F-180小型足球机器人的无线通信系统设计[J].电子技术应用,2004, 30(5):60-63
37.黄新宇.基于DSP的足球机器人小车控制系统的研究与开发[D]:[硕士学位论文].成都:西华大学,2005
38.苏州钧和伺服科技有限公司.MAXON04/05[DB/OL].http://www.maxonmotor.com,2005
39.王晓明.电动机的单片机控制[M].北京:北京航空航天大学出版社,2002,26-177
40.刘赞.基于ARM7的足球机器人底层控制系统的设计[D]:[硕士学位论文].大连:大连理工大学,2005
41.张杰,吴敏.基于S3C2410的足球机器人小车系统设计[J].微型机与应用,2005,3:19-21
42.关慧贞,刘赞.LPC2106在足球机器人控制中的应用设计[J].单片机与嵌入式系统应用, 2005,1:47-49
43.郑旭东,张培仁,徐勇明.TMS320F2812在足球机器人上的应用[J].电子技术应用,2005, 8:65-68
44. Alexander Gloye,Fabian Wiesel.Learning to Drive and Simulate Autonomous Robots with Reinforcement Learning[EB/OL].http://robocup.mi.fu-berlin.de/buch/learning3.pdf,2006-5
45.郭路生.足球机器人路径规划研究与实现[D]:[硕士学位论文].北京:中国地质大学, 2006
46.张杰.基于嵌入式系统的足球机器人小车控制器设计与研究[D]:[硕士学位论文].长沙:中南大学,2005
47.刘国栋,谢宏斌,李春光.动态环境中基于遗传算法的移动机器人路径规划的方法[J].机器人,2003,25(4):327-329
48.李有梅,王文剑,徐宗本.关于求解难组合优化问题的蚁群算法[J].计算机科学,2002, 29(3):115-118
49.丁滢颍,何衍,蒋静坪.基于蚁群算法的多机器人协作策略[J].机器人,2003,25(5):414-418
50.戴博,肖晓明,蔡自兴.移动机器人路径规划技术的研究现状与展望[J].控制工程,2005, 12(3):198-202
51. James Bruce,Manuela Veloso.Safe Multi-Robot Navigation within Dynamics Constraints[J]. Proceedings of the IEEE,http://www.cs.cmu.edu/~coral/publications/index.html,2006
52.谢园园,朱庆宝.动态环境下基于蚁群算法的机器人路径规划[J].南京师范大学学报(工程技术版),2006,6(3):45-49
53.李果.基于改进蚁群算法的移动机器人路径规划[J].控制工程,2005,12(5):473-477
54.刘雪飘,李孝安.足球机器人动态路径规划方法研究[J].计算机测量与控制,2006,14(8): 1103-1107
55. Marco Dorigo,Gianni Di Caro,Thomas Stutzle.Special Issue on Ant Algorithms[A].Future Generation Computer System,2002,16(8):851-871