一种基于uwb定位系统的室内定位方法
【技术领域】
[00011本发明属于定位技术，涉及基于T0A/TD0A/T0F技术室内定位的方法。
【背景技术】
[0002] 室外定位技术已经非常成熟，市场上有多种GNSS(全球导航卫星系统)设备可以满 足不同用户从米级到毫米级的各种需求。而事实上，众多行业都对室内定位技术提出越来 越高的要求，例如物联网行业，旅游行业，商业场所，机场，消防，公安，军用，停车场，医院， 机器人，无人机，隧道矿井等。对于室内定位，虽然目前有多种解决方案，例如WIFI指纹定 位，超声波定位，蓝牙定位，地磁定位，伪卫星定位，UWB定位等，但是由于技术局限以及成本 问题，目前尚未有像GNSS定位技术一样让不同用户满意的成熟产品，更进一步说，这些技术 要么定位精度无法满足要求，要么成本太高，因此难以推广。在众多室内定位技术解决方案 中，目前来看，UWB技术是比较能在精度和成本之间取得平衡的一种技术，最有希望能得到 发展的推广。
[0003] UWB是Ultra Wide Band的缩写，意思是超宽带，是利用比传统通信技术宽得多的 频谱(通常是数百Mhz到数GHz)进行通信。根据Shannon理论，信道带宽越宽，就有着越强的 抗干扰能力，所需要的发射功率越小，传输速率也越快。因此UWB技术可以使用更少的电能， 更快地进行数据的有效传输，其每个数据包的传输时间可以非常短，达到ps级别，这样一来 就有效解决了室内定位中一个很大的问题一多路径问题。这一点是其它几种技术难以解决 的。
[0004] 而UWB定位技术的基础是利用UWB进行通信，度量目标之间的电磁波传输时间，通 常使用的是T0A(Time of Arrival,电磁波达到时间）或者T0F(Time of Flight,电磁波飞 行时间）以及T0DA(达到时间差)技术，然后测量出目标之间的距离。目前UWB技术已经可以 实现最高精度达到厘米级的室内定位，而分米级别的定位产品已经在逐步推广，但是目前 所有的UWB技术定位精度以及其它基于T0A/T0F/TD0A的定位技术都不能保证使用精度，其 中一个重要原因就是天线的群延迟。T0A/T0F/TD0A技术必须度量的是目标之间的电波传输 时间，而电磁波必须要经过发射天线发射到空中，然后由接收天线获取。电磁波在空中的传 输速度是比较稳定的，而在天线中的传输情况却比较复杂，由于电磁波从天线的各个方向 向外辐射，而在各个方向上的延迟时间是不同的，而实际上无法保证在通信或者定位过程 中，两个目标天线之间的方向关系一直保持不变，正因如此，测得的两个目标之间的距离始 终有一个因为天线的各个方向的群延迟不同而造成的误差，这个误差看起来是一种系统误 差，但是却因为其误差量不唯一而无法直接消除。通常来说，UWB天线的群延迟在各个方向 上的差异大概有几十ps到几 ns，而因此给距离测量带来的误差就有几个厘米到几十厘米， 进一步的，根据误差传播原理，这个测距误差带给最后定位误差通常会大于测距误差(一般 来说，定位误差的量值是测距误差的万倍）。这个技术障碍是限制UWB室内定位技术实用化 的一个重要因素，它所体现出来的是，很多产品在实验室里的测距精度很高，但是实用的时 候却误差很大，原因是实验室的测试条件是要求两个测距目标的天线方向保持一致，而实 际中这个条件无法满足。
【发明内容】
[0005] 本发明所要解决的技术问题是由于天线各方向群延迟不同而引起的定位误差。
[0006] 本发明的技术方案提供一种基于UWB定位系统的室内定位方法，所述UWB定位系统 包括锚点、标签以及定位解算服务器，在每个需要定位的标签上分别安装用于感知标签的 天线姿态的姿态传感器，
[0007] 预先测量标签和锚点分别所使用的天线的群延迟参数，得到天线群延迟参数表； 实现方式为，将天线固定在旋转平台上，分别测量空间直角坐标系中两个正交平面上的整 个圆周的群延迟参数，测量间隔根据所使用的姿态传感器的精度相应设定，根据测量所得 的群延迟参数存储得到天线群延迟参数表；
[0008] 预先测量每个锚点的位置以及锚点的天线姿态并存储；
[0009] 进行室内定位时，进行以下操作，
[0010] 在每次进行标签与锚点进行距离测量的时候，标签从姿态传感器获取自身的姿 态，并将姿态参数传输到锚点；
[0011]在每次进行标签与锚点之间的距离测量时，锚点接收标签的姿态参数并和标签到 本锚点的距离一起传输到定位解算服务器；
[0012] 当定位解算服务器进行定位时，执行包括以下步骤，
[0013] 步骤a，将各锚点发送的距离作为标签和各锚点的原始距离信息，进行初始解算得 到标签的粗略位置；
[0014] 步骤b，根据步骤a所得标签的粗略位置和标签的姿态信息，提取预先测量所得相 应锚点的位置以及锚点的天线姿态，计算标签天线与每个锚点天线之间的相互方向关系；
[0015] 步骤c，根据步骤b所得方向关系查找天线群延迟参数表，对标签和各锚点的原始 距离信息进行修正；
[0016] 步骤d，根据步骤c所得修正结果进行再次解算，得到标签的修正后位置。
[0017] 而且，步骤c的实现方式为，设查找得到标签天线与某锚点天线之间的天线群延迟 总量DLgrp，则需要修正的距离DI Sdgrp = DLgrp X C，C是光速，对标签和该锚点的原始距离 信息进行修正后的准确距离DISprec = Dcoast_DISdgrp。
[0018] 本发明的优点在于所采用的技术手段是多传感器融合技术，在成本提高不多的条 件下便可以有效提高定位精度。
【具体实施方式】
[0019] 以下结合UWB定位系统实施例对本发明技术方案进行具体描述。
[0020]其余基于T0A/TD0A/T0F技术的测距定位系统均可以参照本例进行实施，以达到提 高精度的目的。
[0021] 通过研究，本发明提出，虽然UWB天线各个方向群延迟不同，但是这个延迟量是相 对稳定的，不是随机变化的，也就是说，每个天线的群延迟特性，都可以通过手段进行测量， 得到一个天线群延迟参数特性表，这个特性表反应了该天线在每个方向上的群延迟量。在 实际应用中，只要感知目标天线的姿态，进一步获取目标天线之间的相对方向，并根据这个 天线群延迟参数特性表将天线群延迟作为系统误差消除掉，即可提高测距精度，以此来进 一步定位，就可以提高定位精度。
[0022] UWB定位系统中，一般包含三部分，锚点，标签，以及定位解算服务器。参与测距的 部分是锚点与标签两种设备，锚点设备与标签设备上都安装有电磁波收发设备以及通信控 制器和天线。锚点的作用是控制点或者参考点，其天线的位置和姿态是固定的，其位置用其 它手段精确测量出来，输入到系统中作为参考点。标签是需要定位的目标，定位的过程为： 每个定位标签分别与每个锚点进行通信，以得到标签与锚点之间的距离，每个锚点将测距 结果传输到定位解算服务器，当定位解算服务器同时得到一个标签与两个锚点之间的距离 的时候，就可以对该标签进行二维定位，当定位解算服务器同时得到一个标签与三个锚点 之间的距离的时候，就可以对该标签进行三维定位。标签上的天线位置和姿态随时可能变 化，而这个变化会引起锚点天线与标签天线之间的方向不同，从而引起测距结果中的天线 群延迟量不同，影响测距精度。本发明提出在标签上同时安装姿态传感器，在测距的同时， 获取标签的姿态，当对两个以上的锚点进行测距后(此时的距离带有群延迟误差），即可进 行第一次定位解算，得到标签的粗略位置，根据此粗略位置与标签的姿态，计算标签天线与 锚点天线的相对方向，然后查找标签天线与每个锚点天线的群延迟参数特性表，将该方向 对应的群延迟量消除掉，从而得到精确的距离，然后实用这些修正后的精确距离进行第二 次定位结算，即可得到标签的精确位置。
[0023] 在现有的UWB定位系统基础之上，需要采取以下措施，从而实现本发明的设计，从 而提尚定位精度：
[0024] 1，每个需要定位的标签设备(包含天线以及电磁波收发设备以及通信控制处理器 等，通信控制处理器上运行通信控制程序)上都需要安装姿态传感器，从而感知标签天线的 姿态(前后、左右、水平三个方向的角度），一般来说，这需要一个三轴磁力传感器和三轴加 速度传感器组合完成，例如HMC6343。
[0025] 2,在系统运行之前，做以下准备工作：
[0026] A，测量所使用的天线的群延迟参数
[0027] 严格意义上，需要测量每个天线的群延迟参数，但是实际上，只要天线的生产工艺 可靠，相同型号天线的群延迟参数是非常相似的，因此一般只要求测量系统中所使用的每 种型号的天线的群延迟参数即可。为降低复杂度起见，通常布设各锚点时使用的天线为同 一型号的天线，各标签上使用的天线同理。本实施例假设锚点与标签所使用的天线为同一 型号的天线。如果锚点与标签设备上使用的天线型号不同，则需要分别对其测量群延迟参 数。
[0028