CN107037405A - 室内超声波三维定位系统及方法 - Google Patents

Abstract

本发明涉及一种室内超声波三维定位系统及方法，该系统包括信标端和目标节点，信标端包括原点信标和节点信标组，节点信标组包括两个节点信标，原点信标及两个节点信标布置于同一平面；原点信标用于向目标节点发送定位超声波，按预定的时间间隔向目标节点及两个节点信标发送红外光同步信号；两个节点信标用于接收原点信标发送的红外光同步信号，并向目标节点发送定位超声波；目标节点用于接收原点目标发送的定位超声波、红外光同步信号、以及两个节点信标发送的定位超声波，并计算出原点信标以及两个节点信标与目标节点的距离，计算出所述目标节点的三维坐标。本发明具有成本低、安装使用方便、抗电磁干扰能力强、不受外界环境因素影响和时间信息直观等优点。

Description

室内超声波三维定位系统及方法

技术领域

本发明涉及导航定位技术领域，尤其涉及一种室内超声波三维定位系统及方法。

背景技术

室内定位是指在室内环境中实现对室内人员、物体进行位置定位，目前的室内定位技术主要是采用红外线技术、ZigBee技术、无线蓝牙技术、射频识别技术、超宽带技术和光跟踪技术。

然而，采用目前的定位方法对室内人员、物体进行定位不仅容易受到室内复杂环境的影响，定位稳定性差，而且总体成本高。

由此，有必要提出一种受外界环境影响小，定位准确性高的解决方案。

发明内容

本发明的主要目的在于提供一种成本低、安装使用方便、抗电磁干扰能力强、不受外界环境因素影响和时间信息直观的室内超声波三维定位系统及方法，旨在克服现有室内定位技术中信息误差大、时间反应慢的缺点。

为实现上述目的，本发明是这样实现的，本发明提供一种室内超声波三维定位系统，包括信标端和目标节点，所述信标端包括原点信标和节点信标组，所述节点信标组包括两个节点信标，所述原点信标及所述两个节点信标布置于同一平面；

所述原点信标用于向所述目标节点发送定位超声波，按预定的时间间隔向所述目标节点及两个节点信标发送红外光同步信号；

所述两个节点信标用于接收所述原点信标发送的红外光同步信号，并向所述目标节点发送定位超声波；

所述目标节点用于接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

本发明的进一步的技术方案是，所述原点信标与所述两个节点信标呈等腰直角三角形布置于同一平面。

本发明的进一步的技术方案是，所述原点信标包括第一控制器、第一超声波发生传感器、第一超声波发射电路以及红外光同步信号发生器，所述第一超声波发射电路及红外光同步信号发生器分别与所述第一控制器连接，所述第一超声波发射电路与所述第一超声波发生传感器连接；其中，所述第一控制器用于控制所述第一超声波发生传感器、第一超声波发射电路向所述节点信标及目标节点发送定位超声波，控制所述红外光同步信号发生器按预定的时间间隔向所述目标节点及两个节点信标发送红外光同步信号；

所述节点信标组中的每一个节点信标包括第二控制器、第二超声波发生传感器、第二超声波发射电路以及第一红外光同步信号接收器，所述第二超声波发射电路及红外光同步信号接收器分别与所述第二控制器连接，所述第二超声波发射电路与所述第二超声波发生传感器连接；其中，所述第二控制器用于根据所述第一红外光同步信号接收器接收到的红外光同步信号控制所述第二超声波发生传感器、第二超声波发射电路向所述目标节点发送定位超声波；

所述目标节点包括第三控制器、两个超声波接收器、对应于所述两个超声波接收器的两个超声波检测电路以及第二红外光同步信号接收器，所述两个超声波接收器间隔设置；

所述两个超声波检测电路、第二红外光同步信号接收器分别与所述第三控制器连接，所述两个超声波接收器分别与所述两个超声波检测电路中对应的超声波检测电路连接；其中，所述第三控制器用于在所述第二红外光同步信号接收器接收到红外光同步信号后计算出定位超声波到达所述目标节点的时间，根据定位超声波到达所述目标节点的时间计算出所述原点信标以及两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

本发明的进一步的技术方案是，所述目标节点还包括与外界应用主机连接的通信模块，所述通信模块与所述第三控制器连接，所述通信模块用于将所述三维坐标发送至所述外界应用主机。

基于上述室内超声波定位系统，本发明还提出一种室内超声波三维定位方法，所述方法应用于室内超声波三维定位系统，所述室内超声波三维定位系统包括信标端和目标节点，所述信标端包括原点信标和节点信标组，所述节点信标组包括两个节点信标，所述原点信标及所述两个节点信标布置于同一平面；所述方法包括以下步骤：

所述原点信标向所述目标节点及两个节点信标发送红外光同步信号，向所述目标节点发送定位超声波；

所述节点信标接收所述原点信标发送的红外光同步信号，并向所述目标节点发送定位超声波；

所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

本发明的进一步的技术方案是，所述原点信标与所述两个节点呈等腰直角三角形布置于同一平面。

本发明的进一步的技术方案是，所述原点信标包括第一控制器、第一超声波发生传感器、第一超声波发射电路以及红外光同步信号发生器，所述第一超声波发射电路及红外光同步信号发生器分别与所述第一控制器连接，所述第一超声波发射电路与所述第一超声波发生传感器连接；

所述原点信标向所述目标节点及两个节点信标发送红外光同步信号，向所述目标节点发送定位超声波的步骤包括：所述第一控制器控制所述第一超声波发生传感器、第一超声波发射电路向所述节点信标及目标节点发送定位超声波及红外光同步信号；

所述节点信标组中的每一个节点信标包括第二控制器、第二超声波发生传感器、第二超声波发射电路以及第一红外光同步信号接收器，所述第二超声波发射电路及红外光同步信号接收器分别与所述第二控制器连接，所述第二超声波发射电路与所述第二超声波发生传感器连接；

所述节点信标接收所述原点信标发送的红外光同步信号，并向所述目标节点发送定位超声波的步骤包括：所述第二控制器根据所述第一红外光同步信号接收器接收到的红外光同步信号控制所述第二超声波发生传感器、第二超声波发射电路向所述目标节点发送定位超声波；

所述目标节点包括第三控制器、两个超声波接收器、对应于所述两个超声波接收器的两个超声波检测电路以及第二红外光同步信号接收器，所述两个超声波接收器间隔设置；

所述两个超声波检测电路、第二红外光同步信号接收器分别与所述第三控制器连接，所述两个超声波接收器分别与所述两个超声波检测电路中对应的超声波检测电路连接；

所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标的步骤包括：所述第三控制器在所述第二红外光同步信号接收器接收到红外光同步信号后计算出定位超声波到达所述目标节点的时间，根据定位超声波到达所述目标节点的时间计算出所述原点信标以及两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

本发明的进一步的技术方案是，所述目标节点还包括与外界应用主机连接的通信模块，所述通信模块与所述第三控制器连接；

所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标的步骤之后包括：所述通信模块用于将所述三维坐标发送至所述外界应用主机。

本发明的有益效果是：本发明提出的室内超声波三维定位系统及方法通过原点信标向目标节点发送定位超声波，按预定的时间间隔向目标节点及两个节点信标发送红外光同步信号，两个节点信标接收到同步信号后，向目标节点发送定位超声波，目标节点接收到原点信标及两个节点信标发送的定位超声波后，计算出原点信标以及两个节点信标与目标节点的距离，根据距离计算出目标节点的三维坐标，克服了现有室内定位技术中信息误差大、时间反应慢的缺点，另外，使用超声波定位技术，具有成本低、安装使用方便、抗电磁干扰能力强、不受外界环境因素影响和时间信息直观等优点。

附图说明

图1是本发明提出的室内超声波三维定位系统较佳实施例的结构示意图；

图2是本发明提出的室内超声波三维定位系统较佳实施例采用三边定位算法三维定位的原理示意图；

图3是本发明提出的室内超声波三维定位系统较佳实施例原点信标的功能模块示意图；

图4是本发明提出的室内超声波三维定位系统较佳实施例节点信标的功能模块示意图；

图5是本发明提出的室内超声波三维定位系统较佳实施例目标节点的功能模块示意图；

图6是本发明提出的室内超声波三维定位方法的流程示意图。

附图标号：

目标节点-10；

第三控制器-101；

超声波接收器-102；

超声波检测电路-103；

第二红外光同步信号接收器-104；

通信模块-105；

原点信标-20；

第一控制器-201；

第一超声波发生传感器-202；

第一超声波发射电路-203；

红外光同步信号发生器-204；

节点信标-30；

第二控制器-301；

第二超声波发生传感器-302；

第二超声波发射电路-303；

第一红外光同步信号接收器-304。

为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。

具体实施方式

应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。

本发明的主要解决方案是：本发明通过原点信标向目标节点发送定位超声波，按预定的时间间隔向目标节点及两个节点信标发送红外光同步信号，两个节点信标接收到同步信号后，向目标节点发送定位超声波，目标节点接收到原点信标及两个节点信标发送的定位超声波后，计算出原点信标以及两个节点信标与目标节点的距离，根据距离计算出目标节点的三维坐标，克服了现有室内定位技术中信息误差大、时间反应慢的缺点，另外，使用超声波定位技术，具有成本低、安装使用方便、抗电磁干扰能力强、不受外界环境因素影响和时间信息直观等优点。

目前的室内定位方法对室内人员、物体进行定位不仅容易受到室内复杂环境的影响，定位稳定性差，而且总体成本高。

由此，本发明提出一种受外界环境影响小，定位准确性高的室内超声波三维定位系统及方法。

具体地，请参照图1至图5，本发明较佳实施例提出一种室内超声波三维定位系统。

本发明较佳实施例提出的室内超声波三维定位系统，包括信标端和目标节点10，其中，所述信标端包括原点信标20和节点信标组，所述节点信标组包括两个节点信标30，所述原点信标20及所述两个节点信标30布置于同一平面。

为了便于计算所述原点信标20、两个节点信标30相互之间的距离，本实施例将所述原点信标20及两个节点信标30布置为倒立的等腰直角三角形。

所述原点信标20用于向所述目标节点10发送定位超声波，按预定的时间间隔向所述目标节点10及两个节点信标30发送红外光同步信号；

所述两个节点信标30用于接收所述原点信标20发送的红外光同步信号，并向所述目标节点10发送定位超声波；

所述目标节点10用于接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标30发送的定位超声波，并计算出所述原点信标20以及所述两个节点信标30与所述目标节点10的距离，根据所述距离计算出所述目标节点10的三维坐标。

需要说明的是，为了区分所述原点信标20和两个节点信标30，便于所述目标节点10区分并计算所述原点信标20以及所述两个节点信标30与所述目标节点10的距离，可以预先对所述原点信标20及两个节点信标30进行32Bits地址编码和8Bits控制编码。

比如，所述原点信标20首先发送红外光同步信号和定位超声波信号至所述目标节点10，所述目标节点10接收到红外光同步信号后，开始计时，计算定位超声波到达所述目标节点10的时间，并根据定位超声波到达所述目标节点10的时间T₁和超声波的波速C计算出所述原点信标20与所述目标节点10的距离l,计算公式为：l＝C*T₁(C为超声波在室温下的传播速度)；然后，在间隔50ms后，发送红外光同步信号至所述两个节点信标30中的第一节点信标30，所述第一节点信标30接收到红外光同步信号后，发送定位超声波至所述目标节点10，此时，所述目标节点10接收到所述第一节点信标30发送的定位超声波的时间为T₂，其中，T₂＝T₁-50ms，由此根据定位超声波到达所述目标节点10的时间T₂和超声波的波速C计算出所述原点信标20与所述目标节点10的距离m；最后，再次间隔50ms后，发送红外光同步信号至所述两个节点信标30中的第二节点信标30，所述第二节点信标30接收到红外光同步信号后，发送定位超声波至所述目标节点10，此时，所述目标节点10接收到所述第二节点信标30发送的定位超声波的时间为T₃，其中，T₃＝T₁-100ms，由此根据定位超声波到达所述目标节点10的时间T₃和超声波的波速C计算出所述原点信标20与所述目标节点10的距离n。

可以理解的是，由于对所述原点信标20、第一节点信标30以及第二个进行了32Bits地址编码和8Bits控制编码，因此，所述目标节点10能准确区分所述原点信标20、第一节点信标30和第二节点信标30。

如图2所示，所述目标节点10计算出所述原点信标20、第一节点信标30、第二节点信标30与所述目标节点10的距离l、m、n后，根据三边定位算法计算出所述目标节点10的三维坐标M(X，Y，Z)，其中，图2中的点1对应原点信标20，点2对应第一节点信标30，点3对应第二节点信标30。所述三边定位算法如下：

值得提出的是，由于光的速度远大于超声波的波速，所以在室内环境下，可以用红外光作为同步信号，由此克服现有室内定位技术中信息误差大、时间反应慢的确定，从而提高定位的准确性。

由此，本实施例提出的室内超声波三维定位系统通过原点信标20向目标节点10发送定位超声波，按预定的时间间隔向目标节点10及两个节点信标30发送红外光同步信号，两个节点信标30接收到同步信号后，向目标节点10发送定位超声波，目标节点10接收到原点信标20及两个节点信标30发送的定位超声波后，计算出原点信标20以及两个节点信标30与目标节点10的距离，根据距离计算出目标节点10的三维坐标，克服了现有室内定位技术中信息误差大、时间反应慢的缺点，另外，使用超声波定位技术，具有成本低、安装使用方便、抗电磁干扰能力强、不受外界环境因素影响和时间信息直观等优点。

进一步的，所述原点信标20包括第一控制器201、第一超声波发生传感器202、第一超声波发射电路203以及红外光同步信号发生器204，所述第一超声波发射电路203及红外光同步信号发生器204分别与所述第一控制器201连接，所述第一超声波发射电路203与所述第一超声波发生传感器202连接；其中，所述第一控制器201用于控制所述第一超声波发生传感器202、第一超声波发射电路203向所述节点信标30及目标节点10发送定位超声波，控制所述红外光同步信号发生器204按预定的时间间隔向所述目标节点10及两个节点信标30发送红外光同步信号；

所述节点信标30组中的每一个节点信标30包括第二控制器301、第二超声波发生传感器302、第二超声波发射电路303以及第一红外光同步信号接收器304，所述第二超声波发射电路303及红外光同步信号接收器分别与所述第二控制器301连接，所述第二超声波发射电路303与所述第二超声波发生传感器302连接；其中，所述第二控制器301用于根据所述第一红外光同步信号接收器304接收到的红外光同步信号控制所述第二超声波发生传感器302、第二超声波发射电路303向所述目标节点10发送定位超声波；

所述目标节点10包括第三控制器101、两个超声波接收器102、对应于所述两个超声波接收器102的两个超声波检测电路103以及第二红外光同步信号接收器104，所述两个超声波接收器102间隔设置；

所述两个超声波检测电路103、第二红外光同步信号接收器104分别与所述第三控制器101连接，所述两个超声波接收器102分别与所述两个超声波检测电路103中对应的超声波检测电路103连接；其中，所述第三控制器101用于在所述第二红外光同步信号接收器104接收到红外光同步信号后计算出定位超声波到达所述目标节点10的时间，根据定位超声波到达所述目标节点10的时间计算出所述原点信标20以及两个节点信标30与所述目标节点10的距离，根据所述距离计算出所述目标节点10的三维坐标。

需要强调的是，当所述目标节点10为两个目标节点10时，因为超声波的传输需要一定的时间，虽然两个目标节点10的实际位置不一样，但间隔50ms发送的超声波仍然可能会出现第一个时间点与第二个时间点同时到达所述两个目标节点10的超声波传感器，而不能区分所述目标节点10。本实施例中每个目标节点10实用两个超声波接收器，由于两个超声波接收器的位置有所区别，所以能区分开此特殊情况。具体实施时，为了进一步区分不同的目标节点10，也可以对不同的目标节点10进行32Bits地址编码。

另外，所述目标节点10还包括与外界应用主机连接的通信模块105，其中，所述通信模块105可以选用蓝牙通讯模块，所述通信模块105与所述第三控制器101连接，所述通信模块105用于将所述目标节点10的三维坐标或地址编码发送至所述外界应用主机，也可以将所述目标节点10的三维坐标和地址编码一起发送至外界应用主机，所述外界应用主机根据地址编码来区别不同的目标节点10。

综上所述，本发明提出的室内超声波三维定位系统通过原点信标向目标节点发送定位超声波，按预定的时间间隔向目标节点及两个节点信标发送红外光同步信号，两个节点信标接收到同步信号后，向目标节点发送定位超声波，目标节点接收到原点信标及两个节点信标发送的定位超声波后，计算出原点信标以及两个节点信标与目标节点的距离，根据距离计算出目标节点的三维坐标，克服了现有室内定位技术中信息误差大、时间反应慢的缺点，另外，使用超声波定位技术，具有成本低、安装使用方便、抗电磁干扰能力强、不受外界环境因素影响和时间信息直观等优点。

基于上述室内超声波三维定位系统，本发明还提出一种室内超声波三维定位方法。

具体地，请参照图6，本发明较佳实施例提出一种室内超声波三维定位方法，所述方法应用于室内超声波三维定位系统，所述室内超声波三维定位系统包括信标端和目标节点，其中，所述信标端包括原点信标和节点信标组，所述节点信标组包括两个节点信标，所述原点信标及所述两个节点信标布置于同一平面。

为了便于计算所述原点信标、两个节点信标之间的距离，本实施例将所述原点信标及两个节点信标布置为倒立的等腰直角三角形。

所述方法包括以下步骤：

步骤S10，原点信标向所述目标节点及两个节点信标发送红外光同步信号，向所述目标节点发送定位超声波；

步骤S20，所述两个节点信标接收所述原点信标发送的红外光同步信号，并向所述目标节点发送定位超声波；

步骤S30，所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

需要说明的是，为了区分所述原点信标和两个节点信标，便于所述目标节点区分并计算所述原点信标以及所述两个节点信标与所述目标节点的距离，可以预先对所述原点信标及两个节点信标进行32Bits地址编码和8Bits控制编码。

比如，所述原点信标首先发送红外光同步信号和定位超声波信号至所述目标节点，所述目标节点接收到红外光同步信号后，开始计时，计算定位超声波到达所述目标节点的时间，并根据定位超声波到达所述目标节点的时间T₁和超声波的波速C计算出所述原点信标与所述目标节点的距离l,计算公式为：l＝C*T₁(C为超声波在室温下的传播速度)；然后，在间隔50ms后，发送红外光同步信号至所述两个节点信标中的第一节点信标，所述第一节点信标接收到红外光同步信号后，发送定位超声波至所述目标节点，此时，所述目标节点接收到所述第一节点信标发送的定位超声波的时间为T₂，其中，T₂＝T₁-50ms，由此根据定位超声波到达所述目标节点的时间T₂和超声波的波速C计算出所述原点信标与所述目标节点的距离m；最后，再次间隔50ms后，发送红外光同步信号至所述两个节点信标中的第二节点信标，所述第二节点信标接收到红外光同步信号后，发送定位超声波至所述目标节点，此时，所述目标节点接收到所述第二节点信标发送的定位超声波的时间为T₃，其中，T₃＝T₁-100ms，由此根据定位超声波到达所述目标节点的时间T₃和超声波的波速C计算出所述原点信标与所述目标节点的距离n。

可以理解的是，由于对所述原点信标、第一节点信标以及第二个进行了32Bits地址编码和8Bits控制编码，因此，所述目标节点能准确区分所述原点信标、第一节点信标和第二节点信标。

所述目标节点计算出所述原点信标、第一节点信标、第二节点信标与所述目标节点的距离l、m、n后，根据三边定位算法计算出所述目标节点的三维坐标M(X，Y，Z)。其中，三边定位算法如下：

值得提出的是，由于光的速度远大于超声波的波速，所以在室内环境下，可以用红外光作为同步信号，由此克服现有室内定位技术中信息误差大、时间反应慢的确定，从而提高定位的准确性。

由此，本实施例提出的室内超声波三维定位系统通过原点信标向目标节点发送定位超声波，按预定的时间间隔向目标节点及两个节点信标发送红外光同步信号，两个节点信标接收到同步信号后，向目标节点发送定位超声波，目标节点接收到原点信标及两个节点信标发送的定位超声波后，计算出原点信标以及两个节点信标与目标节点的距离，根据距离计算出目标节点的三维坐标，克服了现有室内定位技术中信息误差大、时间反应慢的缺点，另外，使用超声波定位技术，具有成本低、安装使用方便、抗电磁干扰能力强、不受外界环境因素影响和时间信息直观等优点。

进一步的，所述原点信标包括第一控制器、第一超声波发生传感器、第一超声波发射电路以及红外光同步信号发生器，所述第一超声波发射电路及红外光同步信号发生器分别与所述第一控制器连接，所述第一超声波发射电路与所述第一超声波发生传感器连接。

步骤S10，所述原点信标向所述目标节点及两个节点信标发送红外光同步信号，向所述目标节点发送定位超声波的步骤包括：

步骤S101，所述第一控制器控制所述第一超声波发生传感器、第一超声波发射电路向所述节点信标及目标节点发送定位超声波及红外光同步信号。

所述节点信标组中的每一个节点信标包括第二控制器、第二超声波发生传感器、第二超声波发射电路以及第一红外光同步信号接收器，所述第二超声波发射电路及红外光同步信号接收器分别与所述第二控制器连接，所述第二超声波发射电路与所述第二超声波发生传感器连接。

所述步骤S20，所述节点信标接收所述原点信标发送的红外光同步信号，并向所述目标节点发送定位超声波的步骤包括：

步骤S201，所述第二控制器根据所述第一红外光同步信号接收器接收到的红外光同步信号控制所述第二超声波发生传感器、第二超声波发射电路向所述目标节点发送定位超声波。

所述目标节点包括第三控制器、两个超声波接收器、对应于所述两个超声波接收器的两个超声波检测电路以及第二红外光同步信号接收器，所述两个超声波接收器间隔设置。

所述两个超声波检测电路、第二红外光同步信号接收器分别与所述第三控制器连接，所述两个超声波接收器分别与所述两个超声波检测电路中对应的超声波检测电路连接。

所述步骤S30，所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标的步骤包括：

步骤S101，所述第三控制器在所述第二红外光同步信号接收器接收到红外光同步信号后计算出定位超声波到达所述目标节点的时间，根据定位超声波到达所述目标节点的时间计算出所述原点信标以及两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

需要强调的是，当所述目标节点为两个目标节点时，因为超声波的传输需要一定的时间，虽然两个目标节点的实际位置不一样，但间隔50ms发送的超声波仍然可能会出现第一个时间点与第二个时间点同时到达所述两个目标节点的超声波传感器，而不能区分所述目标节点。本实施例中每个目标节点实用两个超声波接收器，由于两个超声波接收器的位置有所区别，所以能区分开此特殊情况。具体实施时，为了进一步区分不同的目标节点，也可以对不同的目标节点进行32Bits地址编码。

另外，所述目标节点还包括与外界应用主机连接的通信模块，其中，所述通信模块可以选用蓝牙通讯模块，所述通信模块与所述第三控制器连接，所述通信模块用于将所述目标节点的三维坐标或地址编码发送至所述外界应用主机，也可以将所述目标节点的三维坐标和地址编码一起发送至外界应用主机，所述外界应用主机根据地址编码来区别不同的目标节点。

所述步骤S30，所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标的步骤之后包括：

步骤3101，所述通信模块用于将所述目标节点的三维坐标和地址编码发送至所述外界应用主机，或将所述目标节点的三维坐标和地址编码一起发送至所述外界应用主机。

综上所述，本发明提出的室内超声波三维定位方法通过原点信标向目标节点发送定位超声波，按预定的时间间隔向目标节点及两个节点信标发送红外光同步信号，两个节点信标接收到同步信号后，向目标节点发送定位超声波，目标节点接收到原点信标及两个节点信标发送的定位超声波后，计算出原点信标以及两个节点信标与目标节点的距离，根据距离计算出目标节点的三维坐标，克服了现有室内定位技术中信息误差大、时间反应慢的缺点，另外，使用超声波定位技术，具有成本低、安装使用方便、抗电磁干扰能力强、不受外界环境因素影响和时间信息直观等优点。

以上所述仅为本发明的优选实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或流程变换，或直接或间接运用在其它相关的技术领域，均同理包括在本发明的专利保护范围内。

Claims (8)

1.一种室内超声波三维定位系统，其特征在于，包括信标端和目标节点，所述信标端包括原点信标和节点信标组，所述节点信标组包括两个节点信标，所述原点信标及所述两个节点信标布置于同一平面；

所述原点信标用于向所述目标节点发送定位超声波，按预定的时间间隔向所述目标节点及两个节点信标发送红外光同步信号；

所述两个节点信标用于接收所述原点信标发送的红外光同步信号，并向所述目标节点发送定位超声波；

所述目标节点用于接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

2.根据权利要求1所述的室内超声波三维定位系统，其特征在于，所述原点信标与所述两个节点信标呈等腰直角三角形布置于同一平面。

3.根据权利要求2所述的室内超声波三维定位系统，其特征在于，

所述原点信标包括第一控制器、第一超声波发生传感器、第一超声波发射电路以及红外光同步信号发生器，所述第一超声波发射电路及红外光同步信号发生器分别与所述第一控制器连接，所述第一超声波发射电路与所述第一超声波发生传感器连接；其中，所述第一控制器用于控制所述第一超声波发生传感器、第一超声波发射电路向所述节点信标及目标节点发送定位超声波，控制所述红外光同步信号发生器按预定的时间间隔向所述目标节点及两个节点信标发送红外光同步信号；

所述节点信标组中的每一个节点信标包括第二控制器、第二超声波发生传感器、第二超声波发射电路以及第一红外光同步信号接收器，所述第二超声波发射电路及红外光同步信号接收器分别与所述第二控制器连接，所述第二超声波发射电路与所述第二超声波发生传感器连接；其中，所述第二控制器用于根据所述第一红外光同步信号接收器接收到的红外光同步信号控制所述第二超声波发生传感器、第二超声波发射电路向所述目标节点发送定位超声波；

所述目标节点包括第三控制器、两个超声波接收器、对应于所述两个超声波接收器的两个超声波检测电路以及第二红外光同步信号接收器，所述两个超声波接收器间隔设置；

所述两个超声波检测电路、第二红外光同步信号接收器分别与所述第三控制器连接，所述两个超声波接收器分别与所述两个超声波检测电路中对应的超声波检测电路连接；其中，所述第三控制器用于在所述第二红外光同步信号接收器接收到红外光同步信号后计算出定位超声波到达所述目标节点的时间，根据定位超声波到达所述目标节点的时间计算出所述原点信标以及两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

4.根据权利要求3所述的室内超声波三维定位系统，其特征在于，所述目标节点还包括与外界应用主机连接的通信模块，所述通信模块与所述第三控制器连接，所述通信模块用于将所述三维坐标发送至所述外界应用主机。

5.一种室内超声波三维定位方法，其特征在于，所述方法应用于如权利要求1-4任意一项所述的室内超声波三维定位系统，室内超声波三维定位系统包括信标端和目标节点，所述信标端包括原点信标和节点信标组，所述节点信标组包括两个节点信标，所述原点信标及所述两个节点信标布置于同一平面；所述方法包括以下步骤：

所述原点信标向所述目标节点及两个节点信标发送红外光同步信号，向所述目标节点发送定位超声波；

所述节点信标接收所述原点信标发送的红外光同步信号，并向所述目标节点发送定位超声波；

所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

6.根据权利要求5所述的室内超声波三维定位方法，其特征在于，所述原点信标与所述两个节点呈等腰直角三角形布置于同一平面。

7.根据权利要求6所述的室内超声波三维定位方法，其特征在于，

所述原点信标包括第一控制器、第一超声波发生传感器、第一超声波发射电路以及红外光同步信号发生器，所述第一超声波发射电路及红外光同步信号发生器分别与所述第一控制器连接，所述第一超声波发射电路与所述第一超声波发生传感器连接；

所述原点信标向所述目标节点及两个节点信标发送红外光同步信号，向所述目标节点发送定位超声波的步骤包括：所述第一控制器控制所述第一超声波发生传感器、第一超声波发射电路向所述节点信标及目标节点发送定位超声波及红外光同步信号；

所述节点信标组中的每一个节点信标包括第二控制器、第二超声波发生传感器、第二超声波发射电路以及第一红外光同步信号接收器，所述第二超声波发射电路及红外光同步信号接收器分别与所述第二控制器连接，所述第二超声波发射电路与所述第二超声波发生传感器连接；

所述节点信标接收所述原点信标发送的红外光同步信号，并向所述目标节点发送定位超声波的步骤包括：所述第二控制器根据所述第一红外光同步信号接收器接收到的红外光同步信号控制所述第二超声波发生传感器、第二超声波发射电路向所述目标节点发送定位超声波；

所述目标节点包括第三控制器、两个超声波接收器、对应于所述两个超声波接收器的两个超声波检测电路以及第二红外光同步信号接收器，所述两个超声波接收器间隔设置；

所述两个超声波检测电路、第二红外光同步信号接收器分别与所述第三控制器连接，所述两个超声波接收器分别与所述两个超声波检测电路中对应的超声波检测电路连接；

所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标的步骤包括：所述第三控制器在所述第二红外光同步信号接收器接收到红外光同步信号后计算出定位超声波到达所述目标节点的时间，根据定位超声波到达所述目标节点的时间计算出所述原点信标以及两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标。

8.根据权利要求7所述的室内超声波三维定位方法，其特征在于，所述目标节点还包括与外界应用主机连接的通信模块，所述通信模块与所述第三控制器连接；

所述目标节点接收所述原点目标发送的定位超声波、红外光同步信号、以及所述两个节点信标发送的定位超声波，并计算出所述原点信标以及所述两个节点信标与所述目标节点的距离，根据所述距离计算出所述目标节点的三维坐标的步骤之后包括：所述通信模块用于将所述三维坐标发送至所述外界应用主机。