CN109282816B - 一种利用三角形约束的测距定位误差抑制方法 - Google Patents

一种利用三角形约束的测距定位误差抑制方法 Download PDF

Info

Publication number
CN109282816B
CN109282816B CN201811119360.8A CN201811119360A CN109282816B CN 109282816 B CN109282816 B CN 109282816B CN 201811119360 A CN201811119360 A CN 201811119360A CN 109282816 B CN109282816 B CN 109282816B
Authority
CN
China
Prior art keywords
distance
target
distance measurements
triangle
corrected
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
Application number
CN201811119360.8A
Other languages
English (en)
Other versions
CN109282816A (zh
Inventor
万群
何龙
王新蕊
李鹏杰
李俊霖
马迎辉
安东
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Ordnance Equipment Group Ordnance Equipment Research Institute
University of Electronic Science and Technology of China
Original Assignee
China Ordnance Equipment Group Ordnance Equipment Research Institute
University of Electronic Science and Technology of China
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China Ordnance Equipment Group Ordnance Equipment Research Institute, University of Electronic Science and Technology of China filed Critical China Ordnance Equipment Group Ordnance Equipment Research Institute
Priority to CN201811119360.8A priority Critical patent/CN109282816B/zh
Publication of CN109282816A publication Critical patent/CN109282816A/zh
Application granted granted Critical
Publication of CN109282816B publication Critical patent/CN109282816B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Mobile Radio Communication Systems (AREA)

Abstract

本发明属于电子信息技术领域,涉及一种利用三角形约束的测距定位误差抑制方法。本发明的方法先判断待定位的目标到两个基站的两个距离测量是否满足三角形的三个不等式,再根据判断结果对2个距离测量进行校正,确定校正的两个距离测量,最后,利用校正的两个距离测量对目标进行位置估计。本发明在不改变现有的测距定位系统的硬件情况下,只需要对现有的距离测量进行校正处理即可实现对测距定位误差的抑制,达到提高定位精度的目的。

Description

一种利用三角形约束的测距定位误差抑制方法
技术领域
本发明属于电子信息技术领域,具体涉及一种利用三角形约束判断距离测量误差并进行校正从而抑制测距定位误差的方法。
背景技术
测距定位是无线电定位领域的常用技术之一,在无线传感器网络节点相对定位、室内定位中具有重要应用价值。在复杂传播环境和干扰环境中,由于测距误差较大,导致测距定位精度不高。此外,当目标位于两个基站的连线附近时,由于几何精度衰减因子较大,测距定位误差对测距误差十分敏感,导致测距定位误差很大。
发明内容
本发明提出一种利用三角形约束的测距定位误差抑制方法,先判断待定位的目标到两个基站的两个距离测量是否满足三角形的三个不等式,再根据判断结果对2个距离测量进行校正,确定校正的两个距离测量,最后,利用校正的两个距离测量对目标进行位置估计。本发明在不改变现有的测距定位系统的硬件情况下,只需要对现有的距离测量进行校正处理即可实现对测距定位误差的抑制,达到提高定位精度的目的。
为实现上述技术目的,本发明采用如下技术方案进行实现。
一种利用三角形约束的测距定位误差抑制方法如下:
步骤1:初始化设置,将两个基站的位置坐标、基站之间的距离、对目标的两个距离测量写入主机内存;
步骤2:判断由两个基站和目标构成的三角形的三边是否满足构成三角形的三边约束;
步骤3:根据步骤2的判断结果,对2个距离测量进行校正,确定校正的2个距离测量;
步骤4:利用校正的2个距离测量,确定目标的位置估计。
进一步地,所述步骤1的具体执行过程如下:
初始化设置,将第一个基站的位置坐标(0,0)、第二个基站的位置坐标(0,L)、基站之间的距离L、目标到第一个基站的距离测量a、目标到第二个基站的距离测量b写入主机内存;
进一步地,所述步骤2的具体执行过程如下:
判断由两个基站和目标构成的三角形的三边L、a、b是否满足构成三角形的三边约束,即是否同时满足如下不等:
a-b≤L,b-a≤L,a+b≥L
进一步地,所述步骤3的具体执行过程如下:
根据步骤2的判断结果,若满足构成三角形的三边约束,则确定校正的两个距离测量,分别为:
Figure BDA0001810354940000021
其中
Figure BDA0001810354940000022
分别为校正的两个距离测量;若不满足构成三角形的三边约束,则确定校正的两个距离测量,分别为:
(1)
Figure BDA0001810354940000023
当b-a>L;
(2)
Figure BDA0001810354940000024
当a-b>L;
(3)
Figure BDA0001810354940000025
当b+a<L;
进一步地,所述步骤4的具体执行过程如下:
利用校正的2个距离测量,确定目标的位置估计,横坐标为:
Figure BDA0001810354940000026
纵坐标为:
Figure BDA0001810354940000027
其中,
Figure BDA0001810354940000028
分别为校正的两个距离测量。
与现有技术相比,本发明方案的有益效果是:
在不改变现有的测距定位系统的硬件情况下,只需要对现有的距离测量进行是否满足构成三角形的三边约束的判断和校正处理,即可实现对测距定位误差的抑制,从而达到提高定位精度的目的。
具体实施方式
下面结合实施例,对本发明作进一步的详细描述:
实施例
本例中的目标实际位置坐标为(3.5,0.5),第一个基站的位置坐标(0,0),第二个基站的位置坐标(0,1),基站之间的距离为1,目标到第一个基站的距离测量为3.6071,目标到第二个基站的距离测量为2.5517。
本发明的具体实施方式流程如下:
步骤1:将第一个基站的位置坐标(0,0)、第一个基站的位置坐标(0,1)、基站之间的距离L=1、目标到第一个基站的距离测量a=3.6071、目标到第二个基站的距离测量b=2.5517写入主机内存;
步骤2:判断由两个基站和目标构成的三角形的三边是否满足构成三角形的三边约束,由于a-b=3.6071-2.5517>1,所以判断结果是不满足;
步骤3:根据步骤2的判断结果,对2个距离测量进行校正,确定校正的2个距离测量,为:
(2)
Figure BDA0001810354940000031
当a-b>L;
步骤4:利用校正的2个距离测量,确定目标的位置估计,横坐标为:
Figure BDA0001810354940000032
纵坐标为:
y=0
可见,本发明确定的目标位置估计为(3.5794,0),横坐标误差为0.0794,纵坐标误差为-0.5,估计的目标与实际目标之间的距离为0.5063。若直接使用2个距离测量,则横坐标误差为0.25,纵坐标误差为-0.5,估计的目标与实际目标之间的距离为0.5590。可见,本发明方法确定的目标位置估计的误差降低了9.43%。

Claims (2)

1.一种利用三角形约束的测距定位误差抑制方法,其特征在于,包括以下步骤:
S1、初始化:获取两个基站的位置坐标、基站之间的距离、两个基站分别对目标的距离测量;具体参数为:第一个基站的位置坐标(0,0)、第二个基站的位置坐标(0,L)、基站之间的距离L、目标到第一个基站的距离测量a、目标到第二个基站的距离测量b;
S2、判断由两个基站和目标构成的三角形的三边L、a、b是否满足构成三角形的三边约束,即是否同时满足如下不等:
a-b≤L,b-a≤L,a+b≥L;
S3、根据步骤S2的判断结果,对2个距离测量进行校正,确定校正的2个距离测量;具体为,确定校正的两个距离测量,分别为:
Figure FDA0003274244810000011
其中
Figure FDA0003274244810000012
分别为校正的两个距离测量;若不满足构成三角形的三边约束,则确定校正的两个距离测量,分别为:
(1)
Figure FDA0003274244810000013
当b-a>L;
(2)
Figure FDA0003274244810000014
当a-b>L;
(3)
Figure FDA0003274244810000015
当b+a<L
S4、利用校正的2个距离测量,确定目标的位置估计。
2.根据权利要求1所述的一种利用三角形约束的测距定位误差抑制方法,其特征在于,步骤S4中,利用校正的2个距离测量,确定目标的位置估计,横坐标为:
Figure FDA0003274244810000016
纵坐标为:
Figure FDA0003274244810000017
其中,
Figure FDA0003274244810000021
分别为校正的两个距离测量。
CN201811119360.8A 2018-09-25 2018-09-25 一种利用三角形约束的测距定位误差抑制方法 Active CN109282816B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811119360.8A CN109282816B (zh) 2018-09-25 2018-09-25 一种利用三角形约束的测距定位误差抑制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811119360.8A CN109282816B (zh) 2018-09-25 2018-09-25 一种利用三角形约束的测距定位误差抑制方法

Publications (2)

Publication Number Publication Date
CN109282816A CN109282816A (zh) 2019-01-29
CN109282816B true CN109282816B (zh) 2022-03-08

Family

ID=65181467

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811119360.8A Active CN109282816B (zh) 2018-09-25 2018-09-25 一种利用三角形约束的测距定位误差抑制方法

Country Status (1)

Country Link
CN (1) CN109282816B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112130185B (zh) * 2020-09-22 2023-11-24 上海市计量测试技术研究院 定位终端的定位精度测量方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1368648A (zh) * 2001-02-06 2002-09-11 株式会社日立制作所 位置计算方法、位置计算装置及其程序
CN106707232A (zh) * 2016-12-20 2017-05-24 南京工业大学 一种基于群智感知的wlan传播模型定位方法
CN107923740A (zh) * 2015-09-09 2018-04-17 索尼公司 传感器设备、传感器系统以及信息处理设备

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020005799A1 (en) * 2000-05-09 2002-01-17 Beisner Henry Michaels Adaptive filter to reduce multipath

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1368648A (zh) * 2001-02-06 2002-09-11 株式会社日立制作所 位置计算方法、位置计算装置及其程序
CN107923740A (zh) * 2015-09-09 2018-04-17 索尼公司 传感器设备、传感器系统以及信息处理设备
CN106707232A (zh) * 2016-12-20 2017-05-24 南京工业大学 一种基于群智感知的wlan传播模型定位方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于RSSI的无线传感网络三维定位方法;龚佳杰;《中国优秀硕士学位论文全文数据库》;20130131;I140-180 *

Also Published As

Publication number Publication date
CN109282816A (zh) 2019-01-29

Similar Documents

Publication Publication Date Title
CN108490473B (zh) 一种融合gnss和uwb的无人机增强定位方法与系统
KR101783050B1 (ko) 3축 자계 센서의 교정 방법 및 장치
AU2003254292B2 (en) Area based position determination for terminals in a wireless network
US8576122B2 (en) Method for measuring location of mobile terminal
CN109141427B (zh) 在非视距环境下基于距离和角度概率模型的ekf定位方法
CN107708204B (zh) 基于卡尔曼滤波的uwb定位系统基站自标定方法
CN105491659A (zh) 一种室内定位的非视距补偿方法
TWI544822B (zh) 訊號強度分佈建立方法及無線定位系統
KR101163335B1 (ko) 수신신호강도의 거리 추정 방식에 의거한 실내 무선 측위 방법 및 이 방법을 실시하기 위한 프로그램이 기록된 기록매체
CN109003309B (zh) 一种高精度相机标定和目标姿态估计方法
CN110506400B (zh) 蓝牙设备定位器
CN110636436A (zh) 基于改进chan算法的三维uwb室内定位方法
US20150031387A1 (en) Compensation of the signal attenuation by human body in indoor wi-fi positioning
CN108414974B (zh) 一种基于测距误差矫正的室内定位方法
CN109282816B (zh) 一种利用三角形约束的测距定位误差抑制方法
US10921418B2 (en) Method and apparatus for location estimation of terminal in wireless communication system
CN112394383A (zh) 一种卫星与5g基站组合定位方法及装置
US9411038B2 (en) Dynamic compensation for wireless device location determination
CN107371133B (zh) 一种提高基站定位精度的方法
CN109375165B (zh) 一种tdoa多测量站的定位方法
CN110572777B (zh) 一种基于蜂窝区域限制辅助定位的方法
CN114205749B (zh) 一种适用于穿墙场景的超宽带迭代定位算法及装置
KR100639500B1 (ko) 무선통신시스템에서의 위치 측정 방법
CN102523592B (zh) 一种在nanoLOC测距系统中利用RSSI降低多径误差的方法
KR20150124658A (ko) 실내 위치 추정 방법 및 장치

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