一种基于ADS-TWR的井下UWB多基站定位区域判定方法技术

本发明专利技术涉及一种基于ADS‑TWR的井下UWB多基站定位区域判定方法，通过在井下多基站定位中，采用超宽带通信技术，利用非对称双边双向测距算法，引入“区域判定”、“区域校正”机制，降低定位复杂度。本发明专利技术并不是在每次定位时都向所有测距基站请求连接，而是首先利用ADS‑TWR算法的高精度测距优势，准确判定移动标签的区域，然后在定位时只与区域内测距基站建立UWB通信，有效解决了移动标签每次定位都需广播Poll请求帧而产生大量无效通信的问题，大幅减少上位机获取一组测距信息的时间。同时，本发明专利技术降低节点功耗，为高精度、高实时性定位的实现提供保障。

【技术实现步骤摘要】
一种基于ADS-TWR的井下UWB多基站定位区域判定方法
本专利技术涉及移动无线通信以及位置的服务
，具体涉及一种基于ADS-TWR的井下UWB多基站定位区域判定方法。
技术介绍
随着工业物联网与人工智能技术在煤矿领域的不断发展，煤矿井下人员与设备的位置信息已经成为十分重要的基础信息。目前，多采用RFID、WiFi、ZigBee、蓝牙等无线技术实现矿井巷道下的物体定位，但由于定位精度差等问题，无法满足井下高精度定位的要求。而超宽带(UltraWideband,UWB)技术具有时间分辨率高，穿透力强，抗多径衰弱能力和抗干扰能力强等特点，能够有效克服传统井下无线定位技术的缺陷。UWB定位技术通常是基于TOF(TimeofFligh)传播时间测距算法、TW-TOF(TwoWayTOF)双向测距算法来实现。但是，TOF算法对测距基站与移动标签的时钟同步有严格要求，TW-TOF算法易受节点时钟偏移的影响，导致测距精度都不高，从而影响定位精度。而ADS-TWR(AsymmetricDoubleSidedTwo-WayRanging)非对称双边双向算法既可消除节点时钟未同步对精度的影响，又能够有效抑制节点时钟偏移引起的误差，因此满足高精度测距要求。考虑到井下狭长空间中多基站分布情况，移动标签的每一次定位通常都需要向井下所有测距基站广播Poll帧，并与通信范围内的测距基站按ADS-TWR测距原理实现信息交互并测距，而完成井下移动标签一维定位只需要两个基站参与测距即可。所以对于这种定位方式，除了与参与定位的两个基站建立的通信是有效的，其余通信都是无效的，这样既大量消耗节点功率，又大幅增加获取一组距离的时间，严重影响定位的实时性和定位精度。
技术实现思路
本专利技术的目的在于提供一种基于ADS-TWR的井下UWB多基站定位区域判定方法，以解决井下UWB多基站定位中移动标签广播Poll请求帧而产生大量无效通信的问题。为实现上述目的，本专利技术采用了以下技术方案：一种基于ADS-TWR的井下UWB多基站定位区域判定方法，包括以下步骤：(1)根据测距基站与UWB移动标签的通信距离，将多个测距基站按照不大于通信距离的尺寸等间距的分布在井下巷道壁的一侧，并保持在同一水平上，每两个相邻的测距基站确定一个区域Rj；(2)将UWB移动标签配置在井下定位目标上，初始化移动标签，通过移动标签向所有测距基站广播Poll请求帧，移动标签通信范围内的测距基站分别与其建立连接，计算测距基站相对移动标签的距离；(3)测距基站将距离信息通过Report帧回传给移动标签，移动标签根据获取的距离集选择两个最近的测距基站并判定所在区域；(4)根据判定区域，移动标签向判定区域内的测距基站发送Poll帧，并时刻检测与区域内测距基站信息交互过程中的异常情况以及测距基站通过Report帧回传的距离信息，判断移动标签所在区域的变化和异常，进行区域校正；(5)上位机获取到区域内测距基站测得的距离信息，根据测距基站固定坐标，通过定位算法解算出移动标签的坐标，完成一维定位。进一步的，所述步骤(2)中，计算测距基站相对移动标签的距离采用ADS-TWR测距算法，具体包括以下步骤：(21)通过UWB移动标签向测距基站发送Poll请求帧，测距基站接收Poll帧，并向移动标签发送应答帧Resp，计算距基站接收Poll帧和发送应答帧的时间间隔treplyB；(22)移动标签接收Resp帧，并向移动标签向测距基站发送终止帧Final，计算移动标签发送Poll请求帧与接收Resp帧之间的时间间隔troundA；(23)测距基站接收Final帧，计算测距基站发送应答帧与接收Resp帧的时间间隔troundB；(24)通过以下公式计算测距基站相对移动标签的距离：其中，ttof为移动标签与测距基站间UWB信号单向传播时间为，d为距离值，c为电磁波传播速度值。进一步的，所述步骤(3)中，判定所在区域，具体包括以下步骤：(31)建立三元组模型：RD-＞{I,D,R}其中，I表示测距基站编号的集合，D表示测距基站回传给同一移动标签的距离集合，R表示划分区域的集合；(32)将所有移动标签通信范围内的测距基站与移动标签进行信息交互，完成测距，并分别将距离信息通过Report帧发送至移动标签，在移动标签端构成距离集D；(33)移动标签根据测距基站回传给同一移动标签的距离集合D与测距基站编号的映射关系，选择测最近基站，并根据测距基站与测距基站编号的映射关系判定移动标签所在区域Rj。进一步的，所述步骤(4)中，进行区域校正，具体为：判定测距基站是否相邻，若测距基站无法判定移动标签所在区域，则返回步骤(2)、(3)进行区域校正；在定位过程中，移动标签多次向区域内测距基站发送Poll帧时，若测距基站未接收到相应的应答帧Resp，则返回所述步骤(2)、(3)，进行区域校正；定位过程中，区域内测距基站向移动标签回传距离后，移动标签接收回传帧Report超时，则返回所述步骤(2)、(3)，进行区域校正；根据区域内测距基站通过Report回传的距离，若判定区域已不是移动标签实际所在区域，需返回步骤(2)、(3)，进行区域校正。本专利技术采用UWB技术，移动标签获取到各测距基站测得的距离信息，选择最近的两个测距基站，判定所在区域，并引入“区域校正”机制，确保移动标签区域的准确性。由上述技术方案可知，本专利技术所述的移动标签区域判定方法，利用ADS-TWR算法的高精度测距优势，判定移动标签的准确区域，并在多基站定位中只与区域内测距基站建立UWB通信，而不是向所有测距基站请求连接，有效解决了移动标签每次定位都需广播Poll请求帧而产生大量无效通信的问题，大幅减少上位机获取一组测距信息的时间，同时降低节点功耗，为实现高精度、高实时性定位提供保障。附图说明图1为本专利技术实例中井下多基站分布图；图2为本专利技术实例中UWB移动标签与测距基站的结构框图；图3为本专利技术实例中ADS-TWR测距算法示意图；图4为本专利技术实例中基于ADS-TWR的回传帧工作机制示意图；图5为本专利技术实例中区域判定三元组模型关系图；图6为本专利技术实例中基于区域判定的定位流程图。具体实施方式下面结合附图对本专利技术做进一步说明：如图1-6所示，一种基于ADS-TWR的井下UWB多基站定位区域判定方法，具体步骤如下：S1：多基站等间距分布：根据测距基站与UWB移动标签的通信距离，将多个测距基站按照不大于通信距离的尺寸等间距的分布在井下巷道壁的一侧，并保持在同一水平上，每两个相邻的测距基站确定一个区域Rj；如图1所示，如多个UWB测距基站A0～An，将所有测距基站等间距地分布在井下巷道壁的一侧，设测距基站与移动标签T的通信距离可达m米，选取测距基站间距l≤m米，例如l＝m/2米，每两个相邻的测距基站便构成了一个长为m米的区域Rj，配置移动标签在井下定位目标上，例如某个移动标签T所在区域为R2。其中，UWB测距基站与UWB移动标签均由主处理器(MCU)以及连接在主处理器上的UWB无线收发模块、其他外设组成。如图2所示，本专利技术采用含有以太网模块的STM32F107芯片作为MCU，DW1000芯片作为UWB无线收发模块。S2：测距基站的高精度测距：移动标签初始化后，向所有测距基站广播Poll请本文档来自技高网...

【技术保护点】
一种基于ADS‑TWR的井下UWB多基站定位区域判定方法，其特征在于，包括以下步骤：(1)根据测距基站与UWB移动标签的通信距离，将多个测距基站按照不大于通信距离的尺寸等间距的分布在井下巷道壁的一侧，并保持在同一水平上，每两个相邻的测距基站确定一个区域Rj；(2)将UWB移动标签配置在井下定位目标上，初始化移动标签，通过移动标签向所有测距基站广播Poll请求帧，移动标签通信范围内的测距基站分别与其建立连接，计算测距基站相对移动标签的距离；(3)测距基站将距离信息通过Report帧回传给移动标签，移动标签根据获取的距离集选择两个最近的测距基站并判定所在区域；(4)根据判定区域，移动标签向判定区域内的测距基站发送Poll帧，并时刻检测与区域内测距基站信息交互过程中的异常情况以及测距基站通过Report帧回传的距离信息，判断移动标签所在区域的变化和异常，进行区域校正；(5)上位机获取到区域内测距基站测得的距离信息，根据测距基站固定坐标，通过定位算法解算出移动标签的坐标，完成一维定位。

【技术特征摘要】
1.一种基于ADS-TWR的井下UWB多基站定位区域判定方法，其特征在于，包括以下步骤：(1)根据测距基站与UWB移动标签的通信距离，将多个测距基站按照不大于通信距离的尺寸等间距的分布在井下巷道壁的一侧，并保持在同一水平上，每两个相邻的测距基站确定一个区域Rj；(2)将UWB移动标签配置在井下定位目标上，初始化移动标签，通过移动标签向所有测距基站广播Poll请求帧，移动标签通信范围内的测距基站分别与其建立连接，计算测距基站相对移动标签的距离；(3)测距基站将距离信息通过Report帧回传给移动标签，移动标签根据获取的距离集选择两个最近的测距基站并判定所在区域；(4)根据判定区域，移动标签向判定区域内的测距基站发送Poll帧，并时刻检测与区域内测距基站信息交互过程中的异常情况以及测距基站通过Report帧回传的距离信息，判断移动标签所在区域的变化和异常，进行区域校正；(5)上位机获取到区域内测距基站测得的距离信息，根据测距基站固定坐标，通过定位算法解算出移动标签的坐标，完成一维定位。2.根据权利要求1所述的基于ADS-TWR的井下UWB多基站定位区域判定方法，其特征在于：所述步骤(2)中，计算测距基站相对移动标签的距离采用ADS-TWR测距算法，具体包括以下步骤：(21)通过UWB移动标签向测距基站发送Poll请求帧，测距基站接收Poll帧，并向移动标签发送应答帧Resp，计算距基站接收Poll帧和发送应答帧的时间间隔treplyB；(22)移动标签接收Resp帧，并向移动标签向测距基站发送终止帧Final，计算移动标签发送Poll请求帧与接收Resp帧之间的时间间隔troundA；(23)测距基站接收Final帧，计算测距基站发送应答帧与接收Resp帧的时间间隔troundB；(24)...

【专利技术属性】
技术研发人员：陆阳，方文浩，卫星，张建军，魏振春，毕翔，陶稳静，贾向利，高健，
申请(专利权)人：合肥工业大学，
类型：发明
国别省市：安徽,34