CN109696167A - 一种uwb室内三维定位系统及方法 - Google Patents

Abstract

本发明公开了一种UWB室内三维定位系统，包括：定位终端，固定在房间同一垂直墙面上的第一基站、第二基站，至少一个固定在待定位目标上的定位标签，第一基站和定位标签分别包括了气压计模块用于测量第一气压值和第二气压值，第一基站根据第一气压值和第二气压值计算高度差；第一基站、第二基站和定位标签分别包括了UWB模块，第一基站计算第一基站和定位标签之间的第一距离，第二基站计算第二基站和定位标签之间的第二距离，定位终端根据第一距离、第二距离和高度差计算获得定位标签的位置坐标。本发明还公开了一种用于该定位系统的UWB室内三维定位方法，本发明的技术方案能够在较低成本和计算复杂度开销下实现精确的室内三维定位。

Description

一种UWB室内三维定位系统及方法

技术领域

本发明涉及到室内定位技术领域，特别涉及一种超宽带(简称，UWB)室内三维定位系统及方法。

背景技术

随着信息通信技术日新月异，人们拥有了可靠、稳定的定位技术。全球定位系统(简称，GPS)技术的出现，使得定位技术跳跃式发展，巨大改变了人们的生活习惯，使用者只需拥有GPS接收机即可使用该服务，现在民用GPS也可以达到十米左右的定位精度。但是卫星信号在室内会被严重的影响，从而导致GPS或是北斗无法发定位。为了将室外定位技术运用到室内，目前有多种解决室内定位的技术，如：超声波、红外、蓝牙、WIFI、ZigBee和UWB等室内定位方式。

其中，UWB定位技术由于其自身的特点在室内定位技术方式中拥有较高的应用前景。首先，UWB频谱范围极宽，平均发射功率低；其次，UWB信号有着极高的时间分辨率，具有良好的抗多径能力；UWB信号穿透力强，适用于障碍物较多的室内环境；UWB的脉冲宽度很窄，能够达到纳秒或者亚纳秒级，UWB定位的理论精度可以达到厘米级甚至是毫米级。

现有的UWB室内三维定位技术中，公开号为CN207946517U的专利文献，提出了一种基于视频辅助定位的UWB三维定位系统。在该文献公开的技术方案中，定位子系统包括至少四个基站，摄像头用于记录相应区域的监控视频信息并传输至中心服务器，其中，至少三个基站处在同一水平面且至少一个基站设置在该平面以外并靠近天花板区域。该方案采用视频信息辅助定位提高了定位精度，但是使用视频信息辅助定位大大增加了算法复杂度，增加了通信的开销，同时，普通住房楼层高度在3m(米)左右，处在同一水平面的三个基站与第四个基站之间的高度差不够大，因此待定位标签的位置坐标的高度误差大。

公开号为CN104902563A的专利文献，提出了一种用于室内定位的多基组网UWB三维定位系统及其定位方法。在该文献公开的技术方案中，定位系统包括标签系统、定位基站、监控终端，实时定位模块对标签获取四个定位基站的方位信息进行交叉定位处理,获得精确地位置信息并在位置坐标系中呈现出来。该专利提出的方法理论上可以解算出待定位标签的位置坐标信息，但是在实践情况下方位消息相互交叉可能相交于多个点或者没有相交点。

综上所述，现有的UWB室内三维定位技术均存在定位方案部署成本高、计算复杂度高且高度误差大的问题。

发明内容

为了解决现有技术中存在的上述问题，本发明提出了一种UWB室内三维定位系统及方法，以提供一种在较低成本和计算复杂度开销下实现精确的室内三维定位的技术方案。

为了实现上述目的，本发明采用了以下技术方案：

一种UWB室内三维定位系统，包括：

第一基站，第二基站，定位终端和至少一个定位标签；所述第一基站和所述第二基站固定在房间的同一墙面上；

所述第一基站包括，第一UWB模块，用于和所述定位标签、所述第二基站进行UWB无线通信；第一气压计模块，用于获取第一基站的当前气压值；第一通信模块，用于和所述定位终端进行通信；第一主控芯片，用于测量所述定位标签到所述第一基站的第一无线信号飞行时间，计算所述第一基站与所述定位标签的第一距离；根据所述第一基站的当前气压值获得第一气压值，根据所述第一气压值与第二气压值获得所述第一基站与所述定位标签的高度差；

所述第二基站包括，第二UWB模块，用于和所述定位标签、所述第一基站进行UWB无线通信；第二主控芯片，用于测量所述定位标签到所述第二基站的第二无线信号飞行时间，计算所述第二基站与所述定位标签的第二距离，通过所述第二UWB模块发送所述第二距离到所述第一基站；

所述定位标签固定在待定位目标上，包括：第三UWB模块，用于和所述第一基站以及所述第二基站进行UWB无线通信；第二气压计模块，用于获取定位标签的当前气压值；第三主控芯片，用于根据所述定位标签的当前气压值获取第二气压值，通过所述第三UWB模块发送所述第二气压值到所述第一基站；；

所述定位终端包括：第二通信模块，用于和所述第一基站进行通信；主机，用于计算所述定位标签的位置坐标。

进一步的，所述根据所述第一基站的当前气压值获得第一气压值包括：

所述第一主控芯片对所述第一基站的当前气压值进行限幅滑动窗口滤波，获得所述第一气压值。

进一步的，所述根据所述定位标签的当前气压值获取第二气压值包括：

所述第三主控芯片对所述定位标签的当前气压值进行限幅滑动窗口滤波，获得所述第二气压值。

进一步的，所述测量所述定位标签到所述第一基站的第一无线信号飞行时间包括，所述第一基站与所述定位标签通过双边双向测距方法，获得所述定位标签到所述第一基站的第一无线信号飞行时间；

所述测量所述定位标签到所述第二基站的第二无线信号飞行时间包括，所述第二基站与所述定位标签通过双边双向测距方法，获得所述定位标签到所述第二基站的第二无线信号飞行时间。

进一步的，所述计算所述第一基站与所述定位标签的第一距离包括，所述第一主控芯片根据所述第一无线信号飞行时间和电磁波传输速率，计算所述第一基站与所述定位标签的当前距离，所述第一主控芯片对该距离进行限幅滑动窗口滤波，获得所述第一距离。

所述计算所述第二基站与所述定位标签的第二距离包括，所述第二主控芯片根据所述第二无线信号飞行时间和电磁波传输速率，计算所述第二基站与所述定位标签的当前距离，所述第二主控芯片对该距离进行限幅滑动窗口滤波，获得所述第二距离。

一种UWB室内三维定位方法，包括：

第一基站测量第一基站的当前气压值，根据该气压值获取第一气压值；

定位标签测量定位标签的当前气压值，根据该气压值获取第二气压值，发送所述第二气压值到所述第一基站；

第一基站根据所述第一气压值和所述第二气压值的气压差获得所述第一基站和所述定位标签的高度差；

第一基站测量所述定位标签到所述第一基站的第一无线信号飞行时间；

第一基站计算所述定位标签到所述第一基站的第一距离；

第二基站测量所述定位标签到所述第二基站的第二无线信号飞行时间；

第二基站计算所述定位标签到所述第二基站的第二距离；发送所述第二距离到所述第一基站；

第一基站发送所述定位标签的标签号、所述第一距离、所述第二距离和所述高度差到定位终端；

所述定位终端根据所述第一距离、所述第二距离和所述高度差计算所述定位标签的位置坐标，获得待定位目标的三维位置信息；

其中，所述第一基站和所述第二基站固定在定位房间的同一垂直墙面上；所述定位标签固定在该定位标签对应的待定位目标上。

进一步的，所述第一基站测量第一基站的当前气压值，根据该气压值获取第一气压值包括，所述第一基站测量所述第一基站的当前气压值，对该气压值进行限幅滑动窗口滤波，获得所述第一气压值；

所述定位标签测量定位标签的当前气压值，根据该气压值获取第二气压值包括，所述定位标签测量所述定位标签的当前气压值，对该气压值进行限幅滑动窗口滤波，获得所述第二气压值。

进一步的，所述第一基站测量所述定位标签到所述第一基站的第一无线信号飞行时间包括，所述第一基站与所述定位标签通过双边双向测距方法，获得所述定位标签到所述第一基站的第一无线信号飞行时间；

所述第二基站测量所述定位标签到所述第二基站的第二无线信号飞行时间包括，所述第二基站与所述定位标签通过双边双向测距方法，获得所述定位标签到所述第二基站的第二无线信号飞行时间。

进一步的，所述第一基站计算所述定位标签到所述第一基站的第一距离包括，所述第一主控芯片根据所述第一无线信号飞行时间和电磁波传输速率，计算所述第一基站与所述定位标签的当前距离，所述第一主控芯片对该距离进行限幅滑动窗口滤波，获得所述第一距离；

所述第二基站计算所述第二基站与所述定位标签的第二距离包括，所述第二主控芯片根据所述第二无线信号飞行时间和电磁波传输速率，计算所述第二基站与所述定位标签的当前距离，所述第二主控芯片对该距离进行限幅滑动窗口滤波，获得所述第二距离。

进一步的，所述方法包括，对所述定位标签的气压计模块进行校准：

将所述定位标签设置到与所述第一基站同一水平面；

第一基站测量获得I个基站气压值P_Ai，

定位标签测量获得J个标签气压值P_Tj；

计算第一基站与定位标签的气压误差ΔH_error；

用所述ΔH_error对所述定位标签的气压计模块的测量数据进行修正；

其中，P_Ai和P_Tj分别代表第一基站采集到的第i个基站气压值和定位标签采集到的第j个标签气压值。

本发明的技术方案中，在同一垂直墙面设置第一基站和第二基站，通过第一基站和定位标签的UWB第一无线信号飞行时间和第二基站和定位标签的UWB第二无线信号飞行时间分别获取待定位目标到所述第一基站的距离和第二基站的距离；根据第一基站的气压值和定位标签的气压值之差获得定位标签和第一基站的高度差，定位终端根据第一基站的高度获得待定位目标的高度信息、利用待定位目标的高度信息、第一距离和第二距离即可计算出待定位目标的三维位置信息；与现有技术相比，本发明的技术方案成本低，仅需要两个基站即可实现三维定位；计算复杂度低，利用待定位目标的高度信息和两个距离信息即可计算出待定位目标的位置；定位精度高，利用气压计测量气压值计算高度信息，分辨率可达到5厘米。

附图说明

图1为本发明的具体实施例1系统拓扑结构图。

图2为本发明的具体实施例1第一基站结构示意图。

图3为本发明的具体实施例1第二基站结构示意图。

图4为本发明具体实施例1定位标签结构示意图。

图5为本发明的具体实施例1基站部署示意图。

图6为本发明具体实施例2方法流程图。

具体实施方式

为了更好的说明本发明的技术方案，下面结合附图对本发明的具体实施方式进行详细描述。

具体实施例1

本实施例为本发明UWB室内三维定位系统的一种优选实施方式。

参见图1，本实施例的定位系统拓扑结构如图1所示，包括：

第一基站，第二基站、定位终端和至少一个定位标签，

所述第一基站和所述第二基站固定在房间的同一垂直墙面上，如图5所示；所述定位标签固定在待定位目标上。

所述定位标签、所述第一基站、所述第二基站之间通过UWB通信无线连接；

所述第一基站与所述定位终端通过无线或有线通信连接；

本实施例中，所述第一基站与所述定位终端之间的连接方式可以是有限网络、WIFI、移动通信网络等任意一种通信连接模式，本发明对此没有限制；

所述定位终端可以是电脑、服务器、平板电脑、手机等应用终端，本发明对此没有限制；

如图2所示，本实施例中的所述第一基站包括：

第一UWB模块，用于和所述定位标签、所述第二基站进行UWB无线通信；

第一气压计模块，用于获取第一基站的当前气压值；

作为本实施例的一种优选实现方案，所述气压计模块可以使用高分辨率数字气压传感器，以提高高度测量精确度。

第一通信模块，用于和所述定位终端进行通信；

作为本实施例的一种优选实现方案，所述第一通信模块为可以使用WIFI通信模块。

第一主控芯片，用于测量所述定位标签到所述第一基站的第一无线信号飞行时间，计算所述第一基站与所述定位标签的第一距离；根据所述第一基站的当前气压值获得第一气压值，根据所述第一气压值与第二气压值获得所述第一基站与所述定位标签的高度差:

其中，所述P_A为第一气压值，所述P_T为第二气压值，所述Temp为当前温度值，可以由第一气压计模块或第二气压计模块测量获得，所述ΔH为高度差；

作为本实施例的一种优选实现方案，所述第一主控芯片对所述第一气压计模块测量的所述第一基站的当前气压值进行限幅滑动窗口滤波，获得所述第一气压值；

其中,所述限幅滑动窗口滤波的具体方法为:

第一主控芯片内设置有一个长度为M的先入先出气压存储单元,用于存放最近M次测量的第一基站的气压值；

第一主控芯片比较所述第一基站的当前气压值PA_NOW与所述先入先出气压存储单元中最后存入的上一次测量的第一基站的气压值PA_M；

如果，|PA_NOW-PA_M|≤TH_PA,则,第一主控芯片将所述PA_NOW存入所述先入先出气压存储单元,更新所述先入先出气压存储单元数据；否则第一主控芯片直接丢弃所述PA_NOW；

所述第一主控芯片将所述先入先出气压存储单元中保存的各气压值的平均值作为所述第一气压值:

其中,m为所述先入先出气压存储单元中存储的气压值的编号；PA_m为所述先入先出气压存储单元中存储的的m个气压值；m＝1,2,……,M。

所述第一距离的计算方式为：

第一主控芯片获取所述第一基站与所述定位标签之间的第一无线信号飞行时间T_prop1；

本实施例中，所述第一无线信号飞行时间可以采用双边双向测距方法、单边双向测距方法等方法测量；也可以直接由定位标签发送一个带有发送时间的发送消息到第一基站，第一基站将接收时间和消息中的发送时间之差作为第一无线信号飞行时间；本发明对此没有限制；

作为本实施例的一种优选实现方案，所述第一无线信号飞行时间采用双边双向测距方法测量；

其中,所述双边双向测距方法的具体方法可以是:

定位标签首先在T₁时刻发送轮询消息到所述第一基站，第一基站在T₂时刻接收到轮询消息，第一基站在T3时刻发送响应消息到所述定位标签；定位标签在T4时刻接收到响应消息,定位标签在T5时刻发送最终消息到所述第一基站；第一基站在T6时刻接收到最终消息。所述第一基站接收到最终消息后，根据上述各消息的发送时刻和接收时刻计算所述第一无线信号飞行时间:

根据所述第一无线信号飞行时间和电磁波传输速率c，计算第一基站与所述定位标签的第一距离DIS₁；

作为本实施例的一种实现方案,所述DIS₁可以直接通过所述T_prop1计算获得:DIS₁＝T_prop1×c。

作为本实施例的一种优选实现方案,第一芯片计算所述第一基站与所述定位标签的当前距离DIS_NOW，对该距离进行限幅滑动窗口滤波，获得所述第一距离；

DIS_NOW＝T_prop1×c

第一主控芯片内设置有一个长度为N的先入先出存储单元,用于存放最近N次获得的第一基站与所述定位标签的距离；

第一主控芯片判断|DIS_NOW-DIS_N|是否不大于TH_DIS；

其中,所述DIS_N所述先入先出存储单元中存储的最近一次获得的第一基站与定位标签的距离；所述TH_DIS为预设的第一距离限幅门限值；

如果是,第一主控芯片将所述DIS_NOW存入所述先入先出距离存储单元,更新所述先入先出距离存储单元数据；否则第一主控芯片直接丢弃所DIS_NOW；

所述第一主控芯片将所述先入先出距离存储单元中保存的各距离的平均值作为所述第一距离:

其中,n为所述先入先出距离存储单元中存储的距离的编号；DIS_n为所述先入先出距离存储单元中存储的的n个距离；n＝1,2,……,N。

如图3所示，本实施例中的所述第二基站包括：

第二UWB模块，用于和所述定位标签、所述第一基站进行UWB无线通信；

第二主控芯片，用于测量所述定位标签到所述第二基站的第二无线信号飞行时间，计算所述第二基站与所述定位标签的第二距离,通过所述第二UWB模块发送所述第二距离信息到所述第一基站；

其中，所述第二距离的计算方式为：

第二主控芯片获取所述第二基站与所述定位标签之间的第二无线信号飞行时间；

本实施例中，所述第二无线信号飞行时间可以采用双边双向测距方法、单边双向测距方法等方法测量，也可以直接由定位标签发送一个带有发送时间的发送消息到第二基站，第二基站将接收时间和消息中的发送时间之差作为第二无线信号飞行时间；本发明对此没有限制；

作为本实施例的一种优选实现方案，所述第二无线信号飞行时间采用双边双向测距方法测量,具体测量方法与第一无线信号飞行时间测量方法相似,可以参见第一无线信号飞行时间的具体测量方法,在此不再赘述；

第二芯片根据所述第二无线信号飞行时间和电磁波传输速率，计算第二基站与所述定位标签的第二距离。所述第二距离的具体计算方式与第一距离的计算方式相似,可以参见第一距离的具体计算方法,在此不再赘述。

如图4所示，本实施例的定位标签包括：

第三UWB模块，用于和所述第一基站以及所述第二基站进行UWB无线通信；

第二气压计模块，用于获取定位标签的当前气压值；

第三主控芯片，用于根据所述定位标签的当前气压值获取第二气压值，通过所述第三UWB模块发送所述第二气压值到所述第一基站；

作为本实施例的一种优选实现方案，所述第三主控芯片对所述第二气压计模块测量的所述定位标签的当前气压值进行限幅滑动窗口滤波，获得所述第二气压值；其中，所述限幅滑动窗口滤波的具体方法与第一气压值的限幅滑动窗口滤波方法相似，在此不再赘述。

所述定位终端包括，第二通信模块，用于和所述第一基站进行通信；主机，用于计算所述定位标签的位置坐标，获得待定位目标的三维位置信息。

本实施例中，所述主机通过所述第二通信模块接收来自所述第一基站的第一距离、第二距离、高度差，结合所述第一基站和所述第二基站的位置坐标计算所述定位标签的位置坐标：

其中,(x,y,z)为定位标签在定位坐标系统中的x轴、y轴、z轴的位置信息，(x₁,y₁,z₁)为第一基站在定位坐标系统中的x轴、y轴、z轴的位置信息，(x₂,y₂,z₂)为和第二基站在定位坐标系统中的x轴、y轴、z轴的位置信息，r₁为第一距离，r₂为第二距离，ΔH为第一基站与定位标签的高度差；

定位终端在计出的两个位置坐标中选择位于定位坐标系统取值范围内的位置坐标作为定位标签的位置坐标，获得所述待定位目标的三维位置信息。

本实施例只使用了两个基站来进行定位，计算出的定位标签位置坐标有两个解，如图5所示，由于本实施例中两个基站设置在房间的同一垂直墙面上，因此两个解对应的位置在所述第一基站和第二基站所在垂直面的镜面对称位置，且其中一个解的位置在定位坐标的取值范围之外，因此，定位终端只需要简单的选择在取值范围内的解作为定位标签的位置坐标，即可准确获取待定位目标的三维位置信息。

具体实施例2

本实施例为本发明UWB室内三维定位方法的一种优选实施方式。

本实施例定位方法应用的系统为具体实施例1中所描述的定位系统，系统结构参见具体实施例1。

参见图6，本实施例的定位方法流程如图2所示，包括：

S101、第一基站测量第一基站的当前气压值，根据该气压值获取第一气压值；

本步骤中，第一基站可以直接将该当前气压值作为第一气压值；作为本实施例的一种优选实现方案，本步骤还可以进一步包括：

S1011、第一基站测量获得第一基站的当前气压值；

S1012、对该气压值进行限幅滑动窗口滤波，获得第一气压值；

所述限幅滑动窗口滤波的具体方法与具体实施例1中第一气压值的限幅滑动窗口滤波相同，在此不再赘述。

S102、定位标签测量其对应的定位标签的当前气压值，根据该气压值获取第二气压值；

本步骤中，第一基站可以直接将该当前气压值作为第二气压值；作为本实施例的一种优选实现方案，本步骤还可以进一步包括：

S1021、定位标签测量获得定位标签的当前气压值；

S1022、对该气压值进行限幅滑动窗口滤波，获得第二气压值；

所述限幅滑动窗口滤波的具体方法与具体实施例1中第二气压值的限幅滑动窗口滤波相同，在此不再赘述。

S103、定位标签发送所述第二气压值到所述第一基站；

S104、第一基站计算所述第一基站和所述定位标签的高度差；

其中，所述P_A为第一气压值，所述P_T为第二气压值，所述Temp为当前温度值，可以由第一气压计模块或第二气压计模块测量获得，所述ΔH为高度差；S105、第一基站计算所述定位标签到所述第一基站的第一距离；

S1051、第一基站获取第一基站与定位标签之间的第一无线信号飞行时间；

所述第一无线信号飞行时间的具体获取方法与具体实施例1相同，在此不再赘述。

S1052、根据所述第一无线信号飞行时间和电磁波传输速率，计算第一基站与定位标签的第一距离。

所述第一距离的具体计算方法与具体实施例1相同，在此不再赘述。

S106、第二基站计算所述定位标签到所述第二基站的第二距离；

S1061、第二基站获取第二基站与定位标签之间的第二无线信号飞行时间；

所述第二无线信号飞行时间的具体获取方法与具体实施例1相同，在此不再赘述。

S1062、根据所述第二无线信号飞行时间和电磁波传输速率，获得第二基站与定位标签的第二距离。

所述第二距离的具体计算方法与具体实施例1相同，在此不再赘述。

S107、第二基站发送所述第二距离到所述第一基站；

S108、第一基站发送所述定位标签的标签号、所述第一距离、所述第二距离和所述高度差到定位终端；

S109、所述定位终端根据所述第一距离、所述第二距离和所述高度差计算所述定位标签的位置坐标，获得待定位目标的三维位置信息；

定位终端接收来自所述第一基站的第一距离、第二距离、高度差，结合所述第一基站和所述第二基站的位置坐标计算所述定位标签的位置坐标：

其中,(x,y,z)为定位标签在定位坐标系统中的x轴、y轴、z轴的位置信息，(x₁,y₁,z₁)为第一基站在定位坐标系统中的x轴、y轴、z轴的位置信息，(x₂,y₂,z₂)为和第二基站在定位坐标系统中的x轴、y轴、z轴的位置信息，r₁为第一距离，r₂为第二距离，ΔH为第一基站与定位标签的高度差；

定位终端在计出的两个位置坐标中选择位于定位坐标系统取值范围内的位置坐标作为定位标签的位置坐标，获得所述待定位目标的三维位置信息。

本实施例只使用了两个基站来进行定位，计算出的定位标签位置坐标有两个解，如图5所示，由于本实施例中两个基站设置在房间的同一垂直墙面上，因此两个解对应的位置在所述第一基站和第二基站所在垂直面的镜面对称位置，且其中一个解的位置在定位坐标的取值范围之外，因此，定位终端只需要简单的选择在取值范围内的解作为定位标签的位置坐标，即可准确获取待定位目标的三维位置信息。

作为本实施例的一种优选实现方案，本实施例的方法在所述步骤S101之前，还可以包括步骤S100、对所述定位标签的气压计模块进行校准；

本实施例中，所述步骤S100进一步包括：

S1001、将所述定位标签设置到与所述第一基站同一水平面；

S1002、第一基站测量获得I个基站气压值P_Ai，

S1003、定位标签测量获得J个标签气压值P_Tj；

S1004、计算第一基站与定位标签的气压误差ΔH_error；

用所述ΔH_error对所述定位标签的气压计模块的测量数据进行修正：第二气压计模块每次测量气压后，将测量获得的气压值加ΔH_error作为定位标签的当前气压值。所述P_Ai和所述P_Tj分别代表第一基站采集到的第i个基站气压值和定位标签采集到的第j个标签气压值。

本发明的上述具体实施例中，在同一垂直墙面设置第一基站和第二基站，通过第一基站和定位标签的UWB第一无线信号飞行时间和第二基站和定位标签的UWB第二无线信号飞行时间分别获取待定位目标到所述第一基站的距离和第二基站的距离；根据第一基站的气压值和定位标签的气压值之差获得定位标签和第一基站的高度差，定位终端根据第一基站的高度获得待定位目标的高度信息、利用待定位目标的高度信息、第一距离和第二距离即可计算出待定位目标的三维位置信息；与现有技术相比，本发明的技术方案成本低，仅需要两个基站即可实现三维定位；计算复杂度低，利用待定位目标的高度信息和两个距离信息即可计算出待定位目标的位置；定位精度高，利用气压计测量气压值计算高度信息，分辨率可达到5厘米。

在本发明的一些优选实现方案中，在计算第一气压值、第二气压值、第一距离、第二距离时，通过限幅滑动窗口滤波可消除由于偶然出现的脉冲干扰所引起的采样值偏差，进一步提高定位精度；在本发明的另一些优选实现方案中，通过双向双边测距，可以避免定位标签与基站之间需要时间同步的问题，还可以消除定位标签与基站之间的时间偏差；提高无线信号飞行时间的测量精度。

需要说明的是，以上实施例仅用以说明本发明的技术方案而非限制，尽管参照较佳实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，可以对本发明的技术方案进行修改或者等同替换，而不脱离本发明技术方案的宗旨和范围，其均应涵盖在本发明的权利要求范围当中。

Claims (10)

1.一种UWB室内三维定位系统，其特征在于，所述系统包括：

第一基站，第二基站，定位终端和至少一个定位标签；所述第一基站和所述第二基站固定在房间的同一墙面上；

所述第一基站包括，第一UWB模块，用于和所述定位标签、所述第二基站进行UWB无线通信；第一气压计模块，用于获取第一基站的当前气压值；第一通信模块，用于和所述定位终端进行通信；第一主控芯片，用于测量所述定位标签到所述第一基站的第一无线信号飞行时间，计算所述第一基站与所述定位标签的第一距离；根据所述第一基站的当前气压值获得第一气压值，根据所述第一气压值与第二气压值获得所述第一基站与所述定位标签的高度差；

所述第二基站包括，第二UWB模块，用于和所述定位标签、所述第一基站进行UWB无线通信；第二主控芯片，用于测量所述定位标签到所述第二基站的第二无线信号飞行时间，计算所述第二基站与所述定位标签的第二距离，通过所述第二UWB模块发送第二距离到所述第一基站；

所述定位标签固定在待定位目标上，包括：第三UWB模块，用于和所述第一基站以及所述第二基站进行UWB无线通信；第二气压计模块，用于获取定位标签的当前气压值；第三主控芯片，用于根据所述定位标签的当前气压值获取第二气压值，通过所述第三UWB模块发送第二气压值到所述第一基站；

所述定位终端包括：第二通信模块，用于和所述第一基站进行通信；主机，用于计算所述定位标签的位置坐标。

2.根据权利要求1所述的系统，其特征在于，所述根据所述第一基站的当前气压值获得第一气压值包括：

所述第一主控芯片对所述第一基站的当前气压值进行限幅滑动窗口滤波，获得所述第一气压值。

3.根据权利要求1所述的系统，其特征在于，所述根据所述定位标签的当前气压值获取第二气压值包括：

所述第三主控芯片对所述定位标签的当前气压值进行限幅滑动窗口滤波，获得所述第二气压值。

4.根据权利要求1所述的系统，其特征在于：

所述测量所述定位标签到所述第一基站的第一无线信号飞行时间包括，所述第一基站与所述定位标签通过双边双向测距方法，获得所述定位标签到所述第一基站的第一无线信号飞行时间；

所述测量所述定位标签到所述第二基站的第二无线信号飞行时间包括，所述第二基站与所述定位标签通过双边双向测距方法，获得所述定位标签到所述第二基站的第二无线信号飞行时间。

5.根据权利要求4所述的系统，其特征在于：

所述计算所述第一基站与所述定位标签的第一距离包括，所述第一主控芯片根据所述第一无线信号飞行时间和电磁波传输速率，计算所述第一基站与所述定位标签的当前距离，所述第一主控芯片对该距离进行限幅滑动窗口滤波，获得所述第一距离；

所述计算所述第二基站与所述定位标签的第二距离包括，所述第二主控芯片根据所述第二无线信号飞行时间和电磁波传输速率，计算所述第二基站与所述定位标签的当前距离，所述第二主控芯片对该距离进行限幅滑动窗口滤波，获得所述第二距离。

6.一种UWB室内三维定位方法，其特征在于，包括：

第一基站测量第一基站的当前气压值，根据该气压值获取第一气压值；

定位标签测量定位标签的当前气压值，根据该气压值获取第二气压值，发送所述第二气压值到所述第一基站；

第一基站根据所述第一气压值和所述第二气压值的气压差获得所述第一基站和所述定位标签的高度差；

第一基站测量所述定位标签到所述第一基站的第一无线信号飞行时间；

第一基站计算所述定位标签到所述第一基站的第一距离；

第二基站测量所述定位标签到所述第二基站的第二无线信号飞行时间；

第二基站计算所述定位标签到所述第二基站的第二距离；发送所述第二距离到所述第一基站；

第一基站发送所述定位标签的标签号、所述第一距离、所述第二距离和所述高度差到定位终端；

所述定位终端根据所述第一距离、所述第二距离和所述高度差计算所述定位标签的位置坐标，获得待定位目标的三维位置信息；

其中，所述第一基站和所述第二基站固定在定位房间的同一垂直墙面上；所述定位标签固定在该定位标签对应的待定位目标上。

7.根据权利要求6所述的方法，其特征在于：

所述第一基站测量第一基站的当前气压值，根据该气压值获取第一气压值包括，所述第一基站测量所述第一基站的当前气压值，对该气压值进行限幅滑动窗口滤波，获得所述第一气压值；

所述定位标签测量定位标签的当前气压值，根据该气压值获取第二气压值包括，所述定位标签测量所述定位标签的当前气压值，对该气压值进行限幅滑动窗口滤波，获得所述第二气压值。

8.根据权利要求6所述的方法，其特征在于：

所述第一基站测量所述定位标签到所述第一基站的第一无线信号飞行时间包括，所述第一基站与所述定位标签通过双边双向测距方法，获得所述定位标签到所述第一基站的第一无线信号飞行时间；

所述第二基站测量所述定位标签到所述第二基站的第二无线信号飞行时间包括，所述第二基站与所述定位标签通过双边双向测距方法，获得所述定位标签到所述第二基站的第二无线信号飞行时间。

9.根据权利要求8所述的方法，其特征在于：

所述第一基站计算所述定位标签到所述第一基站的第一距离包括，所述第一主控芯片根据所述第一无线信号飞行时间和电磁波传输速率，计算所述第一基站与所述定位标签的当前距离，所述第一主控芯片对该距离进行限幅滑动窗口滤波，获得所述第一距离；

所述第二基站计算所述第二基站与所述定位标签的第二距离包括，所述第二主控芯片根据所述第二无线信号飞行时间和电磁波传输速率，计算所述第二基站与所述定位标签的当前距离，所述第二主控芯片对该距离进行限幅滑动窗口滤波，获得所述第二距离。

10.根据权利要求6～9中任一项所述的方法，其特征在于，所述方法还包括，对所述定位标签的气压计模块进行校准：

将所述定位标签设置到与所述第一基站同一水平面；

第一基站测量获得I个基站气压值P_Ai，

定位标签测量获得J个标签气压值P_Tj；

计算第一基站与定位标签的气压误差ΔH_error；

用所述ΔH_error对所述定位标签的气压计模块的测量数据进行修正；

其中，P_Ai和P_Tj分别代表第一基站采集到的第i个基站气压值和定位标签采集到的第j个标签气压值。