法律状态公告日
法律状态信息
法律状态
2018-03-20
授权
授权
2015-12-09
实质审查的生效 IPC(主分类):G01S5/02 申请日:20150626
实质审查的生效
2015-11-11
公开
公开
技术领域
本发明涉及一种双标签高精度定位方法,特别是一种面向矿井运动目标的双标签高精 度定位方法。
背景技术
在现有矿井定位系统中,一般通过RSSI的方式测得定位目标与定位基站之间的距离, 然后通过几何的方法(如三边定位法)求得目标位置。然而,RSSI测距的精确度后衰落 效应的影响非常明显,致使测距精度很小,致使采用单标签的矿井定位系统的精度低下, 定位结果不稳定,存在严重的位置漂移。
矿井运动目标可根据其外形分成两类,第一类矿井运动目标是与巷道平行的长条状对 象,(如矿车、采煤机);第二类矿井运动目标是与巷道垂直的长条状对象,(如人员)。
发明内容
本发明的目的是要提供一种面向矿井运动目标的双标签高精度定位方法,解决单标签 的矿井定位系统的精度低下,定位结果不稳定,存在严重的位置漂移的问题。
本发明的目的是这样实现的:该双标签高精度定位方法包括:第一类矿井运动目标定 位方法和第二类矿井运动目标定位方法;所述方法在运动目标上水平或垂直安装两个定位 标签,并与沿巷道顶板安装的两个定位基站通信,通过构造标签与定位基站RSSI距离与 估计距离之间的优化函数并求解其最小值,实时得到运动目标的位置;
所述第一类矿井运动目标定位方法:在待定位目标的头部和尾部各安装一个定位标签 U1和U2,定位标签U1和U2之间的距离用L表示;定位出任何一个标签,即可知道目标在 巷道中的位置;每个标签都能同时与两个安装巷道顶板中线的定位基站B1和B2通信,将 定位基站B1和B2二点相连构成直线B1B2,定位标签U1和U2到直线B1B2的垂足分别为P1和 P2,|U1P1|=|U2P2|=H为标签到顶板中心的高度;目标在巷道中宽度维上忽略不计,建模为 一维定位,将定位标签U1和U2二点相连构成直线U1U2,以直线U1U2为横轴,U1的横坐标 为x,则U2的横坐标为x+L;纵轴为与巷道纵向中分平面向上的方向;求解出x在满足
xopt=minf(x)
条件下的xopt值,实现目标的定位。
所述第一类矿井运动目标定位方法的具体定位过程:
1)在待定位目标的头部和尾部各安装一个定位标签U1和U2;
2)构造优化函数
定位基站的坐标(xB,H)和(xB+LB,H)、基站之间的距离|B1B2|=LB是已知的;当定位标签 U1和U2的坐标分别为(x,0)和(x+L,0);xB≤x≤xB+LB;设B1与定位标签U1和U2的距离分 别为d11和d12,B2与定位标签U1和U2的距离分别为d21和d22,∠B1U1P1=θ,∠P1U1B2=α;
构造优化函数f(x):
(9)式右边先平方再开方的目的是为了保证每一项都为正,以免求和的时候正负抵消;其中, 为标签Ui,i=1,2的坐标,且
其中,PdBm是收发节点之间以dB为单位的功率路径损耗,是参考距离d0处测量到的功 率,通常d0=1m;χ为阴影效应导致的零均值高斯随机变量,在实际计算中可以将其忽略; η是路径损耗因子;因此,
于是,(9)式只有x未知。将U1、U2、B1、B2和dij代入(9)式,得:
如果定位结果是无偏估计,则|UiBj|=dij,从而使得f(x)=0;如果是有偏估计,应取 能够使得f(x)最小的x,即待定位目标位置xopt可以通过求解使得f(x)最小的x值获得:
xopt=minf(x)(13)
3)优化函数的求解
(1)通过单标签矿井目标定位方法获得迭代初值x0,
sinθ=(x-xB)/d11,cosθ=H/d11,sinα=(xB+LB-x)/d21,cosα=H/d21,
cosα=H/d21,sinα=(xB+LB-x)/d21,因此,
针对ΔB1U1B2,根据余弦定理,有:
利用一元二次方程求根公式解方程(15),并令其为迭代初值x0,得:
其中a=1,b=-(2xB+LB),根据xB≤x≤xB+LB,可以消 除一个解,得到唯一的迭代初值;
(2)通过双向迭代法获得最优解
以x0为起始点,令xi+1=xi±Δx,i=0,1,2,…,N,代入(12)式求得第i+1次迭代的f(x)值 fi+1(xi);其中,N为预设的最大迭代次数,Δx为迭代步长,若Δx取正号,则向B2的方向 迭代(右向迭代),反之则向B1的方向迭代即左向迭代;迭代起始的时候,xopt=x0;在迭 代过程中,若fi+1(xi)>fi(xi),则令xopt=xi+1,否则保持不变;为了加快迭代速度,这里同 时进行双向迭代;令分别对应右向迭代和左向迭代;
迭代遇到下列条件结束:(1)超过迭代次数超过阈值N,整个迭代过程终止;(2)若 但则右向迭代结束,只进行左向迭代;若但则左 向迭代结束,只进行右向迭代;(3)且整个迭代过程终止;(4)当f(x)≤fth的时候,整个迭代过程终止,其中fth是给定的距离误差阈值。
所述第二类矿井运动目标,步骤如下:
1)分别在待定位目标的头部、中部各安装一个定位标签U1和U2,并令|U1U2|=L,U1到B1B2的垂足P的距离|U1P|=H,|B1B2|=LB;
2)构造优化函数,待定位目标位置xopt=minf(x);
3)最优解的求解:
(1)利用
其中a=1,b=-(2xB+LB),根据xB≤x≤xB+LB,可 以消除一个解,得到唯一的迭代初值;
(2)通过双向迭代法获得最优解xopt。
有益效果,由于采用了上述方案,该方法在运动目标上水平或垂直安装两个定位标签, 并与沿巷道顶板安装的两个定位基站通信,通过构造标签与定位基站RSSI距离与估计距 离之间的优化函数并求解其最小值,实时得到运动目标的位置。优化函数的求解通过迭代 的方式完成,它包括迭代初值确定、左/右迭代两个步骤。克服单标签定位受矿井环境因 素较大的缺陷,显著提高定位精度。这些装备和人员完全可以安装两个甚至多个定位标签, 利用多个标签之间的空间约束提高定位精度。解决了单标签的矿井定位系统的精度低下, 定位结果不稳定,存在严重的位置漂移的问题,达到了本发明的目的。
优点:本发明采用双标签的方法进行矿井运动目标定位,仅需在待定位目标上添加一 个定位标签即可大幅提高定位精度,升级成本低,部署容易,适合于与巷道平行的长条状 对象(如矿车、采煤机),也适用于与巷道垂直的长条状对象(如人员)。
附图说明:
图1是本发明的第一类矿井运动目标双标签定位图。
图2是本发明的第二类矿井运动目标双标签定位图。
具体实施方式
实施例1:该双标签高精度定位方法包括:第一类矿井运动目标定位方法和第二类矿 井运动目标定位方法;所述方法在运动目标上水平或垂直安装两个定位标签,并与沿巷道 顶板安装的两个定位基站通信,通过构造标签与定位基站RSSI距离与估计距离之间的优 化函数并求解其最小值,实时得到运动目标的位置;
第一类矿井运动目标定位方法:在待定位目标的头部和尾部各安装一个定位标签U1和 U2,定位标签U1和U2之间的距离用L表示;定位出任何一个标签,即可知道目标在巷道 中的位置;每个标签都能同时与两个安装巷道顶板中线的定位基站B1和B2通信,将定位 基站B1和B2二点相连构成直线B1B2,定位标签U1和U2到直线B1B2的垂足分别为P1和P2, |U1P1|=|U2P2|=H为标签到顶板中心的高度;目标在巷道中宽度维上忽略不计,建模为一维 定位,将定位标签U1和U2二点相连构成直线U1U2,以直线U1U2为横轴,U1的横坐标为x, 则U2的横坐标为x+L;纵轴为与巷道纵向中分平面向上的方向;求解出x在满足
xopt=minf(x)
条件下的xopt值,实现目标的定位。
所述第一类矿井运动目标定位方法的具体定位过程:
1)在待定位目标的头部和尾部各安装一个定位标签U1和U2;
2)构造优化函数
定位基站的坐标(xB,H)和(xB+LB,H)、基站之间的距离|B1B2|=LB是已知的;当定位标签 U1和U2的坐标分别为(x,0)和(x+L,0);xB≤x≤xB+LB;设B1与定位标签U1和U2的距离分 别为d11和d12,B2与定位标签U1和U2的距离分别为d21和d22,∠B1U1P1=θ,∠P1U1B2=α;
构造优化函数f(x):
(9)式右边先平方再开方的目的是为了保证每一项都为正,以免求和的时候正负抵消;其中, 为标签Ui,i=1,2的坐标,且
其中,PdBm是收发节点之间以dB为单位的功率路径损耗,是参考距离d0处测量到的功 率,通常d0=1m;χ为阴影效应导致的零均值高斯随机变量,在实际计算中可以将其忽略; η是路径损耗因子;因此,
于是,(9)式只有x未知。将U1、U2、B1、B2和dij代入(9)式,得:
如果定位结果是无偏估计,则|UiBj|=dij,从而使得f(x)=0;如果是有偏估计,应取 能够使得f(x)最小的x,即待定位目标位置xopt可以通过求解使得f(x)最小的x值获得:
xopt=minf(x)(21)
3)优化函数的求解
(1)通过单标签目标定位方法获得迭代初值x0,
在图1中,sinθ=(x-xB)/d11,cosθ=H/d11,sinα=(xB+LB-x)/d21,cosα=H/d21,因此,
cosα=H/d21,sinα=(xB+LB-x)/d21,因此,
针对ΔB1U1B2,根据余弦定理,有:
利用一元二次方程求根公式解方程(15),并令其为迭代初值x0,得:
其中a=1,b=-(2xB+LB),根据xB≤x≤xB+LB,可以消 除一个解,得到唯一的迭代初值;
(2)通过双向迭代法获得最优解
以x0为起始点,令xi+1=xi±Δx,i=0,1,2,…,N,代入(12)式求得第i+1次迭代的f(x)值 fi+1(xi);其中,N为预设的最大迭代次数,Δx为迭代步长,若Δx取正号,则向B2的方向 迭代(右向迭代),反之则向B1的方向迭代即左向迭代;迭代起始的时候,xopt=x0;在迭 代过程中,若fi+1(xi)>fi(xi),则令xopt=xi+1,否则保持不变;为了加快迭代速度,这里同 时进行双向迭代;令分别对应右向迭代和左向迭代;
迭代遇到下列条件结束:(1)超过迭代次数超过阈值N,整个迭代过程终止;(2)若 但则右向迭代结束,只进行左向迭代;若但则左 向迭代结束,只进行右向迭代;(3)且整个迭代过程终止;(4)当f(x)≤fth的时候,整个迭代过程终止,其中fth是给定的距离误差阈值。
所述第二类矿井运动目标,步骤如下:
1)分别在待定位目标的头部、中部各安装一个定位标签U1和U2,并令|U1U2|=L,U1到B1B2的垂足P的距离|U1P|=H,|B1B2|=LB;
2)构造优化函数,待定位目标位置xopt=minf(x);
3)最优解的求解:
(1)利用
其中a=1,b=-(2xB+LB),根据xB≤x≤xB+LB,可 以消除一个解,得到唯一的迭代初值;
(2)通过双向迭代法获得最优解xopt。
机译: 面向对象的双标签高精度定位方法
机译: 使用双标签的高精度方法在矿山中移动目标位置
机译: 面向目标运动的自动练习目标以及使用该练习目标进行训练的方法