多功能机器人“灵狐”的研究与实现.docx

《多功能机器人“灵狐”的研究与实现.docx》由会员分享，可在线阅读，更多相关《多功能机器人“灵狐”的研究与实现.docx（71页珍藏版）》请在三一办公上搜索。

1、序号： 编码： 第九届“挑战杯”全国大学生课外学术科技作品竞赛作品申报书 作品名称：基于DSP无线通讯的多功能机器人“灵狐”的研究与实现 学校全称： 西北工业大学 申报者姓名 （集体名称）： 周飞，崔海华，许斌，欧为军，王庆， 类别：自然科学类学术论文 哲学社会科学类社会调查报告和学术论文 科技发明制作A类 科技发明制作B类 报送方式：省级报送作品高校直送作品说 明1申报者应在认真阅读此说明各项内容后按要求详细填写。2申报者在填写申报作品情况时只需根据个人项目或集体项目填写A1或A2表，根据作品类别（自然科学类学术论文、哲学社会科学类社会调查报告和学术论文、科技发明制作）分别填写B1、B2或B

2、3表。所有申报者可根据情况填写C表。3表内项目填写时一律用钢笔或打印，字迹要端正、清楚，此申报书可复制。4序号、编码由第九届“挑战杯”全国大学生课外学术科技作品竞赛全国组委会填写。5学术论文、社会调查报告及所附的有关材料必须是中文（若是外文，请附中文本），请以4号楷体打印在A4纸上，附于申报书后，字数在8000字左右（文章版面尺寸14.522cm）。6发起高校的三件直送作品和各省（区、市）通过初评的作品（数量参照“作品数额分配方案”）各一式四份分别按全国组委会规定的时间用特快专递寄至全国竞赛组委会办公室。7作品申报书须按要求由各省或各校竞赛组织协调机构统一寄送。8其他参赛事宜请向本校竞赛组织协

3、调机构咨询。9寄送地址：复旦大学团委第九届“挑战杯”全国大学生课外学术科技作品竞赛组委会办公室联 系 人：丁 力联系电话：02165642631传 真：02165642631邮政编码：200433A2申报者情况（集体项目）说明：1必须由申报者本人按要求填写；2申报者代表必须是作者中学历最高者，其余作者按学历高低排列；3本表中的学籍管理部门签章视为申报者情况的确认。申报者代表情况姓名周飞性别男出生年月83.7学校西北工业大学系别自动化学院专业测控技术及仪器年级大四学历本科学制四年入学时间2001.9作品名称基于DSP无线通讯的多功能机器人“灵狐”的研究与实现通讯地址西北工业大学自动化学院907教

4、研室邮政编码710072办公电话88495943常住地通讯地址西北工业大学旺园学生公寓51信箱邮政编码710072住宅电话82374476其他作者情况姓 名性别年龄学历所在单位崔海华男21本科西北工业大学自动化学院许斌男21本科西北工业大学自动化学院欧为军男20本科西北工业大学自动化学院王庆男20本科西北工业大学自动化学院资格认定学校学籍管理部门意见以上作者是否为2005年7月1日前正式注册在校的全日制非成人教育、非在职的高等学校中国籍专科生、本科生、硕士研究生或博士研究生。是否（部门签章）年 月 日院、系负责人或导师意见本作品是否为课外学术科技或社会实践活动成果是否负责人签名：年 月 日B3

5、申报作品情况（科技发明制作）说明：1必须由申报者本人填写；2本部分中的科研管理部门签章视为对申报者所填内容的确认； 3本表必须附有研究报告，并提供图表、曲线、试验数据、原理结构图、外观图（照片），也可附鉴定证书和应用证书； 4作品分类请按照作品发明点或创新点所在类别填报。作品全称基于DSP无线通讯的多功能机器人“灵狐”的研究与实现作品分类（ABC）A机械与控制（包括机械、仪器仪表、自动化控 制、工程、交通、建筑等） B信息技术（包括计算机、电信、通讯、电子等） C数理（包括数学、物理、地球与空间科学等） D生命科学（包括生物、农学、药学、医学、健 康、卫生、食品等） E能源化工（包括能源、材料

6、、石油、化学、化 工、生态、环保等）作品设计、发明的目的和基本思路，创新点，技术关键和主要技术指标一、目的： “机器人可以部分或完全地解放人类！”这是机器人最有诱惑力的一面。一个国家的军事力量是整个国家的综合国力的重要体现。综合上面的因素，我们积极开拓创新，大胆设想，针对DSP诸多高性能的特点，努力挖掘高性能机器人在军事领域的应用价值。 二、基本思路：将高性能DSP运用于军事领域，可以提高作战能力。同时我们利用步进电机作为执行机构，利用无线通讯编码技术进行通讯，利用无线图像传输技术及GPS定位技术进行定位，利用超声波传感器阵列进行检测避障，利用语音识别及合成技术等实现特殊复杂功能。未来人类将会

7、利用军事机器人执行各种特殊的任务。除了作战功能，我们制作的机器人还将具有舞蹈功能、逐球功能，这归功于美学及路径规划技术、图像采集和处理技术等的发展。我们的目标就是让机器人“无所不能”。三、创新点：1. 将高性能DSP运用到小型轮式机器人领域；2. 运用GPS进行辅助导航功能；3. 利用无线图像传输技术进行侦察配合精确打击（军事），以及高危环境的环境勘测（商用）；4. 机器人体积小，便于隐藏，还适合小环境作业；5. 特定的语音识别技术使机器人更加智能化，如可以识别我方特工（军用），以及人机互动（民用娱乐）；6. 交互式无线通讯方式可以保证控制的有效性，实时性。四、技术关键：该机器人涉及到的关键技

8、术有DSP控制技术、无线通讯与编码技术、音乐美学与路径规划技术、图像采集传输与处理技术、GPS定位导航技术、超声波检测避障技术、语音识别与合成技术、多传感器数据融合技术等等。 五、主要技术指标（实现功能）：一、机器人军事功能演示：机器人通过无线通讯接收指令；机器人开始往指定目的地运动，运动过程中，不断传回图像数据；控制台工作人员可以利用PC、控制平台及GPS定位信息控制机器人；到达指定地点实现特殊任务，如爆破。二、 机器人舞蹈功能演示： 两个机器人编队在抒情的音乐下跳起优美的舞蹈；这期间可以实现图像定位、与人语音交互、超声波测距、无线通讯接收命令等功能；演示方式一：用图像进行定位（半自主）；演

9、示方式二：用内部程序进行舞蹈（全自主）；三、机器人逐球功能演示： 操作者利用已编好的软件通过摄像头对小车、小球、以及背景进行色样采点，然后由已编好的程序算出小车与小球的相对位置坐标，然后发送指令控制小车去追逐小球。六、部分技术参数：DSP：指令周期25ns,AD转换时间只需375ns, 且含有8个16位PWM通道；GPS：利用12颗卫星，控制精度15m；超声波传感器精度：1cm；舞蹈用的执行机构理论精度0.08cm；无线通讯传输速率100Kbps。 作品的科学性先进性（必须说明与现有技术相比、该作品是否具有突出的实质性技术特点和显著进步。请提供技术性分析说明和参考文献资料）一、科学性和先进性：

10、基于高性能DSP无线通讯的军事机器人涉及数学、力学、机械、电子、自动控制、传感器、通信、计算机、人工智能及美学等多个领域的前沿研究和技术融合，其高性能的实时处理能力、高精度的定位能力、高可靠性的作战能力使之具有较强的军事作战价值。二、与现有作品相比，突出实质性技术：7. 实现了DSP步进电机控制器的解决方案；8. 采用无线通讯及编码技术可以远距离传输指令；9. 设计出配合音乐节拍的路径（美学）； 10. 建立了完整而实用的轮式移动机器人运动学和动力学模型；11. 运用超声波、无线视频传输和GPS组合导航可使该机器人准确安全到达目的地；12. 将DSP和无线通讯编码技术运用在军事领域可增强国家国

11、防力量；13. 对室外自主导航小型机器人这个前沿学科的探索，打破国外发达国家的技术封锁。 三、作品中有潜在价值的技术水平：14. 40MIPS运行速度使得指令周期为25ns，可以快速进行各种数值运算；15. 8个16位PWM通道，可产生任意占空比的波形；16. 步进电机工作在四相八拍方式下，可转几乎任意半径的圆圈，理论控制精度为0.0855cm；17. 无线通讯可一次性传输（收发）32个字节，接收方可以实现一系列的动作；通讯速度可以达到100Kbps，可以很好的满足对实时性有一定要求的场合。而且无线通讯具有交互功能，可以进一步扩大应用空间；18. 单个GPS接收机定位精度小于15m，差分后可以

12、减小到1m级别，甚至mm级别；19. 超声波测距0.12m，控制精度在cm级别；20. 语音识别既可以实现特定人也可以非特定人，而且正确率均在95以上。作品在何时、何地、何种机构举行的评审、鉴定、评比、展示等活动中获奖及鉴定结果其基础框架构建作品基于DSP无线通讯的轮式移动机器人的研究与实现在校“三航杯”课外科技作品竞赛中获本科生科技制作发明类二等奖（一等奖空缺），当时我们只实现了舞蹈机器人功能。终审意见表为“基于DSP无线通讯的WMR作品采用了高性能DSP与无线编码技术，该机器人系统结构设计合理、功能较强、智能化程度较高。”“该作品技术含量较高，涉及知识面较广，作为本科生课外科技作品，体现了

13、作者较强的独立工作能力和科研创新能力。”作品所处阶 段（A）A实验室阶段 B中试阶段 C生产阶段D （自填）技术转让方式作品可展示的形 式 实物、产品 模型 图纸 磁盘现场演示 图片 录像 样品使用说明及该作品的技术特点和优势，提供该作品的适应范围及推广前景的技术性说明及市场分析和经济效益预测一、现有作品的特点和优势：21. 补充我国机器人种类，可增加我国军事力量，提高我国的综合国力；22. 运用高性能DSP技术提高作战整体水平；23. 运用高速无线通讯技术可以有效地保证实时性；24. 具有超声波多路采集系统实现自我避障功能；25. GPS定位技术给导航提供很好的依据；26. 科技水平高，应用

14、前途广。二、适应范围和推广前景：可适用于军事领域，可从事部分高危险性作业，如工作在核实验基地等； 可适用于商业领域，实现人机互动，伴随音乐进行舞蹈，键盘遥控等娱乐功能。可适用于体育事业，实现足球机器人功能。三、初步市场分析：在很多国家包括我国，特种机器人的数量不是很多。美国将机器人看作未来作战体系的中心，军事机器人无论在数量还是质量上均却遥遥领先，而且技术封锁。我国是一个军事强国，在军事方面肯定不可以落后。该产品具有价格低、体积小、控制精确、实时性高等诸多优点，相信再开发半年应该就可以运用到战场上。除此之外，该机器人还可用于商业开发，主要是娱乐业和体育行业，商业前景广阔。专利申报情况提出专利申

15、报 申报号 申报日期 年 月 日已获专利权批准 批准号 批准日期 年 月 日 未提出专利申请科研管理部门签 章 年 月 日C.当前国内外同类课题研究水平概述 说明：1.申报者可根据作品类别和情况填写； 2.填写此栏有助于评审。机器人制作是近年来国际上迅速开展起来的一种高技术活动，它涉及数学、力学、机械、电子、自动控制、传感器、通信、计算机、人工智能等多个领域的前沿研究和技术融合，集高技术，娱乐和比赛于一体，能有效培养学生的动手能力、创造能力和协作精神，引起了公众的广泛关注和极大的兴趣。根据文献资料，基于DSP的WMR制作在国外已经轰轰烈烈的开展起来，国外已经有一定这样的成型产品。但由于各种条件

16、的限制，基于DSP的WMR在国内仍处于起步阶段。和该项目相似的在国内外有舞蹈机器人、足球机器人及巡迹机器人等，而且几乎都是用单片机实现的。为了改善机器人的性能，中科院自动化研究所接国家863计划制作了基于DSP技术和嵌入式操作系统技术开发研制了智能移动机器人系统CASIA-I，同时国防科技大学为了参加足球机器人竞赛将处理器改为DSP。另一篇文章基于DSP的移动机器人的设计与实现表明上海交通大学已经有基于DSP的WMR。在中移动机器人的发展展望一文中说道：“工业用自动引导移动机器人（AGV）也得到了飞速发展，在拥有了视觉和激光扫描传感器之后，AGV已经被提高到了一个新的高度了。缺少一套可以适应不

17、同环境和任务的控制算法是目前制约移动机器人发展的最大障碍。目前的算法都仅仅能够适用在被规划好的环境，在没有规划好的环境中，机器人几乎是寸步难行。”种种迹象表明，基于DSP的WMR制作是一项新兴的项目开发事业，在国内尚且起步及技术封锁的情况下，我们小组自主研发了基于DSP无线通讯的WMR，可以说，该WMR制作的科技含量走在了国内的领先位置。D.推荐者情况及对作品的说明说明：1由推荐者本人填写； 2推荐者必须具有高级专业技术职称，并是与申报作品相同或相关领域的专家学者或专业技术人员（教研组集体推荐亦可）； 3推荐者填写此部分，即视为同意推荐； 4推荐者所在单位签章仅被视为对推荐者身份的确认。推荐者

18、情况姓 名范蟠果性别男年龄44职称副教授工作单位西北工业大学自动化学院通讯地址西北工业大学自动化学院邮政编码710072单位电话029-88495943住宅电话88491637推荐者所在单位签章 （签章） 年 月 日请对申报者申报情况的真实性作出阐述作品真实 请对作品的意义、技术水平、适用范围及推广前景作出您的评价基于DSP无线通讯的多功能机器人立意新、创新性高、涉及面广、技术含量高。该作品智能化程度高，集成了众多学科的前沿知识，是一个复杂的系统工程。将高性能DSP运用到军事领域本身就是大胆创新的表现；利用无线图像编码传输技术和交互式无线通讯技术可以保证控制的有效性，再配合GPS进行辅助定位导

19、航，可以实现多种任务。特定的语音识别技术使机器人更加智能化。其它说明推荐者情况姓 名栾云风性别女年龄52职称副教授工作单位西北工业大学自动化学院通讯地址西北工业大学自动化学院邮编710072单位电话88492814住宅电话13572000586推荐者所在单位签章 签章日期 年 月 日 请对申报者申报情况的真实性作出阐述作品真实 请对作品的意义、技术水平、适用范围及推广前景作出您的评价机器人制作涉及多个领域的前沿研究和技术融合，集高技术，娱乐和比赛于一体，能有效培养学生的动手能力、创造能力和协作精神，是近年来国际上迅速开展起来的一种高技术活动。基于DSP无线通讯的多功能机器人涉及电机与拖动技术、

20、DSP控制技术、无线通讯与编码技术、音乐美学与路径规划技术、图像采集传输与处理技术、GPS定位导航技术、超声波测距避障技术、语音识别与合成技术、多传感器数据融合技术等等，是一项跨多学科、系统化的大项目。创意新、胆识大、科技含量高。该机器人的制作对我国军事机器人一个很好的补充作用，对提高我国的国防力量有一定的促进作用。 其它说明推荐者情况姓 名张英敏性别女年龄49职称副教授工作单位西北工业大学自动化学院通讯地址西北工业大学自动化学院邮编710072单位电话88493204-8216住宅电话88495556推荐者所在单位签章 签章日期 年 月 日 请对申报者申报情况的真实性作出阐述作品真实 请对作

21、品的意义、技术水平、适用范围及推广前景作出您的评价基于DSP的多功能机器人是机器人开发设计的新兴领域，其中无线图像编码传输技术，交互式无线通讯控制技术及特定的语音识别技术的应用有创新性，技术水平高，涉及领域广。同时利用GPS定位技术进行辅助导航，可以有效地保证机器人到达目的地。该机器人可实现多种军事功能,如侦察、爆炸物处理、安全巡逻、监视等等。若再加上履带式结构，可运用于野外作战。其它说明学校组织协调机构确认并盖章 （团委代章） 年 月 日 校主管领导或校主管部门确认盖章 年 月 日 各省（区、市）评审委员会初评意见 评委签名： 年 月 日 各省（区、市）组织协调委员会审定意见 团 委 科 协

22、 教 育 厅 学 联（签章） （签章） （签章） （签章） 年 月 日E全国组织委员会秘书处资格和形式审查意见组委会秘书处资格审查意见 审查人（签名） 年 月 日组委会秘书处形式审查意见 审查人（签名） 年 月 日组委会秘书处审查结果合格 不合格 负责人（签名） 年 月 日 目 录第1章 绪论161.1 引言161.2移动机器人研究现状171.3 本课题研究内容及意义18第2章 灵狐机器人系统及其运动模型 192.1 系统框架192.2 灵狐机器人运动建模202.2.1 运动学模型212.2.2 动力学模型23第3章 灵狐机器人子系统设计 243.1 DSP驱动控制子系统243.1.1 DSP

23、简介243.1.2 PWM的实现方法253.1.3 驱动结构设计263.1.3.1步进电机简介及电机选型263.1.3.2机械结构设计273.1.4 步进电机控制283.2 无线通讯子系统293.2.1 无线通讯子系统作用293.2.2 芯片选型293.2.3 无线通讯子系统硬件接口303.2.4 软件编程313.2.5 通信协议设置333.2.6 通信传输距离的计算333.3 超声波子系统343.3.1 超声波测距原理343.3.2 系统硬件接口343.3.3 数据处理353.3.4 结果误差分析363.4 无线图像传输子系统363.5 GPS辅助导航子系统383.5.1 GPS定位原理38

24、3.5.2 产品选型393.5.3 系统硬件接口403.5.4 NMEA-0183通信标准413.5.5 GPGGA语句解析413.6 语音识别子系统423.6.1 系统硬件接口图423.6.2 非特定人语音识别程序的编写433.7 音乐控制子系统453.7.1 系统设计方案453.7.2 音乐子系统的实现453.8 逐球图像处理子系统463.8.1 系统设计方案463.8.2 图像处理子系统的研究与实现473.8.2.1系统结构图473.8.2.2 图像模型的选择RGB模型473.8.2.3 空间坐标变换483.8.2.4 色标设计与识别50第4章 机器人底层控制算法设计 514.1 PD控

25、制简介524.2 系统实现52第5章 实现功能及轨迹控制精度误差实验 545.1 实现功能545.1.1 “灵狐排练”模式545.1.2 基于人的思维的反馈式近地侦察模式555.1.3 基于视觉闭环自治的逐球模式575.2 轨迹控制精度分析595.2.1 轨迹精度误差实验的设计和实现595.2.2 误差分析59第6章 总 结 616.1 概述616.2 主要工作和创新点616.3 作品适用范围及发展前景626.4 研究结论626.5 存在问题及工作展望63主要作者本科阶段发表论文63参考文献.63附录1 配合音乐的DSP舞蹈控制程序66附录2 机器人性能参数67基于DSP无线通讯的多功能机器人

26、“灵狐”的研究与实现第1章 绪论1.1 引言二十一世纪的钟声宣告了知识经济时代的来临，我国也相应提出“科技兴国”方针，大力发展科技事业。机器人是传统的结构学与近代电子技术相结合的产物，是集计算机科学、控制技术、传感器技术、电机技术、机构学及美学等多学科为一体的高科技产物，它的出现和发展不但使传统的工业生产和科学研究发生根本性的变化，而且将对人类社会生活产生深远的影响。图11Sony公司 AIBO机器狗机器人的研究和应用水平，是一个国家经济实力和科技发展水平的反映，一个国家如果不拥有一定数量和质量的机器人，就不具备产品国际竞争的工业基础。因此，世界上许多国家，包括中国在内都对机器人的发展予以高度

27、重视。机器人已发展50年左右了，虽由于涉及的技术太复杂，机器人还没有如人们预期的那样,但得益于相关技术的飞速发展，很多移动机器人即将进入人们的生活。在进入21世纪以后，已经有超过6家公司发布了家用洗尘机器人，Sony公司的AIBO机器狗（图11）更是以超过1万人民币的售价在全世界范围内卖出了上万只1，这无疑给机器人市场注入了一只强心剂。同时工业用自动引导移动机器人（AGV）也得到了飞速发展，在拥有了视觉和激光扫描传感器之后，AGV已经被提高到了一个新的高度。在军事方面，随着高新技术的发展，各种类型的军用机器人已经大量涌现，一些技术发达的国家相继研制了智能程度高、动作灵活、应用广泛的军用机器人。

28、目前军用机器人主要是作为作战武器和保障武器使用。在恶劣的环境下，机器人的承受能力大大超过载人系统，并且能完成许多载人系统无法完成的工作，如运输机器人可以在核化条件下工作，也可以在炮火下及时进行战场救护。在地面上，机器人为联合国维和部队排除爆炸物、扫除地雷；在波黑战场上，无人机大显身手；在海洋中，机器人帮助人清除水雷、探索海底秘密；在宇宙空间，机器人成了火星考察的明星。1.2移动机器人研究现状图12 美国Pioneer2-DXe7在美国，日本及欧洲的许多发达国家，由于移动机器人在人工智能理论研究、服务和娱乐领域的商业前景而受到重视，许多高校和企业都做了一定的理论研究和实践23，同样无线通信技术也

29、在飞速发展45。我国的机器人事业起步较晚，移动机器人的研究早期主要集中在哈尔滨工业大学、清华大学、中国科技大学、上海交通大学等高等院校。下面介绍几个主要的移动机器人。美国Active Media公司成功地开发了先锋系列轮式移动机器人。以Pioneer2-DXe为例，如图12所示， 它采用两轮驱动、一轮从动的结构拖动车体在平地上运动，基于西门子的C166的控制器在分析来自声纳传感器和图像传感器的基础上，按照一定的控制算法对分别驱动左右电机进行控制，从而实现机械小车的启停、转向等。图13 Robot J Edgar 7澳大利亚墨尔本大学研制的轮式移动机器人Robot J Edgar可以用作视觉导航

30、移动机器人应用的测试平台。如图13所示，小车体积较小，车体高66cm，直径为48cm；小车采用左右两轮分别驱动、前后各装一个定位轮的结构，驱动速度达40cm/s。系统集成了声纳传感器和图像传感器。该机器人具有发现目标、自主避障的功能。1.3 本课题研究内容及意义（1）我国移动机器人研究及制作，在传感器、控制器和控制算法上普遍落后于欧美发达国家，特别是使用单片机作为机器人的控制器，不仅使整个电路系统复杂，而且在控制精度、控制算法及实时性方面均受到限制。本文正是突破这种传统做法，选用性能更强的DSP作为控制器的核心进行开发的。（2）目前，国内外许多学者从理论方面研究了驱动可行走机器人的运动规划以及

31、控制方法，并且取得了丰硕的成果。尽管有许多控制策略考虑到了实际系统中存在的各种不确定性和扰动对系统的影响，从而建立了相应的鲁棒控制方法，并进行了仿真试验，但这种理论上的模拟和实际应用的情况仍然相差甚远。要将这些理论上的控制方法应用到实际工程中去，必须首先经过实验验证，然后才能应用到工程实际。因此，研制轮式移动机器人的实验平台及相应的控制装置，并且在该装置上进行控制算法的实验研究具有十分重要的意义。（3）许多机器人，尤其是足球机器人，驱动几乎清一色是直流电机。直流电机速度快，但控制精度低。为实现无线高精度控制机器人，本文实现了DSP步进电机控制器的解决方案，理论控制精度达0.08cm。（4）该作

32、品适合于近距离侦察、攻击目标。基于蓝牙技术的无线通讯距离短，隐蔽性好，而且独特的载波监测、地址匹配、数据就绪输出给破译和干扰带来相当的难度。（5）该作品还具有美学欣赏价值，又因其语音功能而具有人机互动能力，所以有很强的娱乐性，可向玩具商品方向发展。第2章 灵狐机器人系统及其运动模型2.1 系统框架基于DSP无线通讯多功能机器人平台“灵狐”主要有三大功能，近地侦察、逐球和舞蹈。前两者均属于半自主系统，而舞蹈功能的实现无需反馈信息，属于完全自主系统。近地侦察是一种基于人的思维判断的反馈式无线控制系统，其硬件框图如图21所示。整套系统可分为七个子系统，即GPS辅助导航子系统、语音识别子系统、无线图像

33、传输子系统、音乐控制子系统、DSP驱动控制子系统、无线通讯子系统及超声波子系统。无线图像传输子系统实时传输给控制台图像数据，同时GPS辅助导航子系统也实时地传回机器人所在的经纬度，控制人员根据所获得的信息通过无线通讯子系统控制机器人的运动。其中主控制台是系统控制器，DSP驱动控制子系统和音乐子系统可以看成执行机构或控制对象，而无线通讯子系统则是主控制台和DSP驱动控制子系统中间的信息桥梁，超声波子系统、GPS辅助导航子系统及无线图像传输子系统配合有效控制。图21 基于人的思维判断的反馈式近地侦察模式硬件框图逐球机器人是一种基于视觉闭环自治的无线控制系统，其硬件框图如图22所示。整套系统可分为图

34、像处理子系统、DSP驱动控制子系统、决策子系统和无线通讯子系统共四个子系统。视觉子系统感知场地上环境信息和运动物体的位姿状态，并将其传送给决策系统，决策子系统对这些信息进行分析处理，再通过运动控制函数和无线通讯接口将决策内容转化为输出指令，无线通讯子系统以广播通信方式将指令发送给机器人驱动子系统，机器人小车接受指令完成速度跟踪控制。图22 基于视觉闭环自治的逐球机器人模式硬件框图整套系统是一个完整的自治系统，它具有一个实时的视觉闭环。图23是逐球机器人系统平台全视图。图23 逐球机器人模式平台全视图舞蹈功能由机器人自主系统实现，按指定路径伴随音乐节拍做相应舞蹈动作。2.2 灵狐机器人运动建模轮

35、式移动机器人是典型的非完整性系统，其物理含义是机器人不能沿轮轴方向运动5。非完整性控制系统没有孤立的平衡点，因此没有局部渐进稳定平衡点，只存在包含原点的平衡流形。图24 移动机器人采用的传统轮和瑞典轮移动机器人的轮子可分为两种类型：传统轮和瑞典轮。图24(a)为传统轮的偏心方向轮。偏心轮具有全方位运动能力，同样瑞典轮也是全方位轮，如图24(b)所示，点的速度为： （2-1）其中，为轮子半径；为轴的单位向量；为速度向量；为瑞典轮的滚动轴运动的单位向量； 、为机器人质心的瞬时线速度和角速度。不同的轮式具有不同的运动能力和约束。通常用运动自由度DOM和舵性自由度DOS的组合形式（DOM，DOS）来定

36、义轮式机器人的移动能力8。只具有两个运动自由度的 (2，0)系统为目前普遍研究对象。基于DSP无线通讯的Agent采用2轮差分结构，前后端分别有支撑的万向轮。2.2.1 运动学模型如图25所示，、轴为机器人外部环境坐标系，而、轴所代表的就是机器人自身的坐标系。机器人的位姿就是，其中为机器人在绝对坐标系中的坐标。图25 轮式移动机器人运动学模型 图26 坐标转换确定机器人的位姿要引入坐标变换的概念。如图26所示，抽象化机器人为点，在绝对坐标系中的坐标为，在相对坐标系中的坐标为，机器人中心在绝对坐标系中的坐标为，在中的角度为。则可得点在两种坐标之间的转换公式 （2-2）假定轮子和地面之间没有滑动，

37、即每瞬时与地面接触点的速度等于零。则每个轮子的运动学方程为： （2-3）其中，为1/2机器人左右轮间距；、分别为左右轮转动的角度。假定机器人在轮子侧向没有滑动，即系统所受的非完整性约束方程为： （2-4）定义速度向量为： （2-5）其中，、为机器人质心的瞬时线速度和角速度； 是机器人左右轮速度向量。我们可得到机器人的运动学方程可表示为： （2-6）同时可得机器人运动轨迹的曲率半径为： （2-7）当时，曲率半径趋向无穷大，机器人作直线运动；当时，机器人以质心为圆心原地旋转；当不等于时，机器人围绕瞬心作圆周运动。2.2.2 动力学模型达朗伯原理与虚位移原理相结合，可导出动力学普遍方程，是分析动力学

38、的基础。动力学普遍方程可表达为统一形式6： （2-8）其中，为广义坐标向量；惯性力矩矩阵；哥氏力和离心力向量；重力向量；输入变换矩阵；控制向量；乘积因子向量；满秩约束矩阵。对于差轮驱动的移动机器人，定义广义坐标向量，则满秩约束方程可表示为： （2-9）引入乘积因子，满足运动学约束的动力学方程为： （2-10）其中，为车身重量，为轮子质量；整个机器人绕轴的转动惯量，为车身绕的转动惯量；，分别为右轮和左轮的输入力矩。综上所述，可以归纳总结出： （2-11）此模型可用于机器人的路径跟踪控制。 第3章 灵狐机器人子系统设计近地侦察系统是一种基于人的思维判断的反馈式无线控制系统，由七个子系统组成；逐球机

39、器人是一种基于视觉闭环自治的无线控制系统，由四个子系统组成，现对每个子系统逐一介绍。3.1 DSP驱动控制子系统为了保证智能系统的功能扩展、技术的更新和控制算法的研究，系统应具有一定的开放性和软、硬件结构上的可扩展性。合理的模块化设计、有效的任务划分、系统实时性和多任务要求都是机器人平台上应该解决但还没有完全解决的问题。近年来，数字信号处理器DSP以其完善的结构和优良的性能在通信领域、消费类电子、汽车电子产品等领域的应用日益占有重要地位，使用DSP技术提升智能机器人感知、控制性能，提高计算能力，降低总体成本成为一种发展趋势。3.1.1 DSP简介DSP芯片是一种具有特殊结构的微处理器，芯片内部

40、采用程序和数据分开的哈佛结构，具有专门的硬件乘法器，广泛采用流水线操作，提供特殊的DSP指令，可以快速实现各种数字信号处理算法。TMS320LF2407A是为了满足控制应用而设计的，其16位定点DSP内核为模拟系统的设计者提供了一个不牺牲系统精度和性能的数字解决方案。TMS320C24X系列是美国TI公司为电机控制设计的专用芯片，在其基础上升级了TMS320LF240x。除了具有一般DSP的改进的哈佛结构、多总线结构和流水线结构等优点外，它还具有以下优点10： 采用高性能的CMOS工艺，使得供电电压降为3.3V,减小了控制器的功耗；最大可达40MIPS的执行速度缩短了指令周期，从而提高了控制器

41、的实时控制能力； 片内高达32K字的FLASH程序存储器，高达1.5K字的数据程序RAM，544字双端口RAM（DRRAM）和2K字的单口RAM（SARAM）； 两个事件管理器模块EVA和EVB，每个包括：两个16位通用定时器；8个16位的脉宽调制（PWM）通道。它们能够实现：三相反相控制；PWM对称和非对称波形；当外部引脚出现低电平时快速关闭PWM通道；可编程的PWM死区控制以防止上下桥臂同时输出触发脉冲；3个捕获单元；片内光电编码器接口电路；16通道A/D转换器； 片内外设有看门狗定时器和实时中断定时器；可通过事件管理器触发1个16通道或2个8通道A/D转换器来处理反馈速度、位置、电压、电流等模拟信号；同时还有SPI、SCI以及多达40个的GPIO。3.1.2 PWM的实现方法应用DSP 产生PWM 的原理图如图31所示。具体实现如下： 通过设置TxCON 寄存器来确定采用连续增/减计数模式。计数器按设定的时间单位连续向上计数，当计数到设定的峰值时，计数器立即向下计数则生成三角载波。在计数器计数过程中，如果设定的比较寄存器的值与计数器的值相等时PWM 脉冲输出端口自动输出高电平或低电平。 通过设置比较方式控制寄存器ACTRA