[实用新型]超声波避障惯性导航系统

说明书

技术领域

本实用新型涉及导航技术领域，尤其涉及超声波避障惯性导航系统。

背景技术

导航是一个技术门类的总称，它是引导飞机、船舶、车辆等载体安全、准确地沿着选定的路线到达目的地的一种手段。惯性导航系统是利用惯性敏感器件、基准方向和初始的位置信息来确定载体的位置、速度和姿态的自主式导航系统。惯性导航系统完全依靠载体自身的设备进行导航，不依赖任何外部信息，也不向外部辐射能量，因此，它具有隐蔽性、全天候等优点，被广泛应用于航天、航空、航海和许多民用领域，成为目前各种移动载体上应用的主要导航设备。但对于很多需要在未知或时变环境下自动移动的智能载体，在跟随导航自动移动时不可避免会遇到一些障碍物，如何在灵活、实时的避开这些障碍物的基础上进行导航成为当前需要解决的问题。

实用新型内容

本实用新型的目的在于提供一种超声波避障惯性导航系统，构建一个集避障导航和惯性导航为一体的综合导航系统，实现智能载体在未知或时变环境下的避障与导航定位。

为解决上述技术问题，本实用新型采用以下技术方案：

超声波避障惯性导航系统，包括惯性导航系统和超声波避障系统，

所述超声波避障系统与惯性导航系统电连接，用于探测载体的障碍物信息，具体包括多路超声波换能器、选择开关、发射驱动放大电路、接收驱动放大电路、音频解码电路和从CPU，每一路超声波换能器均包括一个超声波发射器和一个超声波接收器；所述从CPU用于发出超声波发射指令和超声波换能器选择指令，并获取超声波换能器采集的检测数据，计算障碍物与载体之间的距离；所述超声波发射器与选择开关电连接，用于向外界辐射超声波；所述超声波接收器与选择开关电连接，用于接收从障碍物反射回来的超声波；所述选择开关与从CPU电连接，用于根据从CPU发送的指令选取某一路超声波换能器进行数据采集或控制；所述发射驱动放大电路与选择开关、从CPU均电连接，用于将从 CPU发出的超声波发射指令信号功率放大后驱动超声波发射器动作；所述接收驱动放大电路与选择开关、音频解码电路均电连接，用于将超声波接收器采集的检测数据进行放大滤波后发送至音频解码电路；所述音频解码电路与从CPU电连接，用于将放大后的超声波数据数字化后发送至从CPU；

所述惯性导航系统用于获取载体的导航参数，具体包括主CPU、加速度计、陀螺仪、信号调理电路和A/D转换电路；所述加速度计与信号调理电路电连接，用于获取载体相对于惯性空间的线运动的加速度；所述陀螺仪与信号调理电路电连接，用于获取载体相对于惯性空间的角运动的角速率；所述信号调理电路与A/D转换电路电连接，用于将加速度计、陀螺仪获取的载体的运动参数信号调理成A/D转换电路能够识别的信号；所述A/D转换电路与主CPU电连接，用于将信号调理电路输出的模拟量的运动参数信号转换为数字量发送至主CPU；所述主CPU与从CPU通讯，进行数据交换，获取障碍物与载体之间距离，结合载体的加速度和角速率，计算导航参数，引导载体完成预定的航行任务。

特别地，所述多路超声波换能器包括四路超声波换能器，分别设置于载体的前、后、左、右四个方向上，分别对载体的前、后、左、右四个方向上的障碍物信息进行探测。

特别地，所述每一路超声波换能器均靠近载体中心设置，每一路超声波换能器距离载体任一侧面的距离均大于等于该路超声波换能器的测距盲区。

特别地，所述惯性导航包括三个加速度传感器，所述加速度传感器采用 ADXL202E加速度传感器。

特别地，所述惯性导航包括三个陀螺仪，所述陀螺仪采用ADXRS612角速率传感器。

特别地，所述超声波避障惯性导航系统还包括GPS模块，所述GPS模块与主CPU通讯连接，用于获取GPS信号发送至主CPU。

特别地，所述主CPU和从CPU均采用MSP430F135单片机。

特别地，所述超声波避障系统还包括温度补偿电路，所述温度补偿电路与从CPU电连接，用于引入温度补偿，消除温度对超声波避障系统精度产生的影响。

本实用新型提出了一种超声波避障惯性导航系统，构建了一个集避障导航和惯性导航为一体的综合导航系统，实现了智能载体在未知或时变环境下的避障与导航定位。

附图说明

此处所说明的附图用来提供对本实用新型实施例的进一步理解，构成本申请的一部分，并不构成对本实用新型实施例的限定。在附图中：

图1为本实用新型实施例1提供的超声波避障惯性导航系统结构框图。