面向矿井运动目标的双标签高精度定位方法
【技术领域】
[0001] 本发明涉及一种双标签高精度定位方法，特别是一种面向矿井运动目标的双标签 高精度定位方法。
【背景技术】
[0002] 在现有矿井定位系统中，一般通过RSSI的方式测得定位目标与定位基站之间的 距离，然后通过几何的方法（如三边定位法）求得目标位置。然而，RSSI测距的精确度后衰 落效应的影响非常明显，致使测距精度很小，致使采用单标签的矿井定位系统的精度低下， 定位结果不稳定，存在严重的位置漂移。
[0003] 矿井运动目标可根据其外形分成两类，第一类矿井运动目标是与巷道平行的长条 状对象，（如矿车、采煤机）；第二类矿井运动目标是与巷道垂直的长条状对象，（如人员）。
【发明内容】
[0004] 本发明的目的是要提供一种面向矿井运动目标的双标签高精度定位方法，解决单 标签的矿井定位系统的精度低下，定位结果不稳定，存在严重的位置漂移的问题。
[0005] 本发明的目的是这样实现的：该双标签高精度定位方法包括：第一类矿井运动目 标定位方法和第二类矿井运动目标定位方法；所述方法在运动目标上水平或垂直安装两个 定位标签，并与沿巷道顶板安装的两个定位基站通信，通过构造标签与定位基站RSSI距离 与估计距离之间的优化函数并求解其最小值，实时得到运动目标的位置；
[0006] 所述第一类矿井运动目标定位方法：在待定位目标的头部和尾部各安装一个定位 标签仏和U 2，定位标签仏和U 2之间的距离用L表示；定位出任何一个标签，即可知道目标 在巷道中的位置；每个标签都能同时与两个安装巷道顶板中线的定位基站队和B 2通信，将 定位基站队和B 2二点相连构成直线B此，定位标签仏和U 2到直线B此的垂足分别为P挪 P2, IU1P1I = IU2P2I =H为标签到顶板中心的高度；目标在巷道中宽度维上忽略不计，建模 为一维定位，将定位标签仏和U 2二点相连构成直线U ，以直线U1U2为横轴，U i的横坐标为 X，则U2的横坐标为x+L ;纵轴为与巷道纵向中分平面向上的方向；求解出X在满足
[0007] x〇pt= min f (X)
[0008] 条件下的、值，实现目标的定位。
[0009] 所述第一类矿井运动目标定位方法的具体定位过程：
[0010] 1)在待定位目标的头部和尾部各安装一个定位标签仏和U2;
[0011] 2)构造优化函数
[0012] 定位基站的坐标（xB, H)和（xB+LB, H)、基站之间的距离IB1B2I = Lb是已知的；当 定位标签仏和U 2的坐标分别为（X, 0)和（x+L, 0) ;x X彡X B+LB;S B i与定位标签U挪 U2的距离分别为d η和d 12, B2与定位标签U JP U 2的距离分别为d 21和d 22, Z B1U1P1= Θ， ZP1U1B2= α ;
[0013] 构造优化函数f(x):
[0015] (9)式右边先平方再开方的目的是为了保证每一项都为正，以免求和的时候正负 抵消；其中，(>,)为标签Ui, i = 1，2的坐标，且
为定位基站Bj, j = 1，2 的坐标，且-Ybi 这些量中，（.Y1J1 ,.Vui )是已 知条件，Clu可用RSSI的方式得到；节点i、j之间的RSS值遵循对数正态阴影模型：
[0017] 其中，PdBm是收发节点之间以dB为单位的功率路径损耗，Ifm是参考距离d。处测 量到的功率，通常d。= lm; X为阴影效应导致的零均值高斯随机变量，在实际计算中可以 将其忽略；η是路径损耗因子；因此，
[0021] 如果定位结果是无偏估计，则IUiB^ = du，从而使得f (X) = 0 ;如果是有偏估计， 应取能够使得f(x)最小的X，即待定位目标位置Xcipt可以通过求解使得f(x)最小的X值获 得：
[0023] 3)优化函数的求解
[0024] (1)通过单标签矿井目标定位方法获得迭代初值X。，
可以消除一个解，得到唯一的迭代初值；
[0034] (2)通过双向迭代法获得最优解
[0035] 以X。为起始点，令X i+1= X i± Ax，i = 〇, 1，2, "·，Ν，代入（12)式求得第i+Ι次迭 代的f(x)值f1+1(Xl);其中，N为预设的最大迭代次数，Δ Χ为迭代步长，若ΔΧ取正号，则 向B2的方向迭代（右向迭代），反之则向B 1的方向迭代即左向迭代；迭代起始的时候，Xcipt =X。;在迭代过程中，若f i+1(Xi) > fi (Xi)，则令Xcipt= X i+1，否则保持不变；为了加快迭代速 度，这里同时进行双向迭代；令Λ二=χ:+Δχ，分别对应右向迭代和左向迭代；
[0036] 迭代遇到下列条件结束：（1)超过迭代次数超过阈值Ν，整个迭代过程终止；（2) 若4 但则右向迭代结束，只进行左向迭代；若，则 左向迭代结束，只进行右向迭代；（3) Λ'：；ρ λβ U^且Λ,;+^λΒ，整个迭代过程终止；（4)当 f(x)彡fth的时候，整个迭代过程终止，其中f th是给定的距离误差阈值。
[0037] 所述第二类矿井运动目标，步骤如下：
[0038] 1)分别在待定位目标的头部、中部各安装一个定位标签仏和U 2，并令IU1U21 = L， 1^到B此的垂足P的距尚IU f I = H，IB1B21 = Lb;
[0039] 2)构造优化函数，待定位目标位置Xcipt= min f (X);
[0040] 3)最优解的求解：
可以消除一个解，得到唯一的迭代初值；
[0043] (2)通过双向迭代法获得最优解Xcipt。
[0044] 有益效果，由于采用了上述方案，该方法在运动目标上水平或垂直安装两个定位 标签，并与沿巷道顶板安装的两个定位基站通信，通过构造标签与定位基站RSSI距离与估 计距离之间的优化函数并求解其最小值，实时得到运动目标的位置。优化函数的求解通过 迭代的方式完成，它包括迭代初值确定、左/右迭代两个步骤。克服单标签定位受矿井环境 因素较大的缺陷，显著提高定位精度。这些装备和人员完全可以安装两个甚至多个定位标 签，利用多个标签之间的空间约束提高定位精度。解决了单标签的矿井定位系统的精度低 下，定位结果不稳定，存在严重的位置漂移的问题，达到了本发明的目的。
[0045] 优点：本发明采用双标签的方法进行矿井运动目标定位，仅需在待定位目标上添 加一个定位标签即可大幅提高定位精度，升级成本低，部署容易，适合于与巷道平行的长条 状对象（如矿车、采煤机），也适用于与巷道垂直的长条状对象（如人员）。
【附图说明】：
[0046] 图1是本发明的第一类矿井运动目标双标签定位图。
[0047] 图2是本发明的第二类矿井运动目标双标签定位图。
【具体实施方式】
[0048] 实施例1 :该双标签高精度定位方法包括：第一类矿井运动目标定位方法和第二 类矿井运动目标定位方法；所述方法在运动目标上水平或垂直安装两个定位标签，并与沿 巷道顶板安装的两个定位基站通信，通过构造标签与定位基站RSSI距离与估计距离之间 的优化函数并求解其最小值，实时得到运动目标的位置；
[0049] 第一类矿井运动目标定位方法：在待定位目标的头部和尾部各安装一个定位标签 仏和U 2，定位标签仏和U 2之间的距离用L表示；定位出任何一个标签，即可知道目标在巷 道中的位置；每个标签都能同时与两个安装巷道顶板中线的定位基站队和B 2通信，将定位 基站队和B 2二点相连构成直线B此，定位标签UjP U 2到直线B此的垂足分别为P JP P 2， U1P1I = IU2P2I =H为标签到顶板中心的高度；目标在巷道中宽度维上忽略不计，建模为一 维定位，将定位标签仏和U 2二点相连构成直线U A，以直线U1U2为横轴，U i的横坐标为X， 则U2的横坐标为x+L ;纵轴为与巷道纵向中分平面向上的方向；求解出X在满足
[0050] x〇pt= min f (X)
[0051] 条件下的、值，实现目标的定位。
[0052] 所述第一类矿井运动目标定位方法的具体定位过程：
[0053] 1)在待定位目标的头部和尾部各安装一个定位标签仏和U 2;
[0054] 2)构造优化函数
[0055] 定位基站的坐标（XB, H)和（XB+LB, H)、基站之间的距离IB1B2I = Lb是已知的；当 定位标签仏和U 2的坐标分别为（X, 0)和（x+L, 0) ;x X彡X B+LB;S B i与定位标签U挪 U2的距离分别为d η和d 12, B2与定位标签U JP U 2的距离分别为d 21和