一种基于UWB技术的三基站三维定位方法技术

本发明专利技术公开了一种基于UWB技术的三基站三维定位方法，其步骤包括：1，将待测标签置于待测载体上，并处在三个基站的环境下，通过基站筛选构建测距系统；2，基于三个基站构建三维定位坐标系；3，基于三维定位坐标系获取三个基站到标签的距离；4，对所获得的距离信息构建四面体，并求得标签的高度及横纵坐标信息，从而实现定位。本发明专利技术能进一步提高UWB三维定位的效率，减少硬件开销，降低设备成本，从而提升定位方法的整体性能。

【技术实现步骤摘要】
一种基于UWB技术的三基站三维定位方法
本专利技术属于定位导航
，具体的说是一种基于UWB技术的三基站三维定位方法。
技术介绍
随着现代科技的发展，定位技术已经在社会的各个领域得到广泛应用。相比早已经深入我们生活各个方面的室外定位技术——全球定位技术，室内定位由于受到定位时间、精度、环境状况等多方面因素的制约，使得其各方面还未发展成熟；同时，未来定位技术的发展趋势一定是室内定位技术与室外定位技术相结合，因此如今越来越多人开始研究室内定位技术。超宽带(UltraWideBand,UWB)定位技术具有功耗低、稳定性高、安全性好、穿透性高、系统复杂性低以及能实现定位精度非常高等优点，而作为目前室内精准定位技术研究的热门方向，为未来室内精准定位提供大量的可能性。目前投入使用的UWB三维定位技术至少需要四个基站导致硬件资源消耗较大，这对设备成本高的UWB技术的投入使用造成了非常大的阻力，同时目前投入使用的三维定位算法的基站摆放位置受限且通讯时间过长。
技术实现思路
本专利技术为了解决上述现有技术存在的不足之处，提出一种基于UWB技术的三基站三维定位方法，以期能进一步提高UWB三维定位的效率，减少硬件资源开销，降低设备成本，从而提升定位方法的整体性能。本专利技术为达到上述目的，采用如下技术方案：本专利技术一种基于UWB技术的三基站三维定位方法的特点是应用于由一个上位机和四个基站所构成的基站环境中，其中，一个基站作为标签并按如下步骤进行：步骤1、基站筛选：步骤1.1、三个基站分别尝试与所述标签进行通讯，当建立通讯后，相应的基站对所述标签进行测距，得到测距结果后发送给所述标签；步骤1.2、所述标签接收到所有基站的测距结果后，选出最小值所对应的基站作为距离最近的基站；步骤1.3、尝试与距离最近的基站进行通讯，若通讯成功，则将所有测距结果发送给距离最近的基站；否则，与距离次近的基站进行通讯，若通讯成功，则将所有测距结果发送给距离次近的基站；否则，与距离最远的基站进行通讯，若通讯成功，则将所有测距结果发送给距离最远的基站，否则，重复执行步骤1.3；步骤1.4、三个基站互相之间与其他基站进行通讯，当均建立通讯时，开始定位工作；步骤2、建立由三个基站所构成的三维定位坐标系；在任意两个基站的距离中，将相对距离较长的两基站分别定义基站B、基站C；定义标签为H；基站B、基站C所在的直线记为x轴，基站C在x轴正半轴，基站B在x轴负半轴；将另一基站命名为基站A；过基站A点对基站B、基站C所在直线作垂线，垂足为O点且O点记为原点，根据三角形三边关系，O点处于基站B、基站C两点之间，以OA为y轴构建二维平面坐标系；过O点作三个基站所在平面的垂线OZ为z轴；从而建立三维定位坐标系；步骤3、距离测量：步骤3.1、对所述标签H通过TOF测距算法获取标签H到基站A的距离HA，标签H到基站B的距离HB，标签H到基站C的距离HC；步骤3.2、所述上位机测量基站A与基站B的距离为AB、基站A与基站C的距离为AC、基站B与基站C的距离为BC；步骤4、在线定位阶段：步骤4.1、利式(1)得到标签H与三个基站构成的四面体体积V：步骤4.2、以三个基站所处平面为底面，令变量P为底面三个基站所构成的三角形周长的一半，通过式(2)得到底面三个基站所构成三角形面积SABC：步骤4.3、记标签H在底面的投影点为T，HT为标签H对应底面的高；从而通过体积公式求得高HT，即为标签H的Z轴坐标；步骤4.4、记变量P1为投影点T、基站A、原点O所围成的三角形△TOA周长的利用式(2)计算得到投影点T、基站A、原点O所围成的三角形△TOA的面积；步骤4.5、记基站A到投影点T的距离为AT、基站B到投影点T的距离为BT、基站C到投影点T的距离为CT、从而由勾股定理分别得到距离AT、距离BT、距离CT；步骤4.6、利用式(3)得到基站A到原点O的距离OA：基站C到原点O的距离OC是通过基站A与基站C之间的距离AC，并利用勾股定理求得，即基站B到原点O的距离OB是通过基站B与基站C之间的距离BC减去基站C与原点O的距离OC求得，即OB＝BC-OC；步骤4.7、由基站B、基站C、投影点T所构成的两个角相加为180°，即∠TOC+∠TOB＝π，从而利用式(4)得到投影点T到原点O的距离OT：步骤4.7、当OT2+OC2＞CT2时，判定所述标签H的横坐标X的符号为正；当OT2+OC2＝CT2时，判定所述标签H的横坐标X的值为0；当OT2+OC2＜CT2时，判定所述标签H的横坐标X的符号为负；步骤4.8、标签H在基站A、基站B、基站C所组成的二维面的投影点T到基站A、原点O所在直线的距离为标签H的横坐标的绝对值|X|；且从而最终得出标签H的X轴坐标；其中，STOA表示投影点T、基站A、原点O点所围三角形△TOA的面积；步骤4.8、当OT2+OA2＞AT2时，判定所述标签H的纵坐标Y的符号为正；当OT2+OA2＝AT2时，判定所述标签H的纵坐标Y的值为0；当OT2+OA2＜AT2时，判定所述标签H的纵坐标Y的符号为负；步骤4.9、标签H在三基站所组成的面的投影点T到基站B和基C所在直线的距离为标H的纵坐标的绝对值|Y|，且从而得到出标签H的Y轴坐标，进而得到所述标签H的位置坐标并实现三维定位。与现有技术相比，本专利技术的有益效果在于：1.本专利技术对于室内定位的应用场景，只利用三个基站以及相应的供能设备即可以实现定位。在有效节约节省的应用成本的同时，减小了测距时间并提高了设备的定位范围，整体而言，本专利技术具有实时性强及定位范围广的优点；2.本专利技术中单片机用于测距，FPGA用于坐标计算，二者并行工作，提高了定位实时性；3.本专利技术中定位方法能通过FPGA硬件实现，使用了并行架构，有效提升了计算速度和数据吞吐量。4.本专利技术中三个基站可以摆放成任意形状的三角形，其测量范围大。相比于传统实现方式，避免了将基站摆放成特定形状的缺陷。附图说明图1为本专利技术三基站三维定位方法的标签在第一象限时的定位图；图2为本专利技术三基站三维定位方法的标签在第二象限时的定位图；图3为本专利技术三基站三维定位方法的标签在第三象限时的定位图；图4为本专利技术三基站三维定位方法的标签在第四象限时的定位图；图5为本专利技术三基站三维定位方法的标签横坐标为正，标签在xoy平面投影点在第一象限时的平面图；图6为本专利技术三基站三维定位方法的标签横坐标为正，标签在xoy平面投影点在第四象限的平面图；图7为本专利技术三基站三维定位方法的标签横坐标为正，标签在xoy平面投影点在x轴正半轴的平面图；图8为本专利技术三基站三维定位方法的标签横坐标为零，标签在xoy平面投影点在y轴正半轴的平面图；图9为本专利技术三基站三本文档来自技高网...

【技术保护点】
1.一种基于UWB技术的三基站三维定位方法，其特征是应用于由一个上位机和四个基站所构成的基站环境中，其中，一个基站作为标签并按如下步骤进行：/n步骤1、基站筛选：/n步骤1.1、三个基站分别尝试与所述标签进行通讯，当建立通讯后，相应的基站对所述标签进行测距，得到测距结果后发送给所述标签；/n步骤1.2、所述标签接收到所有基站的测距结果后，选出最小值所对应的基站作为距离最近的基站；/n步骤1.3、尝试与距离最近的基站进行通讯，若通讯成功，则将所有测距结果发送给距离最近的基站；否则，与距离次近的基站进行通讯，若通讯成功，则将所有测距结果发送给距离次近的基站；否则，与距离最远的基站进行通讯，若通讯成功，则将所有测距结果发送给距离最远的基站，否则，重复执行步骤1.3；/n步骤1.4、三个基站互相之间与其他基站进行通讯，当均建立通讯时，开始定位工作；/n步骤2、建立由三个基站所构成的三维定位坐标系；/n在任意两个基站的距离中，将相对距离较长的两基站分别定义基站B、基站C；定义标签为H；基站B、基站C所在的直线记为x轴，基站C在x轴正半轴，基站B在x轴负半轴；将另一基站命名为基站A；过基站A点对基站B、基站C所在直线作垂线，垂足为O点且O点记为原点，根据三角形三边关系，O点处于基站B、基站C两点之间，以OA为y轴构建二维平面坐标系；过O点作三个基站所在平面的垂线OZ为z轴；从而建立三维定位坐标系；/n步骤3、距离测量：/n步骤3.1、对所述标签H通过TOF测距算法获取标签H到基站A的距离HA，标签H到基站B的距离HB，标签H到基站C的距离HC；/n步骤3.2、所述上位机测量基站A与基站B的距离为AB、基站A与基站C的距离为AC、基站B与基站C的距离为BC；/n步骤4、在线定位阶段：/n步骤4.1、利式(1)得到标签H与三个基站构成的四面体体积V：/n...

【技术特征摘要】
1.一种基于UWB技术的三基站三维定位方法，其特征是应用于由一个上位机和四个基站所构成的基站环境中，其中，一个基站作为标签并按如下步骤进行：
步骤1、基站筛选：
步骤1.1、三个基站分别尝试与所述标签进行通讯，当建立通讯后，相应的基站对所述标签进行测距，得到测距结果后发送给所述标签；
步骤1.2、所述标签接收到所有基站的测距结果后，选出最小值所对应的基站作为距离最近的基站；
步骤1.3、尝试与距离最近的基站进行通讯，若通讯成功，则将所有测距结果发送给距离最近的基站；否则，与距离次近的基站进行通讯，若通讯成功，则将所有测距结果发送给距离次近的基站；否则，与距离最远的基站进行通讯，若通讯成功，则将所有测距结果发送给距离最远的基站，否则，重复执行步骤1.3；
步骤1.4、三个基站互相之间与其他基站进行通讯，当均建立通讯时，开始定位工作；
步骤2、建立由三个基站所构成的三维定位坐标系；
在任意两个基站的距离中，将相对距离较长的两基站分别定义基站B、基站C；定义标签为H；基站B、基站C所在的直线记为x轴，基站C在x轴正半轴，基站B在x轴负半轴；将另一基站命名为基站A；过基站A点对基站B、基站C所在直线作垂线，垂足为O点且O点记为原点，根据三角形三边关系，O点处于基站B、基站C两点之间，以OA为y轴构建二维平面坐标系；过O点作三个基站所在平面的垂线OZ为z轴；从而建立三维定位坐标系；
步骤3、距离测量：
步骤3.1、对所述标签H通过TOF测距算法获取标签H到基站A的距离HA，标签H到基站B的距离HB，标签H到基站C的距离HC；
步骤3.2、所述上位机测量基站A与基站B的距离为AB、基站A与基站C的距离为AC、基站B与基站C的距离为BC；
步骤4、在线定位阶段：
步骤4.1、利式(1)得到标签H与三个基站构成的四面体体积V：



步骤4.2、以三个基站所处平面为底面，令变量P为底面三个基站所构成的三角形周长的一半，通过式(2)得到底面三个基站所构成三角形面积SABC：

【专利技术属性】
技术研发人员：李桢旻，周自衡，梁卓威，刘月月，崇雯玥，杜高明，倪伟，尹勇生，
申请(专利权)人：合肥工业大学，
类型：发明
国别省市：安徽;34