CN106997039B - 虚拟平面约束下重构一维空间的煤矿井下toa定位方法 - Google Patents
虚拟平面约束下重构一维空间的煤矿井下toa定位方法 Download PDFInfo
- Publication number
- CN106997039B CN106997039B CN201610039858.8A CN201610039858A CN106997039B CN 106997039 B CN106997039 B CN 106997039B CN 201610039858 A CN201610039858 A CN 201610039858A CN 106997039 B CN106997039 B CN 106997039B
- Authority
- CN
- China
- Prior art keywords
- positioning
- value
- underground
- roadway
- toa
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
Abstract
煤矿井下多径影响严重,造成TOA测距结果具有非零均值的误差,影响井下定位系统的定位精度。为了解决该问题,提高井下TOA定位系统的定位精度,本发明提供了一种虚拟平面约束下重构一维空间的煤矿井下TOA定位方法:沿巷道延伸方向为x轴,巷道宽方向为y轴,建立测距平面,利用二维虚拟空间y方向的冗余信息重构解点x方向的估计值,重构后测距误差转移到解点的y方向,而解点的x估计值受到测距平面约束而向x真实值趋近,减少了x方向的定位误差,以最终的x估计值作为定位结果,实现巷道内的一维定位。本发明减少了常规定位所需要的基站数,有效挖掘了二维空间的冗余信息,显著提高定位精度,特别适用于煤矿狭长空间的定位。
Description
技术领域
本发明涉及一种在煤矿井下进行精确定位的方法,具体是通过TOA测距方式获得移动节点与2个固定基站的距离,将该2个基站确定的定位平面按巷道走向重构一维空间,从而实现在巷道内的精确定位。属无线电定位技术领域,适用于煤矿井下工作人员及设备定位系统的开发。
背景技术
多数精确定位系统是通过测量到达时间(Time-Of-Arrival,TOA)来获取发射节点与定位节点之间的距离,换言之,测量TOA是最有效最准确获取收发双方距离的方法。扩频测距是应用广泛的一种TOA测距方法,它是通过码相关运算来获取TOA信息的,然而在煤矿井下多径环境下,如图1所示,扩频码理想的相关图呈三角形,而在多径严重的实际情况下呈钟形,且相关峰明显延迟。虽然扩频技术具有突出的抗多径干扰的能力,但对于这种无线传播的额外延迟给TOA的测量带来的测量误差的情况却没有好的解决方法。特别地,这种由于额外延迟造成的测量误差的均值不为零,而目前很多成熟的定位跟踪算法要求距离的测量值具有均值为0的测量误差,因此,研究能够抑制非零均值测量误差的定位方法,提高定位精度,无疑对煤矿井下人员定位系统的建设与开发具有重要意义。
发明内容
为了解决煤矿井下严重的多径影响造成距离测量结果有偏移误差从而影响井下人员定位系统的定位精度问题,本发明提供了一种虚拟平面约束下重构一维空间的TOA定位方法。方法考虑到实际矿井巷道狭长,井下定位系统只需要知道在巷道的哪一段,并不关心该移动点究竟是在巷道中的偏左还是偏右,因此,方法的解决思路是忽略巷道宽度定位信息,将测距误差转移到巷道宽方向定位上,从而保证巷道长方向的定位精度。
为实现上述目的,本发明的技术方案是:将定位基站沿巷道的同一侧分布,沿巷道延伸方向设为x轴,巷道宽方向设为y轴,建立测距平面;
所述的定位基站通过TOA测距获得移动目标与基站的伪距,即带有测量误差的距离值;
采用2站测距平面定位,得到测距平面上的2个测量方程,求解所述测量方程所获得的解点视为虚拟位置估计点,所述的虚拟位置估计点所在测距平面视为虚拟平面;
巷道为狭长空间,忽略其宽度,视为一维空间,利用二维虚拟空间y方向的冗余信息重构解点x方向的估计值,重构后解点的x方向估计值受到测距平面约束而向x真实值趋近,减少了x方向的定位误差;
丢弃所述重构后解点的y方向估计值,其x方向的值即是对移动目标在巷道位置的估计,从而实现在巷道内的一维定位。
所述的虚拟平面约束下重构一维空间的定位算法,具体包括以下步骤:
(2)设置位置估计值中的y值浮动区间:y_mean-dadj*y_dev<Deltay<y_mean+dadj*y_dev,其中,Deltay表示y值浮动区间的一个变量,y_mean表示y估值的均值,y_dev表示y估值的方差,dadj是调节系数;设置监视计数器Cmonitor初值为零;
(3)泰勒级数迭代法求解测量方程,得到解点的位置Pv(x,y)
(4)判断解点位置的y值是否落在给定的y值浮动区间,如果是,转步骤(7);如果不是,转入步骤(5);
(6)判断Cmonitor是否大于7,如果否,转转步骤(3),如果是,转转步骤(7)
(7)接受解点Pv(x,y)的估计结果,丢弃y值数据,x值即表示移动目标在巷道真实值的估计。
所述的TOA测距是采用扩频测距技术实现的,由定位基站接收移动目标发射的扩频信号并由定位基站对此扩频信号进行码相关运算获得信号的到达时间,进而将到达时间值换算成移动目标到定位基站的伪距。
无论巷道是否严格直线,均以巷道的实际长度作为X轴坐标值。
本发明有以下3点有益效果:
1.显著降低了TOA定位系统的硬件要求。现有的定位算法,例如基于最小二乘法的定位算法、基于滤波的定位算法、质心算法等等,算法的实现至少需要3个定位基站参与甚至更多,而本发明提供的方法仅需要2个定位基站参与,降低了TOA定位系统的硬件要求。
2.能有效抑制非视距传播(Non-line of sight,NLOS)所造成的定位误差。事实上,在矿井下,有些情况下,NLOS信号也是有益的,本发明提供的方法的主要功能即是消除额外延迟带来的测距偏移误差,因此,本方法能够统一NLOS与NOS场景,不作区别地完成这两种情况下的定位。
3.提供了具有零均值误差的定位结果,为其它成熟的定位算法应用于井下作出了基础性的工作。
附图说明
图1是本发明所涉及的扩频码相关图。
图2是本发明虚拟测距平面约束一维定位的场景示意图。
图3是本发明定位方法的流程图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
图2是本发明虚拟测距平面约束一维定位的场景示意图,采用2站测距平面定位,定位基站B1、B2设在巷道的同一侧,以巷道延伸方向为x轴,沿巷道宽方向为y轴建立平面坐标系,现需要定位R_p2移动目标点,d1和d2是经TOA测量得到的目标节点到基站B1和B2的距离,由于多径的影响,这个测量的距离值是带误差的,不是准确的距离值,在此称之为伪距,假设测距无误差,那么目标位置一定位于以基站为圆心,距离为半径的圆上,那么,两个圆位置线的交点就是移动目标点的位置。可以看到,由于是得到的d1和d2是伪距,交点V_p2不在巷道内,而是在巷道外,显然这是一个不存在的位置点,称之为虚拟位置点,它所在的平面,称之为虚拟平面。可以清楚地看到,尽管得到的交点是虚拟的,如果把巷道看成是一维的,它向x轴的投影x2却能比较准确地反映出移到目标节点在巷道的真实位置。由于伪距误差的存在,而这个伪距误差是非零均值的,那么,它必定会导致定位的点落在虚拟平面Δy的范围内。显然,R_p1、R_p2和R_p3的定位点V_p1、V_p2、V_p3均落在Δy的范围内。向x轴投影操作隐含了对伪距的纠偏操作,如果能适当调整伪距,保证交点落在Δy的范围内,则能有效地减少x值的随机误差。
图3本发明定位方法的流程图,联系图2给出实施例。假设欲对R_p2移动目标点实行定位,由以下步骤完成:
(1)B1、B2得到伪距d1、d2,建立测量方程:
其中(x1,y1)(x2,y2)分别为b1和b2的坐标,(x,y)是移动目标点R_p2的坐标。联立①、②方程可解出(x,y),当然解点并不一定能保证接近R_p2的真实值。因此,接下来的工作就是确保解点接近真实值。
(2)要确定Δy的范围,Δy的范围由下式给出:
y_mean-dadj*y_dev<Deltay<y_mean+dadj*y_dev
其中,y_mean表示y估值的均值,可先由实测或者理论推导获得,y_dev表示y估值的方差,也可先由实测或者理论推导获得,之后这两个参数可由实测值不断修正更新。dadj是调节系数,调节系数主要是根据移动目标的伪距进一步微调Δy的范围,这是因为移动目标所处的位置会对Δy的范围变化有一些小的影响;设置监视计数器Cmonitor初值为零。
(3)适当调整伪距以减少系统的结构性误差,所谓结构性误差是指移动目标离某一个基站较近,那么这时的定位行为与移动目标处在两定位基站中间有所不同,需要适当调整,调整方式是适当加长近端的伪距值,同时适当减少远端的伪距值,以使二者定位行为趋于一致。
(4)利用泰勒级数迭代法求解测量方程,如果不收敛,说明伪距误差过大,已超过算法所能调节的范围,给出报错信息,本次定位结果无效。
如果是第一次迭代收敛,可以得到解点的位置V_p2(x,y),此时将y值送存储器存储,这些存储的y值数据可以用来求出y的均值和方差。
如果是第二次及二次以后迭代不收敛,则以前次收敛所得到的解点的位置V_p2(x,y)表示此次迭代的结果。
(5)判断解点位置V_p2(x,y)的y值是否落在给定的y值浮动区间,是,转步骤(8);
(6)将Cmonitor增1,对伪距d1、d2分别加权处理,d1=weightvalue*d1,d2=weightvalue*d2,其中weightvalue为加权系数,由下式确定:
(7)判断Cmonitor是否大于7,否,转转步骤(4)
(8)接受解点Pv(x,y)的估计结果,丢弃y值数据,x值即表示移动目标在巷道真实值的估计;
下面给出一个具体的实施例:
定位基站B1坐标为(0,0),基站B2坐标为(0,32.48),移动目标点在[2.24 30.24]范围内利用本方法定位51次,统计数据如下:伪距d1的误差均值为1.8541,伪距d2的误差均值为1.8227m,定位误差均值为0.0141m,伪距d1的误差方差为0.9479,伪距d2的误差方差为17.0957,定位平均误差为0.9277m。可以看出,尽管伪距具有非零均值的误差,本发明所提供的方法定位误差均值接近于0,定位误差主要是随机误差,说明本方法能有效抑制偏移误差;另外,伪距d2的误差方差为17.0957,说明d2的测量起伏较大,但仍对本算法不造成大的影响,定位平均误差在1m以内。
Claims (3)
1.一种虚拟平面约束下重构一维空间的煤矿井下TOA定位方法,其特征在于,将定位基站沿巷道的同一侧分布,沿巷道延伸方向设为x轴,巷道宽方向设为y轴,建立测距平面,定位基站通过TOA测距获得移动目标与基站的伪距,即带有测量误差的距离值,采用2站测距平面定位,得到测距平面上的2个测量方程,求解测量方程所获得的解点视为虚拟位置估计点,虚拟位置估计点所在测距平面视为虚拟平面;
巷道为狭长空间,忽略其宽度,视为一维空间,利用虚拟平面y方向的冗余信息重构解点x方向的估计值,重构后解点的x方向估计值受到虚拟平面约束而向x真实值趋近,减少了x方向的定位误差;
所述的虚拟平面约束下重构一维空间的煤矿井下TOA定位方法,具体包括以下步骤:
(2)设置位置估计值中的y值浮动区间:
y_mean-dadj*y_dev<Deltay<y_mean+dadj*y_dev,其中,Deltay表示y值浮动区间的一个变量,y_mean表示y估值的均值,y_dev表示y估值的方差,dadj是调节系数;设置监视计数器Cmonitor初值为零;
(3)泰勒级数迭代法求解测量方程,得到解点的位置Pv(x,y);
(4)判断解点位置的y值是否落在给定的y值浮动区间,如果是,转步骤(7),如果不是,进入步骤(5);
(6)判断Cmonitor是否大于7,如果否,转步骤(3),如果是,进入步骤(7);
(7)接受解点Pv(x,y)的估计结果,丢弃y值数据,以x值作为移动目标在巷道真实值的估计。
2.根据权利要求1所述的一种虚拟平面约束下重构一维空间的煤矿井下TOA定位方法,其特征在于,所述的TOA测距是采用扩频测距技术实现的,由定位基站接收移动目标发射的扩频信号并由定位基站对此扩频信号进行码相关运算获得信号的到达时间,进而将到达时间值换算成移动目标到定位基站的伪距。
3.根据权利要求2所述的一种虚拟平面约束下重构一维空间的煤矿井下TOA定位方法,其特征在于,无论巷道是否严格直线,均以巷道的实际长度作为x轴坐标值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610039858.8A CN106997039B (zh) | 2016-01-22 | 2016-01-22 | 虚拟平面约束下重构一维空间的煤矿井下toa定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610039858.8A CN106997039B (zh) | 2016-01-22 | 2016-01-22 | 虚拟平面约束下重构一维空间的煤矿井下toa定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106997039A CN106997039A (zh) | 2017-08-01 |
CN106997039B true CN106997039B (zh) | 2021-09-21 |
Family
ID=59428088
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610039858.8A Active CN106997039B (zh) | 2016-01-22 | 2016-01-22 | 虚拟平面约束下重构一维空间的煤矿井下toa定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106997039B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110113712B (zh) * | 2019-05-16 | 2020-12-04 | 成都精位科技有限公司 | 定位处理方法及装置 |
CN110677805B (zh) * | 2019-09-25 | 2021-08-03 | 南京沃旭通讯科技有限公司 | 适于煤矿井下的定位方法和系统 |
CN111830462B (zh) * | 2020-07-06 | 2022-09-06 | 中建三局绿色产业投资有限公司 | 一种应用于排水深隧工程水下机器人定位的方法及装置 |
CN115267667B (zh) * | 2022-09-28 | 2023-04-07 | 长沙迪迈数码科技股份有限公司 | 井下高精度定位修正方法、装置、设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101354435A (zh) * | 2008-09-05 | 2009-01-28 | 清华大学 | 基于距离大小顺序关系的传感器网络节点自定位方法 |
CN102711040A (zh) * | 2012-06-01 | 2012-10-03 | 中国矿业大学(北京) | 基于无线传感器网络的煤矿井下一维定位方法和系统 |
CN202600134U (zh) * | 2012-06-01 | 2012-12-12 | 中国矿业大学(北京) | 煤矿井下超宽带定位系统 |
CN103052153A (zh) * | 2012-12-31 | 2013-04-17 | 中国矿业大学(北京) | 一种基于TOA的煤矿井下WiFi人员定位系统及定位方法 |
CN104333905A (zh) * | 2014-11-03 | 2015-02-04 | 中国矿业大学(北京) | 一种抑制巷道nlos时延误差的toa井下人员定位系统及方法 |
CN103152695B (zh) * | 2013-02-04 | 2015-06-10 | 太原理工大学 | 基于td-scdma系统的井下人员精确定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101770009B (zh) * | 2009-01-06 | 2014-05-21 | 成都西谷曙光数字技术有限公司 | 一种精确射频定位系统 |
-
2016
- 2016-01-22 CN CN201610039858.8A patent/CN106997039B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101354435A (zh) * | 2008-09-05 | 2009-01-28 | 清华大学 | 基于距离大小顺序关系的传感器网络节点自定位方法 |
CN102711040A (zh) * | 2012-06-01 | 2012-10-03 | 中国矿业大学(北京) | 基于无线传感器网络的煤矿井下一维定位方法和系统 |
CN202600134U (zh) * | 2012-06-01 | 2012-12-12 | 中国矿业大学(北京) | 煤矿井下超宽带定位系统 |
CN103052153A (zh) * | 2012-12-31 | 2013-04-17 | 中国矿业大学(北京) | 一种基于TOA的煤矿井下WiFi人员定位系统及定位方法 |
CN103152695B (zh) * | 2013-02-04 | 2015-06-10 | 太原理工大学 | 基于td-scdma系统的井下人员精确定位方法 |
CN104333905A (zh) * | 2014-11-03 | 2015-02-04 | 中国矿业大学(北京) | 一种抑制巷道nlos时延误差的toa井下人员定位系统及方法 |
Non-Patent Citations (2)
Title |
---|
《基于WiFi 和计时误差抑制的TOA 煤矿井下目标定位方法》;孙继平等;《煤炭学报》;20140131;第39卷(第1期);全文 * |
《基于卡尔曼滤波和指纹定位的矿井TOA定位方法》;孙继平等;《中国矿业大学学报》;20141130;第43卷(第6期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN106997039A (zh) | 2017-08-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107817469B (zh) | 基于非视距环境下超宽频测距实现室内定位方法 | |
CN106997039B (zh) | 虚拟平面约束下重构一维空间的煤矿井下toa定位方法 | |
US9407317B2 (en) | Differential ultra-wideband indoor positioning method | |
CN109613584B (zh) | 基于uwb的无人集卡的定位定向方法 | |
CN104640204B (zh) | 一种非直达波环境下无线传感器网络节点定位方法 | |
CN204166130U (zh) | 射频定位装置和系统 | |
CN106886039B (zh) | 基于城市三维地图的地面数字电视广播与导航卫星混合粒子滤波定位方法 | |
CN107071896B (zh) | 一种利用非视距信号实现煤矿弯曲巷道目标定位方法 | |
CN107820206B (zh) | 基于信号强度的非视距定位方法 | |
CN110954865A (zh) | 一种基于电离层信息的短波时差定位方法 | |
KR100977246B1 (ko) | 순방향 링크 aoa를 이용한 위치 추정 장치 및 방법 | |
Toth et al. | Positioning slow-moving platforms by UWB technology in GPS-challenged areas | |
CN104968046A (zh) | 一种基于共面度的跳距修正的wsn三维空间目标定位方法 | |
KR20140126790A (ko) | 무선 센서 네트워크 기반의 위치 추정방법 | |
CN104267420B (zh) | 一种星载对运动目标的三维定位方法、装置和系统 | |
CN113038364A (zh) | 一种基于uwb技术的tdoa与ds_twr结合的井下二维定位方法 | |
CN107703482A (zh) | 一种闭式解与迭代算法相结合的aoa定位方法 | |
CN114501300A (zh) | 一种基于空间环境误差模型的分布式定位算法 | |
CN115379558A (zh) | 一种基于粒子群优化乌鸦算法的移动台位置估计方法 | |
Chengdong et al. | A RSSI-based probabilistic distribution localization algorithm for wireless sensor network | |
CN109270489B (zh) | 基于uwb的nlos隧道环境下的实时连续定位方法 | |
Li et al. | Research on improved UWB localization algorithm in NLOS environment | |
CN105137393A (zh) | 一种用于网络的空间多传感器快速定位方法 | |
CN110596640B (zh) | 一种基于单基站双标签测距的一维定位系统及方法 | |
Liu et al. | Research on the positioning method of autonomous mobile robot in structure space based on UWB |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |