[发明专利]一种基于多传感器的移动小车避障和定位系统及方法

说明书

技术领域

本发明涉及无线传感器定位技术，涉及一种适用于多传感器的移动小车避障和定位系统及方法。

背景技术

在工业现场的设备中，常常使用移动小车来完成物资在不同设备间的转移，需要移动小车能够精准地移动到各台设备前，定位的误差将会对设备或移动小车产生较大的影响。因此，需要设计一种室内的高精度的移动小车定位系统以提高移动小车运行的准确性，并且需要使用一些辅助的传感器来实现移动小车的避障功能。

目前，典型的室内无线定位系统有如下的几种：

1)基于红外的室内定位系统。它采用了红外线技术实现室内定位，每个待定位的物体使用红外发射机定期发送自身唯一的ID识别码。同时，在室内固定放置红外接收机用于提取红外信号携带的数据。专利号为201510658330.4，题为“基于GNSS的红外定位装置”的专利采用了这种技术。采用这种技术存在的明显缺点是红外信号的直线视距和传输距离较短，以致于一些红外信号不能够被红外接收机接收到。

2)基于超声波的室内定位系统。待定位的移动小车定期发送超声波信号，室内固定位置超声波接收模块通过接收到超声波的信号强度得到与移动小车的距离信息，采用三角法定位出移动小车的位置坐标。专利号为201410565470.2，题为“一种室内超声波定位系统及其定位方法”的专利采用了这种技术。但是超声波信号对于接收面的平整性要求高，且对超声波节点的质量和布置依赖高，应用起来成本高。

3)基于RFID的室内定位系统。安装在移动小车上的RFID标签发送射频信号，同时布置在室内的RFID阅读器接收射频信号，采用接收信号强度指示来标识接收到射频信号的强度，根据无线电传输路径损耗模型来得到RFID阅读器与移动小车的直线距离。从而可以通过定位算法计算得到移动小车的位置坐标。专利号为200910173577.1，题为“RFID定位方法及其系统”的专利采用了这种技术。采用这种技术的缺点在于定位精度严重依赖于无线电传输路径损耗模型的精确程度。在实际中，由于环境的差异和各个节点的差异，单一的路径损耗模型并不适用所有的场景。

4)还有一些利用Wi-Fi网络、ZigBee网络的定位系统，其原理和缺点与基于RFID的定位系统相同，没有考虑在不同的环境中对路径损耗模型进行相应的修正，而是专注于如何通过滤波算法提高定位的准确性。

因此，在本领域需要设计一种对实际环境中无线电传输路径损耗模型的差异进行修正的定位系统，并且能够通过采用一些辅助传感器实现移动小车的避障功能。

发明内容

为了克服现有的移动小车定位方法中没有对无线电传输路径损耗模型的差异进行修正、定位精确性较差、小车自主运行能力较差的缺点，本发明提供一种适用于多传感器的移动小车避障和定位系统，采用基于ZigBee网络的定位方法，并对实际环境中每个节点的损耗模型进行相应的修正，提高了定位的精确性，并且通过在移动小车上使用超声波传感器和红外传感器实现移动小车的避障功能，提高移动小车的自主运动能力。

本发明的目的是通过以下技术方案实现的：

一种适用于多传感器的移动小车避障和定位系统，包括一辆移动小车，移动小车包括移动小车本体、一个超声波模块、两个红外模块和一个ZigBee模块，所述的移动小车本体用于小车的运动控制，所述的超声波模块用于避开小车前方的障碍物，所述的红外模块用于避开小车左右两侧的障碍物，所述的ZigBee模块用于接收和发送ZigBee信号。

所述移动小车避障和定位系统还包括四个定位节点和一个协调节点，且每个定位节点位于定位系统中的位置各不相同，每个定位节点包括一个ZigBee模块、一个稳压模块和一块电池，所述的ZigBee模块用于接收和发送ZigBee信号，所述的稳压模块用于将电池的电压降压到ZigBee模块适用的电压，所述的电池用于提供ZigBee模块工作所需的电源；

所述协调节点包括一个ZigBee模块，所述的协调节点用于计算移动小车的位置坐标，协调节点通过有线串口与计算机相连，计算机通过上位机软件实时显示小车的位置坐标。

一种基于多传感器的移动小车避障和定位方法，它包括以下几个步骤：

步骤1)定义每个ZigBee节点的设备ID；

步骤2)将移动小车、定位节点和协调节点上的ZigBee进行组网；

步骤3)组网成功后，四个定位节点分别从距离移动小车设定距离处多次发送ZigBee信号给移动小车，移动小车通过测得信号的强度值计算出各个分段的路径损耗指数，随后每个定位节点将采用修正后的路径损耗指数；