WO2020172933A1 - 一种uwb室内三维定位系统及方法 - Google Patents
一种uwb室内三维定位系统及方法 Download PDFInfo
- Publication number
- WO2020172933A1 WO2020172933A1 PCT/CN2019/079278 CN2019079278W WO2020172933A1 WO 2020172933 A1 WO2020172933 A1 WO 2020172933A1 CN 2019079278 W CN2019079278 W CN 2019079278W WO 2020172933 A1 WO2020172933 A1 WO 2020172933A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- base station
- air pressure
- pressure value
- positioning
- positioning tag
- Prior art date
Links
- 238000001914 filtration Methods 0.000 claims description 28
- 238000004891 communication Methods 0.000 claims description 23
- 230000002146 bilateral Effects 0.000 claims description 14
- 230000005540 biological transmission Effects 0.000 claims description 12
- 230000000875 corresponding Effects 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 108010093413 Prophet of Pit-1 protein Proteins 0.000 description 4
- 238000000691 measurement method Methods 0.000 description 3
- 238000000034 method Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006011 modification reaction Methods 0.000 description 1
- 230000000149 penetrating Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
- H04W64/003—Locating users or terminals or network equipment for network management purposes, e.g. mobility management locating network equipment
Abstract
本发明公开了一种UWB室内三维定位系统,包括:定位终端,固定在房间同一垂直墙面上的第一基站、第二基站,至少一个固定在待定位目标上的定位标签,第一基站和定位标签分别包括了气压计模块用于测量第一气压值和第二气压值,第一基站根据第一气压值和第二气压值计算高度差;第一基站、第二基站和定位标签分别包括了UWB模块,第一基站计算第一基站和定位标签之间的第一距离,第二基站计算第二基站和定位标签之间的第二距离,定位终端根据第一距离、第二距离和高度差计算获得定位标签的位置坐标。本发明还公开了一种用于该定位系统的UWB室内三维定位方法,本发明的技术方案能够在较低成本和计算复杂度开销下实现精确的室内三维定位。
Description
本发明涉及到室内定位技术领域,特别涉及一种超宽带(简称,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
1时刻发送轮询消息到所述第一基站,第一基站在T
2时刻接收到轮询消息,第一基站在T3时刻发送响应消息到所述定位标签;定位标签在T4时刻接收到响应消息,定位标签在T5时刻发送最终消息到所述第一基站;第一基站在T6时刻接收到最终消息。所述第一基站接收到最终消息后,根据上述各消息的发送时刻和接收时刻计算所述第一无线信号飞行时间:
根据所述第一无线信号飞行时间和电磁波传输速率c,计算第一基站与所述定位标签的第一距离DIS
1;
作为本实施例的一种实现方案,所述DIS
1可以直接通过所述T
prop1计算获得:DIS
1=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
1,y
1,z
1)为第一基站在定位坐标系统中的x轴、y轴、z轴的位置信息,(x
2,y
2,z
2)为和第二基站在定位坐标系统中的x轴、y轴、z轴的位置信息,r
1为第一距离,r
2为第二距离,Δ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
1,y
1,z
1)为第一基站在定位坐标系统中的x轴、y轴、z轴的位置信息,(x
2,y
2,z
2)为和第二基站在定位坐标系统中的x轴、y轴、z轴的位置信息,r
1为第一距离,r
2为第二距离,Δ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)
- 一种UWB室内三维定位系统,其特征在于,所述系统包括:第一基站,第二基站,定位终端和至少一个定位标签;所述第一基站和所述第二基站固定在房间的同一墙面上;所述第一基站包括,第一UWB模块,用于和所述定位标签、所述第二基站进行UWB无线通信;第一气压计模块,用于获取第一基站的当前气压值;第一通信模块,用于和所述定位终端进行通信;第一主控芯片,用于测量所述定位标签到所述第一基站的第一无线信号飞行时间,计算所述第一基站与所述定位标签的第一距离;根据所述第一基站的当前气压值获得第一气压值,根据所述第一气压值与第二气压值获得所述第一基站与所述定位标签的高度差;所述第二基站包括,第二UWB模块,用于和所述定位标签、所述第一基站进行UWB无线通信;第二主控芯片,用于测量所述定位标签到所述第二基站的第二无线信号飞行时间,计算所述第二基站与所述定位标签的第二距离,通过所述第二UWB模块发送第二距离到所述第一基站;所述定位标签固定在待定位目标上,包括:第三UWB模块,用于和所述第一基站以及所述第二基站进行UWB无线通信;第二气压计模块,用于获取定位标签的当前气压值;第三主控芯片,用于根据所述定位标签的当前气压值获取第二气压值,通过所述第三UWB模块发送第二气压值到所述第一基站;所述定位终端包括:第二通信模块,用于和所述第一基站进行通信;主机,用于计算所述定位标签的位置坐标。
- 根据权利要求1所述的系统,其特征在于,所述根据所述第一基站的 当前气压值获得第一气压值包括:所述第一主控芯片对所述第一基站的当前气压值进行限幅滑动窗口滤波,获得所述第一气压值。
- 根据权利要求1所述的系统,其特征在于,所述根据所述定位标签的当前气压值获取第二气压值包括:所述第三主控芯片对所述定位标签的当前气压值进行限幅滑动窗口滤波,获得所述第二气压值。
- 根据权利要求1所述的系统,其特征在于:所述测量所述定位标签到所述第一基站的第一无线信号飞行时间包括,所述第一基站与所述定位标签通过双边双向测距方法,获得所述定位标签到所述第一基站的第一无线信号飞行时间;所述测量所述定位标签到所述第二基站的第二无线信号飞行时间包括,所述第二基站与所述定位标签通过双边双向测距方法,获得所述定位标签到所述第二基站的第二无线信号飞行时间。
- 根据权利要求4所述的系统,其特征在于:所述计算所述第一基站与所述定位标签的第一距离包括,所述第一主控芯片根据所述第一无线信号飞行时间和电磁波传输速率,计算所述第一基站与所述定位标签的当前距离,所述第一主控芯片对该距离进行限幅滑动窗口滤波,获得所述第一距离;所述计算所述第二基站与所述定位标签的第二距离包括,所述第二主控芯片根据所述第二无线信号飞行时间和电磁波传输速率,计算所述第二基站与所述定位标签的当前距离,所述第二主控芯片对该距离进行限幅滑动窗口 滤波,获得所述第二距离。
- 一种UWB室内三维定位方法,其特征在于,包括:第一基站测量第一基站的当前气压值,根据该气压值获取第一气压值;定位标签测量定位标签的当前气压值,根据该气压值获取第二气压值,发送所述第二气压值到所述第一基站;第一基站根据所述第一气压值和所述第二气压值的气压差获得所述第一基站和所述定位标签的高度差;第一基站测量所述定位标签到所述第一基站的第一无线信号飞行时间;第一基站计算所述定位标签到所述第一基站的第一距离;第二基站测量所述定位标签到所述第二基站的第二无线信号飞行时间;第二基站计算所述定位标签到所述第二基站的第二距离;发送所述第二距离到所述第一基站;第一基站发送所述定位标签的标签号、所述第一距离、所述第二距离和所述高度差到定位终端;所述定位终端根据所述第一距离、所述第二距离和所述高度差计算所述定位标签的位置坐标,获得待定位目标的三维位置信息;其中,所述第一基站和所述第二基站固定在定位房间的同一垂直墙面上;所述定位标签固定在该定位标签对应的待定位目标上。
- 根据权利要求6所述的方法,其特征在于:所述第一基站测量第一基站的当前气压值,根据该气压值获取第一气压值包括,所述第一基站测量所述第一基站的当前气压值,对该气压值进行限幅滑动窗口滤波,获得所述第一气压值;所述定位标签测量定位标签的当前气压值,根据该气压值获取第二气压值包括,所述定位标签测量所述定位标签的当前气压值,对该气压值进行限幅滑动窗口滤波,获得所述第二气压值。
- 根据权利要求6所述的方法,其特征在于:所述第一基站测量所述定位标签到所述第一基站的第一无线信号飞行时间包括,所述第一基站与所述定位标签通过双边双向测距方法,获得所述定位标签到所述第一基站的第一无线信号飞行时间;所述第二基站测量所述定位标签到所述第二基站的第二无线信号飞行时间包括,所述第二基站与所述定位标签通过双边双向测距方法,获得所述定位标签到所述第二基站的第二无线信号飞行时间。
- 根据权利要求8所述的方法,其特征在于:所述第一基站计算所述定位标签到所述第一基站的第一距离包括,所述第一主控芯片根据所述第一无线信号飞行时间和电磁波传输速率,计算所述第一基站与所述定位标签的当前距离,所述第一主控芯片对该距离进行限幅滑动窗口滤波,获得所述第一距离;所述第二基站计算所述第二基站与所述定位标签的第二距离包括,所述第二主控芯片根据所述第二无线信号飞行时间和电磁波传输速率,计算所述第二基站与所述定位标签的当前距离,所述第二主控芯片对该距离进行限幅滑动窗口滤波,获得所述第二距离。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910140710.7A CN109696167A (zh) | 2019-02-26 | 2019-02-26 | 一种uwb室内三维定位系统及方法 |
CN201910140710.7 | 2019-02-26 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2020172933A1 true WO2020172933A1 (zh) | 2020-09-03 |
Family
ID=66233661
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2019/079278 WO2020172933A1 (zh) | 2019-02-26 | 2019-03-22 | 一种uwb室内三维定位系统及方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN109696167A (zh) |
WO (1) | WO2020172933A1 (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110856106B (zh) * | 2019-11-20 | 2021-06-18 | 重庆邮电大学 | 基于uwb和气压计的室内高精度三维定位方法 |
CN111126521A (zh) * | 2019-11-28 | 2020-05-08 | 清研讯科(北京)科技有限公司 | 资产定位方法及装置、存储介质、电子装置 |
CN110996387B (zh) * | 2019-12-02 | 2021-05-11 | 重庆邮电大学 | 一种基于TOF和位置指纹融合的LoRa定位方法 |
CN111300376A (zh) * | 2020-03-23 | 2020-06-19 | 北京海益同展信息科技有限公司 | 一种巡检机器人、噪声监测方法及噪声监测系统 |
CN112747747A (zh) * | 2021-01-20 | 2021-05-04 | 重庆邮电大学 | 一种改进的uwb/imu融合室内行人定位方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106507302A (zh) * | 2016-11-04 | 2017-03-15 | 南开大学 | 一种基于uwb的三维室内定位系统 |
CN106550451A (zh) * | 2016-11-01 | 2017-03-29 | 哈尔滨工程大学 | 一种多用户超宽带室内定位系统 |
US20170123045A1 (en) * | 2015-10-29 | 2017-05-04 | Industrial Bank Of Korea | Mobile apparatus for measuring relative location based on uwb and method thereof |
CN108646215A (zh) * | 2018-05-15 | 2018-10-12 | 重庆邮电大学 | 一种基于超宽带的自动跟随快速定位方法 |
CN108731662A (zh) * | 2017-03-15 | 2018-11-02 | 酷异有限公司 | 三维定位装置与方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20150059718A (ko) * | 2012-10-22 | 2015-06-02 | (주)와이파이브 | 상향링크 액세스 포인트를 이용한 위치추정장치 및 위치추정방법 |
CN103994754B (zh) * | 2014-06-12 | 2017-01-11 | 上海扬梓投资管理有限公司 | 海拔高度测量方法及系统 |
CN107917713A (zh) * | 2017-10-19 | 2018-04-17 | 深圳市金立通信设备有限公司 | 一种计算空间直线距离的方法、终端及计算机可读介质 |
CN108802787A (zh) * | 2018-06-29 | 2018-11-13 | 深圳市乐驭智能技术有限公司 | 定位方法、装置、计算机设备和存储介质 |
-
2019
- 2019-02-26 CN CN201910140710.7A patent/CN109696167A/zh active Pending
- 2019-03-22 WO PCT/CN2019/079278 patent/WO2020172933A1/zh active Application Filing
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170123045A1 (en) * | 2015-10-29 | 2017-05-04 | Industrial Bank Of Korea | Mobile apparatus for measuring relative location based on uwb and method thereof |
CN106550451A (zh) * | 2016-11-01 | 2017-03-29 | 哈尔滨工程大学 | 一种多用户超宽带室内定位系统 |
CN106507302A (zh) * | 2016-11-04 | 2017-03-15 | 南开大学 | 一种基于uwb的三维室内定位系统 |
CN108731662A (zh) * | 2017-03-15 | 2018-11-02 | 酷异有限公司 | 三维定位装置与方法 |
CN108646215A (zh) * | 2018-05-15 | 2018-10-12 | 重庆邮电大学 | 一种基于超宽带的自动跟随快速定位方法 |
Non-Patent Citations (3)
Title |
---|
HU, ZHENGQUN : "Application of Differential Barometric Altimetry in Indoor Positioning System based on MS5534C", TRANSDUCER AND MICROSYSTEM TECHNOLOGIES, vol. 30, no. 12, 31 December 2011 (2011-12-31), pages 142-144 - 152, XP009522972, ISSN: 2096-2436 * |
LIU, QILIE ET AL.: "An Improved Protocol Based on Location Information in DTN", 2010 2ND INTERNATIONAL CONFERENCE ON FUTURE COMPUTER AND COMMUNICATION, 31 December 2010 (2010-12-31), XP031699130 * |
LU JINGYU , YU WENTAO , ZHAO XIN , SUN GUANGYI: "Design of Indoor Positioning System for Mobile Robot based on Ultra-wideband", ROBOTICS AND INDUSTRIAL AUTOMATION, vol. 43, no. 5, 31 December 2017 (2017-12-31), pages 25 - 28, XP009522964 * |
Also Published As
Publication number | Publication date |
---|---|
CN109696167A (zh) | 2019-04-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2020172933A1 (zh) | 一种uwb室内三维定位系统及方法 | |
CN110099354B (zh) | 一种结合tdoa与tof的超宽带通信二维定位方法 | |
Lorincz et al. | Motetrack: A robust, decentralized approach to rf-based location tracking | |
Lorincz et al. | MoteTrack: a robust, decentralized approach to RF-based location tracking | |
US8380218B2 (en) | Transponder subsystem for supporting location awareness in wireless networks | |
WO2018210107A1 (zh) | 一种基于Wi-Fi物联网设备网络的定位方法和系统 | |
CN106686722B (zh) | 基于css技术的大型室内环境定位的微基站及工作方法 | |
CN109788551A (zh) | 一种三维室内定位系统及方法 | |
AU2017296346A1 (en) | Methods and systems for the location and monitoring of mobile units | |
CN110856106B (zh) | 基于uwb和气压计的室内高精度三维定位方法 | |
KR100938806B1 (ko) | 알에프수신신호세기의 확률적 필터링을 이용한무선센서노드 위치추적방법 | |
CN109633537A (zh) | 一种基于uwb测距的员工定位系统 | |
US10659921B2 (en) | Measurement batching | |
US10667091B1 (en) | Wireless positioning method and server and storage medium with the same | |
Ou et al. | A ZigBee position technique for indoor localization based on proximity learning | |
Lorincz et al. | A robust, decentralized approach to rf-based location tracking | |
CN110933599B (zh) | 一种融合uwb与wifi指纹的自适应定位方法 | |
CN108413966A (zh) | 基于多种传感测距技术室内定位系统的定位方法 | |
CN203416427U (zh) | 基于ZigBee技术的自组网定位系统 | |
CN110650435B (zh) | 基于UWB定位和ZigBee定位的机器学习融合方法 | |
CA3089930A1 (en) | Low level smartphone audio and sensor clock synchronization | |
CN110958576B (zh) | 一种基于uwb的室内定位方法及系统 | |
CN104254125B (zh) | 基于无线传感网的节点定位rssi算法的改进 | |
Lemieux et al. | WHLocator: hybrid indoor positioning system | |
CN109141420B (zh) | 一种基于众包数据的室内定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 19916805 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 19916805 Country of ref document: EP Kind code of ref document: A1 |