信号干扰下超宽带精确定位方法、装置及电子设备

1.本发明涉及物体目标定位领域，尤其涉及一种信号干扰下超宽带精确定位方法、装置、电子设备及存储介质。


背景技术：

2.uwb(ultra-wideband)技术也被称之为“超宽带”，又称之为脉冲无线电技术。这是一种无需任何载波，通过发送纳秒级脉冲而完成数据传输的短距离范围内无线通信技术，并且信号传输过程中的功耗仅仅有几十μw。uwb因其独有的特点，使其在军事、物联网等各个领域都有着广阔的应用。其中，基于uwb的定位技术具备实时的室内外精确跟踪能力，定位精度高，可达到厘米级甚至毫米级定位。
3.tof(time of flight,飞行时间)测距技术属于双向测距技术，是uwb定位法中最常见的定位方法之一，其通过计算信号在两个模块的飞行时间，再乘以光速即可求出两个模块之间的距离。利用此技术，采集到预设的4个锚点(anchor)与靶点(tag)之间的距离，即可建立数学模型计算出靶点的精确位置。
4.然而，在此技术实际应用于室内环境时，由于室内环境复杂多变，uwb通信信号极易受到遮挡，虽然uwb技术具有穿透能力，但仍然会产生误差，在较强干扰下，数据会发生异常波动(通常是时间延时)，基本无法完成室内定位，甚至会造成严重事故。因此，信号干扰下的超宽带(uwb)精确定位问题成为亟待解决的问题。


技术实现要素：

5.本发明的目的在于克服上述技术不足，提供一种信号干扰下超宽带精确定位方法，解决现有技术在较强干扰下，数据会发生异常波动(通常是时间延时)，基本无法完成室内定位，甚至会造成严重事故的技术问题。
6.为达到上述技术目的，本发明的技术方案提供一种信号干扰下超宽带精确定位方法，包括以下步骤：
7.s101：设定三维坐标系，并获取三维坐标系下4个锚点的坐标，通过4个锚点的坐标确定靶点的活动范围；
8.s102：数据整定：在靶点活动范围内，针对某一具体位置的靶点a，采集n组有效数据，若n大于1，则找出各组数据中的异常项，然后用正常项的均值代替，得到整定后的有效数据，进入步骤s103；所述有效数据，具体指：靶点分别与4个锚点的4个初步测量距离值；若n＝1，则进入步骤s105；
9.s103：数据聚类：利用聚类方法将整定后的有效数据进行两次二维聚类，得到靶点a与4个锚点的精确测量距离值；
10.s104：第一靶点位置计算：根据靶点a与4个锚点的精确测量距离值，采用球形定位方法，得到靶点a的位置，流程结束；
11.s105：第二靶点位置计算：建立空间距离近似判断模型，利用空间距离近似判断模
型结合球形定位方法，得到靶点a的位置。
12.进一步地，步骤s102中，当n大于1时，得到整定后的有效数据，其具体过程如下：
13.s201：输入n组有效数据；
14.s202：计算n组有效数据的均值；
15.s203：用各组有效数据减去均值后，得到处理后的各组有效数据；
16.s204：遍历处理后的各组有效数据，判断任一组有效数据i中的第k项是否超过预设值d；若是，则将第i组有效数据中的第k项视为异常项；进入步骤s205；否则，进入步骤s206；其中i＝1,2,..n，k＝1,2,3,4；
17.s205：将第i组有效数据中除第k项以外的其它项加上均值，第k项用均值代替，得到整定后的有效数据，结束整定过程；
18.s206：将第i组有效数据加上均值，得到整定后的有效数据。
19.进一步地，步骤s105具体为：
20.所述空间距离近似判断模型由靶点活动范围内的若干个预设节点构成；若单组有效数据均与某个预设节点与4个锚点的对应距离相差小于预设值b，则利用该单组有效数据，采用球形定位方法，得到靶点a的位置；若单组有效数据中某一个数据与某个或多个预设节点与锚点的对应距离相差大于预设值c，则表示该单组有效数据为异常项，找到与该单组有效数据的其它3个初步测量距离值最接近的节点，利用该节点与4个锚点的距离值采用球形定位方法，得到靶点a位置。
21.本发明提供一种信号干扰下超宽带精确定位装置，包括：
22.数据预处理模块，设定三维坐标系，并获取三维坐标系下4个锚点的坐标，通过4个锚点的坐标确定靶点的活动范围；
23.数据整定模块，在靶点活动范围内，针对某一具体位置的靶点a，采集n组有效数据，若n大于1，则找出各组数据中的异常项，然后用正常项的均值代替，得到整定后的有效数据，进入数据聚类模块；所述有效数据，具体指：靶点分别与4个锚点的4个初步测量距离值；若n＝1，则进入第二靶点位置计算模块；
24.数据聚类模块，利用聚类方法将整定后的有效数据进行两次二维聚类，得到靶点a与4个锚点的精确测量距离值；
25.第一靶点位置计算模块，根据靶点a与4个锚点的精确测量距离值，采用球形定位方法，得到靶点a的位置，流程结束；
26.第二靶点位置计算模块，建立空间距离近似判断模型，利用空间距离近似判断模型结合球形定位方法，得到靶点a的位置。
27.进一步地，所述第二靶点位置计算模块，具体处理如下：所述空间距离近似判断模型由靶点活动范围内的若干个预设节点构成；若单组有效数据均与某个预设节点与4个锚点的对应距离相差小于预设值b，则利用该单组有效数据，采用球形定位方法，得到靶点a的位置；若单组有效数据中某一个数据与某个或多个预设节点与锚点的对应距离相差大于预设值c，则表示该单组有效数据为异常项，找到与该单组有效数据的其它3个初步测量距离值最接近的节点，利用该节点与4个锚点的距离值采用球形定位方法，得到靶点a位置。
28.本发明还提供了一种计算机设备，其包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现上述信
号干扰下超宽带精确定位的步骤。
29.本发明还提供了一种计算机可读存储介质，所述计算机可读存储介质存储有计算机程序，所述计算机程序被处理器执行时实现上述信号干扰下超宽带精确定位的步骤。
30.与现有技术相比，本发明的有益效果包括：能够实现信号干扰下的超宽带(uwb)精确定位，尤其是当某个靶点位置上仅测得一组有效数据，且其中含有一个异常项时，仍然能够对靶点位置进行正确估算。
附图说明
31.图1是本发明提供的信号干扰下超宽带精确定位方法的流程示意图；
32.图2是三维坐标系、锚点、靶点活动范围示意图；
33.图3是本发明数据整定示意图；
34.图4是采用k-means聚类方法后的效果示意图；
35.图5是球形定位方法的流程图；
36.图6是本发明第二靶点位置计算的流程图。
具体实施方式
37.为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
38.本发明提供了一种信号干扰下超宽带精确定位方法。请参考图1，该方法包括以下步骤：
39.s101：设定三维坐标系，并获取三维坐标系下4个锚点的坐标，通过4个锚点的坐标确定靶点的活动范围；
40.作为一种实施例，请参考图2，图2是三维坐标系、锚点、靶点活动范围示意图；图2中，4个锚点分别为a0-a3；靶点为tag；靶点在4个锚点构成的空间范围内活动；其中4个锚点通过线缆与计算器电性连接；
41.s102：数据整定：在靶点活动范围内，针对某一具体位置的靶点a，采集n组有效数据，若n大于1，则找出各组数据中的异常项，然后用正常项的均值代替，得到整定后的有效数据，进入步骤s103；所述有效数据，具体指：靶点分别与4个锚点的4个初步测量距离值；若n＝1，则进入步骤s105；
42.作为一种实施例，n组有效数据中的第i组有效数据，可表示为：di＝[d
i0
,d
i1
,d
i2
,d
i3
]；其中d
i0-d
i3
分别表示靶点a到锚点a0-a3的测量距离；
[0043]
作为一种实施例，请参考图3，图3是本发明数据整定示意图；步骤s102中的整定后的有效数据，其整定过程如下：
[0044]
s201：输入n组有效数据；
[0045]
作为一种实施例，输入的n组有效数据为d1,d2,...,di,...,dn；
[0046]
s202：计算n组有效数据的均值；
[0047]
作为一种实施例，均值m＝(d1+d2+...+di+...+dn)/n；
[0048]
s203：用各组有效数据减去均值后，得到处理后的各组有效数据；
[0049]
作为一种实施例，处理后的第i组有效数据为：d
i～
＝[d
i0-m,d
i1-m,d
i2-m,d
i3-m]；
[0050]
s204：遍历处理后的各组有效数据，判断任一组有效数据i中的第k项是否超过预设值d；若是，则将第i组有效数据中的第k项视为异常项；进入步骤s205；否则，进入步骤s206；其中i＝1,2,..n，k＝1,2,3,4；
[0051]
作为一种实施例，预设值d取值为200mm；假设第4项为异常项；
[0052]
s205：将第i组有效数据中除第k项以外的其它项加上均值，第k项用均值代替，得到整定后的有效数据，结束整定过程；
[0053]
作为一种实施例，在存在异常项的情况下，第i组整定后的有效数据为：di`＝[d
i0
,d
i1
,d
i2
,m]；
[0054]
s206：将第i组有效数据加上均值，得到整定后的有效数据；
[0055]
作为一种实施例，在不存在异常项的情况下，第i组整定后的有效数据，即为其本身，即di＝[d
i0
,d
i1
,d
i2
,d
i3
]；
[0056]
s103：数据聚类：利用聚类方法将整定后的有效数据进行两次二维聚类，得到靶点a与4个锚点的精确测量距离值；
[0057]
作为一种实施例，本技术中采用k-means聚类方法，作为其它实施例，可采用其它聚类方法，这里不用以限定。请参考图4，图4是采用k-means聚类方法后的效果示意图；图4中左边两幅与右边两幅分别代表不同数据组聚类前后的效果图；
[0058]
s104：第一靶点位置计算：根据靶点a与4个锚点的精确测量距离值，采用球形定位方法，得到靶点a的位置，流程结束；
[0059]
请参考图5球形定位方法的流程图；
[0060]
图5中，首先输入4个锚点的坐标以及靶点和锚点的距离，即有效数据；在确定靶点到锚点距离的情况下，根据几何原理，靶点可以理解为同时位于以锚点所在的坐标为球心，ri为半径的4个圆球上，而ri即为靶点与锚点之间的直线距离。4个锚点编号为a0，a1，a2，a3，锚点坐标为a0(x0,y0,z0)～a3(x3,y3,z3)，靶点坐标为(x,y,z)，结合靶点坐标的限制条件则可如图5所示利用球形定位算法估算出靶点位置；具体地说：
[0061]
将4个锚点的坐标以及靶点和锚点的距离带入式(1)
[0062][0063]
两两相减得式(2)：
[0064][0065]
转换可得式(3)：
[0066][0067]
利用已知x,y,z限制条件和最小二乘法求解上述线性方程，最终可得到输出的靶点a的坐标x,y,z值。
[0068]
s105：第二靶点位置计算：建立空间距离近似判断模型，利用空间距离近似判断模型结合球形定位方法，得到靶点a的位置。
[0069]
作为一种实施例，请参考图6所示，图6是本发明第二靶点位置计算的流程图；
[0070]
所述空间距离近似判断模型由靶点活动范围内的若干个预设节点构成；预设节点在靶点活动范围内进行均分；空间上两两接近的节点均有两轴的坐标相同，另一轴坐标距离为设定值；
[0071]
节点设置的越密，模型判断准确度越高，但计算量也越大。节点设置完毕后，计算出各节点到4个靶点的距离，然后与测得的单组数据进行一一比对；
[0072]
若单组有效数据均与某个预设节点与4个锚点的对应距离相差小于预设值b，则利用该单组有效数据，采用球形定位方法，得到靶点a的位置；若单组有效数据中某一个数据与某个或多个预设节点与锚点的对应距离相差大于预设值c，则表示该单组有效数据为异常项，找到与该单组有效数据的其它3个初步测量距离值最接近的节点，利用该节点与4个锚点的距离值采用球形定位方法，得到靶点a位置。
[0073]
通俗来讲，显然，含有某个异常项的单组距离数据应有3项与某个或多个节点的锚点距离值极为接近(绝对差值《50mm，即上述预设值b),而另一项则相距甚远(绝对差值》300mm，即上述预设值c)，此为异常项。找到和该3项数据最为接近的节点，用此节点的锚点距离数据替换异常项。处理完毕后，即可利用球形算法估算靶点位置。
[0074]
若测得的单组数据和某个或多个节点的锚点距离值较为接近(四项数据的绝对差值均《50mm),则可视为该组数据不含异常项，可直接利用球形算法估算靶点位置。
[0075]
应理解，上述实施例中各步骤的序号的大小并不意味着执行顺序的先后，各过程的执行顺序应以其功能和内在逻辑确定，而不应对本技术实施例的实施过程构成任何限定。
[0076]
本实施例还提供一种信号干扰下超宽带精确定位装置，该信号干扰下超宽带精确定位装置与上述实施例中信号干扰下超宽带精确定位方法一一对应。该信号干扰下超宽带精确定位包括：
[0077]
数据预处理模块，设定三维坐标系，并获取三维坐标系下4个锚点的坐标，通过4个锚点的坐标确定靶点的活动范围；
[0078]
数据整定模块，在靶点活动范围内，针对某一具体位置的靶点a，采集n组有效数据，若n大于1，则找出各组数据中的异常项，然后用正常项的均值代替，得到整定后的有效数据，进入数据聚类模块；所述有效数据，具体指：靶点分别与4个锚点的4个初步测量距离值；若n＝1，则进入第二靶点位置计算模块；
[0079]
数据聚类模块，利用聚类方法将整定后的有效数据进行两次二维聚类，得到靶点a与4个锚点的精确测量距离值；
[0080]
第一靶点位置计算模块，根据靶点a与4个锚点的精确测量距离值，采用球形定位方法，得到靶点a的位置，流程结束；
[0081]
第二靶点位置计算模块，建立空间距离近似判断模型，利用空间距离近似判断模型结合球形定位方法，得到靶点a的位置。
[0082]
所述第二靶点位置计算模块，具体处理如下：所述空间距离近似判断模型由靶点活动范围内的若干个预设节点构成；若单组有效数据均与某个预设节点与4个锚点的对应距离相差小于预设值b，则利用该单组有效数据，采用球形定位方法，得到靶点a的位置；若单组有效数据中某一个数据与某个或多个预设节点与锚点的对应距离相差大于预设值c，则表示该单组有效数据为异常项，找到与该单组有效数据的其它3个初步测量距离值最接近的节点，利用该节点与4个锚点的距离值采用球形定位方法，得到靶点a位置。
[0083]
本发明还提供了一种计算机设备，其包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现上述信号干扰下超宽带精确定位的步骤，在此不再赘述。
[0084]
本发明还提供了一种计算机可读存储介质，所述计算机可读存储介质存储有计算机程序，所述计算机程序被处理器执行时实现上述信号干扰下超宽带精确定位的步骤，在此不再赘述。
[0085]
作为一种具体实施例，本方法能够在信号受干扰的情况下，对靶点位置进行精确估算。若设定靶点活动范围为(5m*5m*3m)，相邻节点轴坐标距离为0.1m，具体的估算精度为：当某位置测得多组可用数据时，此定位方法的2维(x、y)精度在0.07m左右，3维(x、y、z)精度在0.2m左右；若仅有一组可用数据，此定位方法的2维精度在0.08m左右，3维精度在0.3m左右。
[0086]
本发明的有益效果是：能够实现信号干扰下的超宽带(uwb)精确定位，尤其是当某个靶点位置上仅测得一组有效数据，且其中含有一个异常项时，仍然能够对靶点位置进行正确估算。
[0087]
以上所述本发明的具体实施方式，并不构成对本发明保护范围的限定。任何根据本发明的技术构思所做出的各种其他相应的改变与变形，均应包含在本发明权利要求的保护范围内。