安徽
毕 业 设 计 (论 文)
课 题: 足球机器人的控制系统设计 专 业: 机械设计制造及其自动化 班 级: 07城建机械3班 学生姓名: 蒋严 学 号: 07290070325 指导教师: 李辉
2011年6月8日
安徽建筑工业学院本科毕业设计(论文)
摘要
本文主要介绍了对遥轮足球机器人运动控制算法的研究。首先,本文建立了四轮全向足球机器人运动学和动力学模型。通过对机器人运动学和动力学模型的分析,对其控制方程进行合理简化,提出了四轮全向足球机器人的运动控制算法。该算法可以对机器人同时完成或位置控制和速度控制,并且控制时间最优。该算法分为两个部分:机器人速度轨迹生成算法和机器人速度轨迹跟随算法。机器人速度轨迹生成算法基于开关控制原理,它根据机器人当前位置、当前速度、目标点位置和目标点速度,生成一条从“当前点”到“目标点”的时间最优的速度轨迹。机器人速度轨迹生成算法利用模糊PID复合算法实时控制机器人四组驱动轮速度。通过四组驱动轮的速度矢量合成,使得机器人跟随设定的速度轨迹。实验表明该速度控制算法完全满足控制足球机器人运动快速、准确、灵活的控制要求。
本文还对四轮足球机器人的控制系统进行了研究和设计。控制系统采用主一从式双DSP为核心的设计方案。系统中,主DSP对从DSP进行管理和控制、双DSP配合,完成速度跟随控制、无线通讯、传感器数据读取等任务。该方案传统方案相比,更加稳定、实用、可靠,功能更强。 关键词:足球机器人、FIRA 、 DSP、运动控制
ABSTRACT
2
安徽建筑工业学院本科毕业设计(论文)
The robot of RoboCup games must travels in a confused dynamic circumstance freely and achieve an accurate positioning in the competition.In this paper,the kinematics equations and the dynamic equations of the holonomic omni—directional wheeled mobile robot are presented. Analysing those equations,this paper propose a motion control method for the robot.The method includes two pans,Velocity Trajectory Generation(VTG)and Velocity Trajectory Tracking(VTT).The VTG is based on Bang—Bang control and generates a velocity trajectory from start—point to end—point for the robot.The VTT is based on PID control and controls the velocity of the robot tracking the velocity trajectory generated by VTG.
This paper presents the design of Robot Soccer’s circuit system.The core of the circuit is dual DSP,TMS320LF2407A.One DSP is the master, the other is slavery.Under the control of the master ,the slavery DSP realizes the motion control Algorithm.
Key words: Soccer robot、TMS320LF2407、、Motion control、Digital signal
processing
3
安徽建筑工业学院本科毕业设计(论文)
目录
摘要................................................................................................................................ 2 1 绪论.......................................................................................................................... 6
1.1.足球机器人的简介…………………………………….. ………………………9 1.2 .Robocup挑战计话 ...................................................................................... 9 1.3论文内容..................................................................................................... 10 1.4本章小结........................................................................................................ 10 2足球机器人的体系结构………………………………………………………….11
2.1. 足球机器人的系统原理组成……………………………………………11 2.2.足球机器人的系统工作模式........................................................................ 13 2.3足球机器人的系统组成................................................................................ 14 2.4.足球机器人的技术要求................................................................................ 15 2.5.机器人机电结构系统.................................................................................... 17 .6.本章小结.......................................................................................................... 20 3 以双DSP为核心的控制系统电路设计 .............................................................. 21
3.1 控制电路系统结构....................................................................................... 21 3.2 MCU模块设计 ............................................................................................. 22 3.3.主从工作模式下的软件设计........................................................................ 25 3.4. 驱动电路模块的设计.................................................................................. 28 3.5.传感器电路模块设计.................................................................................... 33 3.6. DC-DC升压电路模块设计 ......................................................................... 35 3.7. 本章小结...................................................................................................... 36
4 足球机器人控制对象建模…………………………. …………………………37
4.1控制系统的总体设计…………………………………………………………37
4.2足球机器人的动力学建模…………………………………………………………38
4.3足球机器人的运动学建模…………………………..……………………….42
4
安徽建筑工业学院本科毕业设计(论文)
4.4本章总结………………………………………………………………………48 5 研究工作总结及展望............................................................................................ 49 参考文献...................................................................................................................... 51 致 谢.......................................................................................................................... 53 附录一 毕业设计任务书.......................................................................................... 62
5