救援机器人导航定位控制系统设计与研究

摘要

救援机器人在灾难发生时能有效的提高救援工作效率,减少救援时二次伤亡发生的概率,在救援现场起着越来越重要的作用,将其作为研究对象具有较高的理论与实践意义。课题对机器人的导航定位和路径规划算法进行了相关研究,同时对系统进行了详细设计。论文研究的主要内容分为三个部分:
　　1.以TI公司TMS320F2812为核心,配以外部INS(InertialNavigationSystem)采集电路,给出了机器人导航控制系统设计方案,对主要功能模块进行了详细设计。由于TI系列DSP芯片所提供的标准异步串行通信UART口非常有限,课题设计采用了TL16C550与MAX490进行RS-422异步串行通信,实现DSP与无线收发模块之间的数据交换,同时丰富系统的外部通信接口。
　　2.基于四元数法建立了捷联惯性导航系统的数学模型,组合导航采用惯性导航与GPS非耦合的组合模式。利用Matlab平台对组合导航系统进行仿真验证。通过仿真结果和原始轨迹比较验证了导航算法的可行性。采用迷宫算法对路径规划算法进行仿真,在介绍常用迷宫算法的基础上提出一种优化的向心深度优先搜索算法。仿真结果表明,该算法不仅提高了搜寻效率,而且具有占用内存空间少,对处理器的速度要求低等特点。
　　3.对救援机器人导航及路径规划算法进行半实物实验。实验分为静态和动态两部分,分别对其结果进行详细分析。动态实验误差率控制在4％以内,根据实验经验,误差率满足设计要求。由此得出,本课题所研究的系统设计方案与相关算法具有一定的可行性。

目录

封面

声明

中文摘要

英文摘要

目录

1 绪论

1.1 论文研究的背景与意义

1.2 国内外研究现状及水平

1.3 本文内容安排

2 机器人导航定位控制系统硬件设计

2.1 硬件系统总体框架

2.2 惯性导航模块

2.3 GPS接收模块

2.4 路径检测模块

2.5 DSP处理器模块和外围电路

2.6 基于PTR2000无线通信模块

2.7 DSP异步串行通信设计

2.8系统PCB设计

2.9小结

3 导航系统设计理论基础

3.1 导航常用计算参数

3.2 三维捷联导航系统的基本分析

3.3 捷联系统工作原理及优点

3.4系统更新周期

3.5小结

4 惯性导航算法及组合模式研究

4.1算法设计-姿态算法

4.2 姿态更新的其他算法及各种算法的比较

4.3导航系统模型建立

4.4 微分方程的求解

4.5 SINS/GPS 组合导航系统组合方式

4.6 小结

5 机器人路径规划算法设计

5.1常用迷宫算法介绍

5.2优化的向心深度优先搜寻法

5.3小结

6 系统仿真及半实物实验

6.1 导航定位系统仿真

6.2系统主要模块软件设计

6.3系统调试

6.4半实物系统实验

6.5小结

7 总结与展望

致谢

参考文献

附录A 硕士研究生学习阶段发表论文

附录B 系统硬件原理设计图

附录C 系统硬件PCB设计图

附录D 导航定位控制系统实物图