具有自动智能补偿UWB定位精度装置及方法转让专利

申请号 : CN202111237192.4

文献号 : CN113677001B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 刘金华王聪

申请人 : 山东开创电气有限公司

摘要 :

本发明涉及一种本发明所述的具有自动智能补偿UWB定位精度装置,属于标识卡定位技术领域。包括云平台和UWB模组,所述UWB模组包括N个UWB基站及M个标识卡,与基站配合实现距离测量;每一所述UWB基站均包括一基站高度测量模块,通过基站高度测量模块测出基站高度;标识卡包括标识卡高度测量模块,通过标识卡高度测量模块,测出标识卡高度;云平台用于实现所有数据显示和数据控制。本发明还公开了一种具有自动智能补偿UWB定位精度的方法。本发明具有以下有益效果:通过硬件内置测量高度模块,能自动校准UWB定位坐标,不会因为安装不同高度或将标识卡佩带不同高度导致坐标偏差影响精度。此发明就是为了解决不同环境下很更方便部署,提高测试精度。

权利要求 :

1.一种具有自动智能补偿UWB定位精度装置,其特征在于:包括云平台和UWB模组,所述UWB模组包括N个UWB基站及M个标识卡,M≥1,所述标识卡安装在被测人或物体上,且与每一所述UWB基站通信连接,与基站配合实现距离测量;

每一所述UWB基站均包括一基站高度测量模块,通过基站高度测量模块测出基站高度;

标识卡包括标识卡高度测量模块,通过标识卡高度测量模块,测出标识卡高度;

其中一UWB基站将测距信息及高度信息通过有线或网线传输回云平台,云平台用于实现所有数据显示和数据控制;

所述N=3,具体为不同高度位置的UWB主基站A、UWB从基站B和UWB从基站C,位置不重叠,UWB主基站A、UWB从基站B及UWB从基站C均与标识卡通讯连接,所述UWB主基站A与云平台通讯连接,

所述UWB主基站A包括第一基站高度测量模块,用于测量该基站高度,并将采集到的基站高度数据发送到第一MCU主控芯片;第一UWB定位模块,用于与标识卡配合测量两者之间直线距离,并将采集到的直线距离数据发送到第一MCU主控芯片;与所述第一基站高度测量模块、第一UWB定位模块相连的所述第一MCU主控芯片,用于对接收到的该基站高度数据、直线距离数据进行处理,并将处理后的基站高度数据、直线距离数据发送到第一无线通讯模块;与所述第一MCU主控芯片相连的第一无线通讯模块,用于接收所述处理后的基站高度数据、直线距离数据,并将所述处理后的基站高度数据、直线距离数据通过无线网络发送到云平台,所述测距信息是通过无线电波光速乘以基站获取到标识卡的时间得到这个标识卡距离基站的距离,

UWB主基站A通过第一基站高度测量模块测出UWB主基站A竖向高度的步骤,具体如下:步骤1:通过第一基站高度测量模块测出UWB主基站A高度为a2,确定坐标点A2;

步骤2:通过第四标示卡高度测量模块测出标识卡高度为B1,确定坐标点b1,因为标识卡不固定,随时移动,所以需要实时测量高度,校准;

步骤3:将a2‑B1得到高度差a12,确定坐标点A1;

步骤4:利用第一UWB定位模块,与标识卡配合测量两者直线距离,测得基站坐标点A2的到标识卡坐标点b1的直线距离;

步骤5:通过以上步骤根据勾股定理 计算可以得出坐标点A1至坐标点b1距离;

步骤6:获取坐标点A1至坐标点b1距离后,通过相同方法可以获取标识卡和另外2个基站的相对距离。

2.根据权利要求1所述的具有自动智能补偿UWB定位精度装置,其特征在于:所述UWB主基站A还包括与第一MCU主控芯片相连的第一供电模块及第一显示模块,第一供电模块为第一MCU主控芯片供电,第一显示模块用于数据显示。

3.根据权利要求2所述的具有自动智能补偿UWB定位精度装置,其特征在于:所述UWB从基站B包括第二基站高度测量模块,用于测量该基站高度,并将采集到的该基站高度数据发送到第二MCU主控芯片;

第二UWB定位模块,用于与标识卡配合测量两者直线距离,并将采集到的距离数据发送到第二MCU主控芯片,第二UWB定位模块兼具数据传输通讯及定位功能;

与所述第二基站高度测量模块、第二UWB定位模块相连的所述第二MCU主控芯片,用于对接收到的基站高度数据、直线距离数据进行处理;

第二UWB定位模块与第一UWB定位模块无线互联,实现第一MCU主控芯片、第二MCU主控芯片双向通信,将第二MCU主控芯片所述处理后的基站高度数据、直线距离数据通过无线网络发送到第一MCU主控芯片;

所述UWB从基站B与UWB从基站C的结构相同,第二UWB定位模块、第一UWB定位模块均与UWB从基站C的第三UWB定位模块无线互联,第三MCU主控芯片分别与第一MCU主控芯片、第二MCU主控芯片双向通信。

4.根据权利要求3所述的具有自动智能补偿UWB定位精度装置,其特征在于:所述标识卡包括第四标识卡高度测量模块,用于测量标识卡高度,并将采集到的标识卡高度数据发送到第四MCU主控芯片;

与所述第四MCU主控芯片相连接的第四UWB定位模块,分别用于与第一UWB定位模块、第二UWB定位模块、第三UWB定位模块配合测量两者之间直线距离,并将处理后的标识卡高度数据通过无线网络发送到第一MCU主控芯片或第二MCU主控芯片或第三MCU主控芯片。

5.根据权利要求4所述的具有自动智能补偿UWB定位精度装置,其特征在于:所述标识卡还包括与第四MCU主控芯片相连的第四供电模块及第四显示模块,第四供电模块为第四MCU主控芯片供电,第四显示模块用于数据显示。

6.根据权利要求5所述的具有自动智能补偿UWB定位精度装置,其特征在于:所述标识卡还包括标识卡本体,第四MCU主控芯片、第四标识卡高度测量模块、第四UWB定位模块、第四供电模块及第四显示模块均内置在标识卡本体中,还包括与标识卡本体相配合的充电底座。

7.一种具有自动智能补偿UWB定位精度的方法,其特征在于:应用权利要求1至6中任一项所述的具有自动智能补偿UWB定位精度装置,所述具有自动智能补偿UWB定位精度的方法,包括:

标识卡先与UWB主基站A、UWB从基站B、UWB从基站C进行测距;

UWB主基站A通过第一基站高度测量模块测出UWB主基站A竖向高度;

UWB从基站B通过第二基站高度测量模块测出UWB从基站B竖向高度;

UWB从基站C通过第三基站高度测量模块测出UWB从基站C竖向高度;

标识卡通过第四标识卡高度测量模块测出标识卡竖向高度;

测距信息及高度信息汇集至UWB主基站A,并通过UWB主基站A将测距信息及高度信息通过有线或网线传输回云平台,云平台通过算法进行数据解算处理,最终得出标识卡的位置。

说明书 :

具有自动智能补偿UWB定位精度装置及方法

技术领域

[0001] 本发明涉及一种具有自动智能补偿UWB定位精度装置及方法,属于标识卡定位技术领域。

背景技术

[0002] 随着我国经济迅速发展,地下空间建设更是日新月异。为确保隧道施工安全及运营管理,需借助各先进的物联网技术改善隧道的生产环境,提高其风险抵御能力。目前隧道
监测系统一般包含隧道LED门禁系统、隧道视频监控系统、隧道人员定位系统、隧道应急电
话系统、隧道气体检测系统。
[0003] 隧道监测系统可实现人员定位,其具体工作原理为:采用无线脉冲UWB定位技术,在隧道内部署定位基站,并向进入隧道内的施工人员分发定位标签,能有效获取进入隧道
内施工人员的时间信息、数量信息、精准位置信息等。
[0004] 现有UWB室内定位分为一维定位、二维定位、三维定位。一维定位主要用于存在检测或测距。二维定位能确定同一平面的坐标信息。三维定位能实现3个维度定位,实现3D效
果。
[0005] 三维定位需要部署更多基站,成本高。目前隧道人员定位主要采用一维和二维定位。无法实现3个维度定位,实现3D效果。并且,部署不同高度的基站或佩带标识卡会导致测
试数据算出的坐标和实际会有偏差,为了提高UWB室内定位精度,目前采用很多方案,比如
在安装部署时通过手动方式用皮尺测量+平台地图来确定好基站做标和高度,来达到提高
测量精度,施工复杂、成本高。
[0006] 在中国专利申请CN202010939121.8中,公开了一种UWB定位校正方法、UWB定位系统、设备、存储介质,其中方法包括步骤如下:从UWB定位区域中选取n个位置点作为参考点,
第i个参考点的真实坐标记为(xi,yi),i=1,2,3,..,,n,第i个参考点根据UWB定位系统定
位得到的定位坐标为计算第i个参考点在x方向定位误差err_xi,和y方向的定位误差err_
yi;以此得到n个参考点在x方向和y方向的定位误差,并和参考点的坐标形成n组离散的数
据点,构成曲面拟合的数据集Q和P;根据数据集Q和P构造误差拟合曲面,得到x方向的误差
曲面f(x,y)和y方向的误差曲面g(x,y);将步骤S4得到的误差曲面f(x,y)、g(x,y)结合UWB
定位得到的实际坐标值,对UWB定位误差进行校准,得到校准后的坐标。但是这种方式存在
很大缺陷:通过增加参考点来提高校准后定位坐标,这样会导致增加成本和实际场景部署
的不方便性,特别是在煤矿井下下比较恶劣的场景。
[0007] 在中国专利ZL201710789063.3中,公开了一种自适应组网方法、定位系统及定位基站,通过实施例中的定位基站上可以配置距离检测装置,利用距离检测装置可以检测到
定位基站之间的距离,并且校验标签与其中一个定位基站的相对位置不变。这样,即使定位
基站的位置发生变化,仍可以通过距离检测装置检测得到的距离信息,重新确定定位基站
和校验标签的相对位置坐标,可以重新实现对系统时间修正值的确定。使UWB定位系统中的
定位精度不会因为定位基站位置的变化而改变。但是这种方式存在很大缺陷:目前很多实
施场景是基站是固定不变,同时也不能解决在基站安装不同高度和标识卡不同高度的情
况。

发明内容

[0008] 根据以上现有技术中的不足,本发明要解决的技术问题是:为解决上述问题之一,提供一种具有自动智能补偿UWB定位精度装置及方法。
[0009] 本发明所述的具有自动智能补偿UWB定位精度装置,其特征在于:包括云平台和UWB模组,所述UWB模组包括N个UWB基站及M个标识卡,
[0010] N≥3,M≥1,所述标识卡安装在被测人或物体上,且与每一所述UWB基站通信连接,与基站配合实现距离测量;每一所述UWB基站均包括一基站高度测量模块,通过基站高度测
量模块测出基站高度;标识卡包括标识卡高度测量模块,通过标识卡高度测量模块,测出标
识卡高度;其中一UWB基站将测距信息及高度信息通过有线或网线传输回云平台,云平台用
于实现所有数据显示和数据控制。
[0011] 优选地,所述N=3,具体为不同高度位置的UWB主基站A、UWB从基站B和UWB从基站C,位置不重叠,UWB主基站A、UWB从基站B及UWB从基站C均与标识卡通讯连接,所述UWB主基站A
与云平台通讯连接。
[0012] 优选地,所述UWB主基站A包括第一基站高度测量模块,用于测量该基站高度,并将采集到的基站高度数据发送到第一MCU主控芯片;
[0013] 第一UWB定位模块,用于与标识卡配合测量两者之间直线距离,并将采集到的直线距离数据发送到第一MCU主控芯片;
[0014] 与所述第一基站高度测量模块、第一UWB定位模块相连的所述第一MCU主控芯片,用于对接收到的基站高度数据、直线距离数据进行处理,并将处理后的基站高度数据、直线
距离数据发送到第一无线通讯模块;
[0015] 与所述第一MCU主控芯片相连的第一无线通讯模块,用于接收所述处理后的基站高度数据、直线距离数据,并将所述处理后的基站高度数据、直线距离数据通过无线网络发
送到云平台。
[0016] 优选地,所述UWB主基站A还包括与第一MCU主控芯片相连的第一供电模块及第一显示模块,第一供电模块为第一MCU主控芯片供电,第一显示模块用于数据显示。
[0017] 优选地,所述所述UWB从基站B包括第二基站高度测量模块,用于测量该基站高度,并将采集到的该基站高度数据发送到第二MCU主控芯片;第二UWB定位模块,用于与标识卡
配合测量两者直线距离,并将采集到的距离数据发送到第二MCU主控芯片,第二UWB定位模
块兼具数据传输通讯及定位功能;与所述第二基站高度测量模块、第二UWB定位模块相连的
所述第二MCU主控芯片,用于对接收到的基站高度数据、直线距离数据进行处理;第二UWB定
位模块与第一UWB定位模块无线互联,实现第一MCU主控芯片、第二MCU主控芯片双向通信,
将第二MCU主控芯片所述处理后的基站高度数据、直线距离数据通过无线网络发送到第一
MCU主控芯片;所述UWB从基站B与UWB从基站C的结构结构相同,第二UWB定位模块、第一UWB
定位模块均与UWB从基站C的第三UWB定位模块无线互联,第三MCU主控芯片分别与第一MCU
主控芯片、第二MCU主控芯片双向通信。
[0018] 优选地,所述标识卡包括第四标示卡高度测量模块,用于测量标识卡高度,并将采集到的标志卡高度数据发送到第四MCU主控芯片;与所述第四MCU主控芯片相连接的第四
UWB定位模块,分别用于与第一UWB定位模块、第二UWB定位模块、第三UWB定位模块配合测量
两者之间直线距离,并将处理后的标示卡高度数据通过无线网络发送到第一MCU主控芯片
或第二MCU主控芯片或第三MCU主控芯片。
[0019] 优选地,所述标识卡还包括与第四MCU主控芯片相连的第四供电模块及第四显示模块,第四供电模块为第四MCU主控芯片供电,第四显示模块用于数据显示。
[0020] 优选地,所述标识卡还包括标识卡本体,第四MCU主控芯片、第四标示卡高度测量模块、第四UWB定位模块、第四供电模块及第四显示模块均内置在标识卡本体中,还包括与
标识卡本体相配合的底座。
[0021] 一种具有自动智能补偿UWB定位精度的方法,其特征在于:应用上述的具有自动智能补偿UWB定位精度装置,所述具有自动智能补偿UWB定位精度的方法,包括:
[0022] 标识卡先与UWB主基站A、UWB从基站B、UWB从基站C进行测距;
[0023] UWB主基站A通过第一基站高度测量模块测出UWB主基站A竖向高度;
[0024] UWB从基站B通过第二基站高度测量模块测出UWB从基站B竖向高度;
[0025] UWB从基站C通过第三基站高度测量模块测出UWB从基站C竖向高度;
[0026] 标识卡通过第四标示卡高度测量模块测出标识卡竖向高度;
[0027] 测距信息及高度信息汇集至UWB主基站A,并通过UWB主基站A将测距信息及高度信息通过有线或网线传输回云平台,云平台通过算法进行数据解算处理,最终得出标识卡的
位置。
[0028] 优选地,所述测距信息是通过无线电波光速乘以基站获取到标识卡的时间得到这个标识卡距离基站的距离。
[0029] 与现有技术相比,本发明具有以下有益效果:
[0030] 本发明所述的具有自动智能补偿UWB定位精度装置,通过硬件内置测量高度模块,能自动校准UWB定位坐标,不会因为安装不同高度或将标识卡佩带不同高度导致坐标偏差
影响精度。
[0031] 本发明所述的具有自动智能补偿UWB定位精度装置,采用UWB定位,是通过无线电波光速乘以基站获取到标识卡的时间得到这个标识卡距离基站的距离。不同高度会导致获
取时间不同,不同时间通过光速相乘得到距离就不同,距离不同最后导致获取坐标就和实
际有误差。此发明就是为了解决不同环境下很更方便部署,提高测试精度。
[0032] 本发明所述的具有自动智能补偿UWB定位精度的方法,可实现人员定位,采用无线脉冲UWB定位技术,在隧道内部署室外定位基站,向进入隧道内的施工人员分发定位标签,
能有效获取进入隧道洞口施工人员的时间信息、数量信息、精准位置信息等。

附图说明

[0033] 为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍。在所有附图中,类似的元件
或部分一般由类似的附图标记标识。附图中,各元件或部分并不一定按照实际的比例绘制。
[0034] 图1为本发明的原理框图;
[0035] 图2为UWB主基站A的原理框图;
[0036] 图3为标识卡的原理框图;
[0037] 图4为软件高度算法说明图;
[0038] 图5为主从基站间距离的信号飞行时间示意图;
[0039] 图6为实施图原理框图;
[0040] 图7为软件高度、距离和坐标算法流程图;
[0041] 图8为高度测量模块图;
[0042] 图9为绝对压力值补偿流程图;
[0043] 图10为标识卡的分解图;
[0044] 图11为标识卡结构图一;
[0045] 图12为标识卡结构图二;
[0046] 图13为标识卡结构图三;
[0047] 图14为标识卡结构图四;
[0048] 图15为标识卡结构图五。
[0049] 图中:1、核心主板2、前壳3、后壳4、电池5、充电底座6、腰带夹7、显示屏8、显示灯9、按键。

具体实施方式

[0050] 下面结合附图对本发明做进一步描述:
[0051] 以下通过具体实施例对本发明作进一步说明,但不用以限制本发明,凡在本发明精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
[0052] 实施例一
[0053] 如图1‑3所示,所述具有自动智能补偿UWB定位精度装置,包括云平台和UWB模组,所述UWB模组包括N个UWB基站及M个标识卡,N≥3,M≥1,所述标识卡安装在被测人或物体
上,且与每一所述UWB基站通信连接,与基站配合实现距离测量;每一所述UWB基站均包括一
基站高度测量模块,通过基站高度测量模块测出基站高度;标识卡包括标识卡高度测量模
块,通过标识卡高度测量模块,测出标识卡高度;其中一UWB基站将测距信息及高度信息通
过有线或网线传输回云平台,云平台用于实现所有数据显示和数据控制。
[0054] 本实施例中,在控制成本的情况下所述N=3,M理论不超过1000,每个都单独定位,具体为不同高度位置的UWB主基站A、UWB从基站B和UWB从基站C,位置不重叠,UWB主基站A、
UWB从基站B及UWB从基站C均与标识卡通讯连接,所述UWB主基站A与云平台通讯连接;所述
UWB主基站A包括第一基站高度测量模块,用于测量该基站高度,并将采集到的基站高度数
据发送到第一MCU主控芯片;第一UWB定位模块,用于与标识卡配合测量两者之间直线距离,
并将采集到的直线距离数据发送到第一MCU主控芯片;与所述第一基站高度测量模块、第一
UWB定位模块相连的所述第一MCU主控芯片,用于对接收到的基站高度数据、直线距离数据
进行处理,并将处理后的基站高度数据、直线距离数据发送到第一无线通讯模块;与所述第
一MCU主控芯片相连的第一无线通讯模块,用于接收所述处理后的基站高度数据、直线距离
数据,并将所述处理后的基站高度数据、直线距离数据通过无线网络发送到云平台;所述
UWB主基站A还包括与第一MCU主控芯片相连的第一供电模块及第一显示模块,第一供电模
块为第一MCU主控芯片供电,第一显示模块用于数据显示;所述UWB从基站B包括第二基站高
度测量模块,用于测量该基站高度,并将采集到的该基站高度数据发送到第二MCU主控芯
片;第二UWB定位模块,用于与标识卡配合测量两者直线距离,并将采集到的距离数据发送
到第二MCU主控芯片,第二UWB定位模块兼具数据传输通讯及定位功能;与所述第二基站高
度测量模块、第二UWB定位模块相连的所述第二MCU主控芯片,用于对接收到的基站高度数
据、直线距离数据进行处理;第二UWB定位模块与第一UWB定位模块无线互联,实现第一MCU
主控芯片、第二MCU主控芯片双向通信,将第二MCU主控芯片所述处理后的基站高度数据、直
线距离数据通过无线网络发送到第一MCU主控芯片;所述UWB从基站B与UWB从基站C的结构
结构相同,第二UWB定位模块、第一UWB定位模块均与UWB从基站C的第三UWB定位模块无线互
联,第三MCU主控芯片分别与第一MCU主控芯片、第二MCU主控芯片双向通信;所述标识卡包
括第四标示卡高度测量模块,用于测量标识卡高度,并将采集到的标志卡高度数据发送到
第四MCU主控芯片;与所述第四MCU主控芯片相连接的第四UWB定位模块,分别用于与第一
UWB定位模块、第二UWB定位模块、第三UWB定位模块配合测量两者之间直线距离,并将处理
后的标示卡高度数据通过无线网络发送到第一MCU主控芯片或第二MCU主控芯片或第三MCU
主控芯片;所述标识卡还包括与第四MCU主控芯片相连的第四供电模块及第四显示模块,第
四供电模块为第四MCU主控芯片供电,第四显示模块用于数据显示。
[0055] 实施例二
[0056] 如图10‑15所示,与实施例一不同之处在于,所述标识卡还包括还包括标识卡本体,第四MCU主控芯片、第四标示卡高度测量模块、第四UWB定位模块、第四供电模块及第四
显示模块均内置在标识卡本体中,还包括与标识卡本体相配合的充电底座5。
[0057] 具体为,标识卡本体包括扣合在一起的前壳2与后壳3,前壳2与后壳3围合成空腔,空腔内固定核心主板1及电池4,后壳3上安装有腰带夹6,充电底座5的上表面具有限位槽,
充电时,前壳2与后壳3的底部嵌入限位槽中,第四MCU主控芯片电路、第四标示卡高度测量
电路、第四UWB定位电路、第四供电电路及第四显示电路均集成在核心主板1上,充电底座5
内具有充电核心板,充电核心板具体充电端及放电端,其放电端通过触点与电池4的充电端
连接,第四显示模块还包括固定在前壳2面板上的显示屏7、显示灯8,显示屏7、显示灯8均与
第四显示电路电性连接,前壳2上还具有与第四MCU主控芯片电路电性连接的按键9。
[0058] 实施例三
[0059] 如图8及9所示,与实施例一不同之处在于,第一基站高度测量模块包括电容C1、电容C2、电容C3、电容C4及电容C1,电容C2,电容C3,电容C4,完成电源滤波和高频滤波,气压传
感器U1完成绝对压力测量,温度传感器J1完成温度测量,获取数据传给MCU处理。根据获取
到的温度和压力根据补偿系数进行补偿获取到的最终压力值转换成高度数据送给MCU处
理。
[0060] 实施例四
[0061] 如图1、图6和图7所示,所述具有自动智能补偿UWB定位精度的方法,所述应用实施例1所述的具有自动智能补偿UWB定位精度装置,所述具有自动智能补偿UWB定位精度的方
法,包括:标识卡先与UWB主基站A、UWB从基站B、UWB从基站C进行测距;UWB主基站A通过第一
基站高度测量模块测出UWB主基站A竖向高度;UWB从基站B通过第二基站高度测量模块测出
UWB从基站B竖向高度;UWB从基站C通过第三基站高度测量模块测出UWB从基站C竖向高度;
标识卡通过第四标示卡高度测量模块测出标识卡竖向高度;标识卡与任一基站无线互联,
且相邻基站间无线互联,测距信息及高度信息汇集至UWB主基站A,并通过UWB主基站A将测
距信息及高度信息通过有线或网线传输回云平台,云平台通过算法进行数据解算处理,最
终得出标识卡的位置。
[0062] 实施例五
[0063] 如图4软件高度算法说明图所示,以UWB主基站A为例,说明UWB主基站A通过第一基站高度测量模块测出UWB主基站A竖向高度的步骤,
[0064] 1、 通过第一基站高度测量模块测出UWB主基站A高度为a2,确定坐标点A2;
[0065] 2、 通过第四标示卡高度测量模块测出标识卡高度为B1,确定坐标点b1,因为标识卡不固定,随时移动,所以需要实时测量高度,校准;
[0066] 3、 将a2‑B1得到高度差a12,确定坐标点A1;
[0067] 4、 利用第一UWB定位模块,与标识卡配合测量两者直线距离,测得基站坐标点A2的到标识卡坐标点b1的直线距离;
[0068] 5、 通过以上步骤根据勾股定理 计算可以得出坐标点A1至坐标点b1距离;
[0069] 6、 获取坐标点A1至坐标点b1距离后,通过相同方法可以获取标识卡和另外2个基站的相对距离。
[0070] UWB从基站B通过第二基站高度测量模块测出UWB从基站B竖向高度;UWB从基站C通过第三基站高度测量模块测出UWB从基站C竖向高度,与UWB主基站A相同,不再累述。
[0071] 实施例六,参照主从基站间距离的信号飞行时间图5,所述测距信息是通过无线电波光速乘以基站获取到标识卡的时间得到这个标识卡距离基站的距离,具体原理如下:
[0072] 一、将主基站1为参考基站,假定主基站1坐标为(AX1,AY1,AZ1),从基站2坐标(AX2,AY2,AZ2),从基站3坐标(AX3,AY3,AZ3),则主、从基站距离差,关系式为:
[0073] ,
[0074] 其中, 表示从基站2至主基站1距离;
[0075] 表示从基站3至主基站1距离;
[0076] 表示主基站1在X轴上的坐标; 表示从基站2在X轴上的坐标; 表示从基站3在X轴上的坐标;
[0077] 表示主基站1在Y轴上的坐标; 表示从基站2在Y轴上的坐标; 表示从基站3在Y轴上的坐标;
[0078] 表示主基站1在Z轴上的坐标; 表示从基站2在Z轴上的坐标; 表示从基站3在Z轴上的坐标。
[0079] 二、将其除光速得到距离飞行时间偏移量,关系式为:
[0080] ,
[0081] 其中, 表示标签到从基站2的时间与标签到主基站1的时间之差; 表示标签到从基站3的时间与标签到主基站1的时间之差;表示光速3.0*10^8m/s。
[0082] 三、计算到达信号时间戳的时候必须减去偏移量必须距离飞行时间偏移量,否侧无法计算到标签的信号达时间差,参照主从基站间距离的信号飞行时间图5。
[0083] 上述三个步骤完成后即可计算标签达到主从基站的两两到达时间差,即公式为:
[0084] ,其中,表示标签到达2号从基站的时间与标签到达1号主基站的时间之差; 表示标签到达3
号从基站的时间与标签到达1号主基站的时间之差;
[0085] 表示2号从基站接收主基站同步消息的接收时间戳; 表示3号从基站接收1号主基站同步消息的接收时间戳; 表示2号从基站接收标签消息的接收时间戳; 表示3
号从基站接收标签消息的接收时间戳;表示1号主基站发同步信号的发射时间戳;表示1
号主基站接收标签消息的接收时间戳;
[0086] 表示2号从基站相对于主基站的时钟偏移量; 表示3号从基站相对于主基站的时钟偏移量。
[0087] 乘光速,得到距离差,公式为:
[0088] ,
[0089] 其中, 表示标签到2号从基站的距离与标签到主机站的距离之差;表示标签到3号从基站的距离与标签到主机站的距离之差; 表示光速3.0*10^8m/s。
[0090] 即可通过算法进行标识卡坐标xy的解算,最终得出标识卡的位置。
[0091] 以上显示和描述了本发明的基本原理、主要特征以及本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明
本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些
变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及
其等效物界定。