CN108134640B - 一种基于节点运动状态约束的协作定位系统和方法 - Google Patents
一种基于节点运动状态约束的协作定位系统和方法 Download PDFInfo
- Publication number
- CN108134640B CN108134640B CN201711317113.4A CN201711317113A CN108134640B CN 108134640 B CN108134640 B CN 108134640B CN 201711317113 A CN201711317113 A CN 201711317113A CN 108134640 B CN108134640 B CN 108134640B
- Authority
- CN
- China
- Prior art keywords
- node
- information
- state
- relative distance
- module
- 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
- 230000033001 locomotion Effects 0.000 title claims abstract description 37
- 238000000034 method Methods 0.000 title claims abstract description 37
- 230000004927 fusion Effects 0.000 claims description 44
- 238000012937 correction Methods 0.000 claims description 28
- 239000011159 matrix material Substances 0.000 claims description 27
- 238000004891 communication Methods 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 9
- 239000000126 substance Substances 0.000 claims description 6
- 238000001914 filtration Methods 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 4
- 238000005259 measurement Methods 0.000 claims description 3
- 230000001186 cumulative effect Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 239000000758 substrate Substances 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04B—TRANSMISSION
- H04B17/00—Monitoring; Testing
- H04B17/30—Monitoring; Testing of propagation channels
- H04B17/391—Modelling the propagation channel
- H04B17/3913—Predictive models, e.g. based on neural network models
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/025—Services making use of location information using location based information parameters
- H04W4/027—Services making use of location information using location based information parameters using movement velocity, acceleration information
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供了一种基于节点运动状态约束的协作定位系统和方法。通过利用具有自定位信息节点的位置信息和节点间的相对距离信息,完成网络中所有节点的定位。针对该系统所设计的协作定位算法首先基于节点的运动状态约束对节点的状态信息进行预测;然后,基于所有的先验信息,对节点的相对距离信息进行融合,得到节点位置的观测信息;最后,利用节点位置的观测信息对预测信息进行修正,就可以得到节点状态的后验估计。本发明利用节点的运动状态约束对节点的位置信息进行预测,能够有效提高节点位置的预测精度,最终提高节点的定位精度,并且在节点速度比较大或者网络连通性较差的情况下,该方法具有比传统定位方法更好的稳定性。
Description
技术领域
本发明属于导航领域,是一种基于节点运动状态约束的协作定位系统和方法。
背景技术
无人机在近年来得到了越来越广泛的关注,它可以应用于监测、测绘、农作物保护等各种应用中。通常情况下,可以通过多无人机协作的方式来提高该无人系统的性能和鲁棒性。对于这个协作系统来说,节点位置信息是至关重要的,目前,GPS被广泛应用于节点定位问题当中。但是,在恶劣的环境条件下,如城市峡谷、森林及强信号干扰环境,GPS信号容易受到干扰,此时,GPS提供的位置信息与真实位置存在很大的偏差,这使得GPS定位系统的性能大大降低。协作定位方法能够有效利用网络中节点间的相对距离信息或者角度信息,来提高节点定位的性能和稳定性。置信度传播算法和扩展卡尔曼滤波算法是比较常用的协作定位方法,其他方法还包括最小二乘算法和无迹卡尔曼滤波算法等。
扩展卡尔曼滤波算法由于具有较低的计算复杂度而得到了广泛的应用,它利用线性方程对非线性的系统方程或者状态方程进行逼近。线性方程与非线性方程之间的失配使得系统的性能大大降低。另外,基于因子图的置信度传播算法也被广泛运用,它没有考虑到节点的运动状态约束,在节点运动速度比较小的时候,该算法能够提供较高的定位精度,但是当运用于无人机网络这样的节点高速运动的场景时,其先验信息误差较大,因而其最终的位置估计精度也较差。
在无人机网络中,由于遮挡等原因,只有部分节点能够通过传统方法,如GPS,对自身进行定位,将这些节点称为参考节点,其余节点无法进行自定位,称之为非参考节点。另外,节点间通信距离较长,节点速度比较快,利用传统的协作定位方法对无人机网络中各个节点进行定位时其定位精度较差,并且定位结果容易发散。
本发明提出了一种基于节点运动状态约束的协作定位系统和方法。该系统是针对高速运动的无人机网络中部分节点无法完成自定位的问题,利用参考节点的位置估计信息和节点间的相对距离信息完成网络中所有节点的定位。所提出的协作定位方法在节点的状态模型中加入了节点的运动速度,可以有效提高节点位置的预测精度;对于每一个节点,基于预测信息和该节点通信范围内的参考节点的位置估计信息,对相对距离信息进行融合,得到节点位置的观测信息;利用观测信息和节点的运动状态约束对预测信息进行修正,可以得到节点状态的后验估计,这其中就包括了节点位置的后验估计。
发明内容
本发明的目的是针对恶劣环境条件下,高速运动的无人机网络中部分节点无法通过传统方法,如GPS,进行定位,提出一种基于节点运动状态约束的协作定位系统和方法。
基于节点运动状态约束的协作定位系统可以分为四个模块:预测模块、先验信息融合模块、相对距离信息融合模块、校正模块。前一时刻节点状态的后验估计输入到预测模块,预测模块的输出端连接到先验信息融合模块和校正模块的输入端,先验信息融合模块的输出端与相对距离信息融合模块的输入端相连,相对距离信息融合模块的输出连接到校正模块,校正模块的输出就是当前时刻节点状态的后验估计。
针对该协作定位系统所提出的基于节点运动状态约束的协作定位方法包括如下步骤:
(1)对节点状态信息进行预测。基于前一时刻节点状态的后验估计,根据节点的运动状态约束对当前时刻节点的状态信息进行预测。该预测值送入到先验信息融合模块和校正模块;
(2)对所有的先验信息进行融合,得到融合的先验信息。在某一时刻,参考节点的先验信息包括预测信息和通过传统定位方法,如GPS,所获得的位置估计信息;非参考节点的先验信息来自预测信息。将融合的先验信息送入到相对距离信息融合模块;
(3)相对距离信息融合模块收集当前时刻节点通信范围内参考节点的位置估计信息及相对距离信息,基于融合的先验信息,对相对距离信息进行融合,得到节点位置的观测信息,将该观测信息送入校正模块;
(4)校正模块根据节点的运动状态约束,利用相对距离信息融合模块所得到的节点位置的观测信息对节点状态的预测值进行修正,得到节点状态的后验估计;
(5)将校正模块的结果输出,即可得到当前时刻节点状态的后验估计,其中就包括了节点位置的后验估计。
本发明在节点的状态模型中加入了节点的运动速度,然后利用节点的运动状态约束有效提高了节点位置的预测精度,这不仅提高了节点的定位精度,也提高了在网络连通性较差或者节点速度较大时方法的稳定性。
附图说明
图1是基于节点运动状态约束的协作定位方法的框图;
图2通信范围内的参考节点数不足时非参考节点的定位性能;
图3是非参考节点的定位误差累积密度图;
图4是参考节点的定位误差累积密度图。
具体实施方式
本发明设计了一种协作定位系统和算法。该系统是针对高速运动的无人机网络中部分节点无法完成自定位的问题,利用参考节点的位置估计信息和节点间的相对距离信息完成网络中所有节点的定位。所提出的协作定位方法在节点的状态模型中加入了节点的运动速度,并且在计算节点的状态信息时利用了节点的运动状态约束。该方法能够有效提高节点状态的预测精度,进而提高节点的定位精度,并且提高了在网络连通性较差或者节点速度较大时方法的稳定性。
基于节点运动状态约束的协作定位系统可以分为四个模块:预测模块、先验信息融合模块、相对距离信息融合模块、校正模块。针对该系统所提出的协作定位方法包括如下步骤:
(1)建立系统的状态模型,确定系统的状态方程和观测方程:
其中,为节点m在t时刻的状态变量,包括节点的位置信息和速度信息,F为状态转移矩阵,为系统建模噪声,其均值为零,协方差矩阵为表示观测向量,表示相对距离信息融合所得到的节点位置的观测信息,表示的是t时刻的观测误差,其均值为零,协方差矩阵为
(2)对节点状态进行预测。基于前一时刻节点状态的后验估计,利用扩展卡尔曼滤波算法作为节点的运动状态约束,对节点在当前时刻的状态进行预测,该预测值的均值和协方差矩阵分别为:
(3)对所有的先验信息进行融合,得到融合的先验信息。在某一时刻,参考节点的先验信息包括预测信息和通过传统定位方法,如GPS,所获得的位置估计信息,可基于最小均方误差准则对这些先验信息进行融合;非参考节点的先验信息来自预测信息。将融合的先验信息送入相对距离信息融合模块;
(4)相对距离信息融合模块收集当前时刻节点通信范围内参考节点的位置估计信息及相对距离信息,基于融合的先验信息,利用参数化的置信度传播算法对相对距离信息进行融合,得到节点位置的观测信息,其均值为协方差矩阵为将观测信息送入校正模块;
(5)校正模块根据节点的运动状态约束,利用相对距离信息融合模块所得到的节点位置的观测信息对节点状态的预测值进行修正,得到节点状态的后验估计。首先,计算测量余量及其协方差矩阵
然后,计算卡尔曼增益
最后,得到校正后的节点状态的均值和协方差矩阵
(6)将校正模块的结果输出,即可得到当前时刻节点状态的后验估计。该后验估计信息输入到下一个时间片的预测模块的输入端,用于对下一时刻节点状态信息的预测。
协作定位系统的系统框图如图1所示,包括了预测模块101、先验信息融合模块102、相对距离信息融合模块103、校正模块104;前一时刻节点状态的后验估计输入到预测模块101,预测模块101的输出端连接到先验信息融合模块102和校正模块104的输入端,先验信息融合模块102的输出端连接到相对距离信息融合模块103的输入端,相对距离信息融合模块103的输出连接到校正模块104的输入端。
实施例
将扩展卡尔曼滤波算法作为节点的运动状态约束,用参数化的置信度传播算法对节点的相对距离信息进行融合为例。设定在一个无人机网络中,有18个无人机,其中8个无人机可通过GPS对自身进行定位,通过GPS所获得位置估计信息是存在一定误差的,其余无人机不能完成自定位,所有无人机节点随机分布在5000m×5000m的范围内。由于距离与功耗的限制以及障碍物的遮挡,每一个节点只能与网络中的部分节点进行通信,通过通信链路可以得到节点间的相对距离信息,每个节点的运动速度在40m/s左右,加速度在1~2m/s2之间,节点的通信半径为1400m。参考节点通过GPS所得位置的误差标准差为5m,节点间相对距离信息的误差标准差为3m。
基于节点运动状态约束的协作定位系统可以分为四个模块:预测模块、先验信息融合模块、相对距离信息融合模块、校正模块。针对该系统所提出的协作定位方法包括如下步骤:
(1)建立系统的状态模型,确定系统的状态方程和观测方程:
(2)根据t-1时刻节点状态的后验估计信息对t时刻的节点状态及其协方差矩阵进行预测,计算公式分别为:
(3)对节点位置估计的先验信息进行融合。在每个时间片内,对于参考节点,其先验信息包括预测信息和通过GPS所获得的节点位置的估计信息,可基于最小均方误差准则进行融合;对于非参考节点,其先验信息就是预测信息。
其中,
(4)基于融合的先验信息,利用参数化的置信度传播算法,也就是蒙特卡洛随机采样的方法,利用大量带有权值的随机采用点对相对距离信息进行融合,得到节点位置的观测信息。首先,在融合的先验信息中随机采样得到K个采样点在该分布中,采样点的概率密度为
并对所有采样点的权重进行归一化,使得
最后,基于这些带有权值的随机采样点,可以得到由相对距离信息融合得到的节点位置的观测信息,其均值和协方差矩阵分别为
(5)建立校正方程,利用相对距离信息融合模块的节点位置观测结果对节点状态的预测信息进行校正。首先,计算测量余量及其协方差矩阵
然后,计算卡尔曼增益
最后,得到校正后的节点状态的均值和协方差矩阵
图2表示在参考节点数不足时,非参考节点的定位性能,SPA-EKF是本发明所提出的一种协作定位方法。STOC-EKF和SPAWN是两个对比算法。在参考节点足够时,图3表示非参考节点的定位误差累积密度,图4表示参考节点的定位误差累积密度。其中,图4中“GPSlocalization”表示参考节点通过传统的GPS定位方法所得到的节点定位误差累积密度。
图中可以看出,当运用于高速运动的无人机网络时,基于节点运动状态约束的协作定位系统和方法在参考节点数不足时定位误差发散较缓慢,因而方法的稳定性更好。在参考节点足够时,该协作定位系统和方法的定位精度更高。
Claims (4)
1.一种基于节点运动状态约束的协作定位系统的定位方法,所述的协作定位系统包括预测模块(101)、先验信息融合模块(102)、相对距离信息融合模块(103)和校正模块(104);预测模块(101)的输出端连接到先验信息融合模块(102)和校正模块(104)的输入端,先验信息融合模块(102)的输出端连接到相对距离信息融合模块(103)的输入端,相对距离信息融合模块(103)的输出端与校正模块(104)的输入端相连;
其特征在于,所述的定位方法包括如下步骤:
(1)预测模块根据前一时刻节点状态的后验估计,基于节点的运动状态约束,对当前时刻节点的状态信息进行预测,将预测信息送入先验信息融合模块和校正模块;
(2)在每一个时间片内,先验信息融合模块根据参考节点的位置估计信息和预测模块输出的每个节点的位置预测信息,计算得到每个节点位置的先验估计,该先验信息送入到相对距离信息融合模块;
(3)相对距离信息融合模块基于先验信息和节点通信范围内参考节点的位置信息,对相对距离信息进行融合,得到节点位置的观测信息,将这个观测信息送入到校正模块;
(4)校正模块根据节点的运动状态约束和相对距离信息融合模块得到的节点位置观测信息,对节点状态的预测值进行校正,得到节点状态的后验估计,这其中就包括了节点位置的后验估计;
所述的步骤(1)具体为:
基于前一时刻节点状态的后验估计,利用扩展卡尔曼滤波算法作为节点的运动状态约束,对节点在当前时刻的状态进行预测:
2.如权利要求1所述的基于节点运动状态约束的协作定位系统的定位方法,其特征在于所述的步骤(2)具体为:
对所有的先验信息进行融合,得到融合的先验信息,在某一时刻,参考节点的先验信息包括参考节点的位置估计信息和预测模块输出的每个节点的位置预测信息,基于最小均方误差准则对这些先验信息进行融合;非参考节点的先验信息来自预测信息,将融合的先验信息送入相对距离信息融合模块。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711317113.4A CN108134640B (zh) | 2017-12-12 | 2017-12-12 | 一种基于节点运动状态约束的协作定位系统和方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711317113.4A CN108134640B (zh) | 2017-12-12 | 2017-12-12 | 一种基于节点运动状态约束的协作定位系统和方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108134640A CN108134640A (zh) | 2018-06-08 |
CN108134640B true CN108134640B (zh) | 2020-11-06 |
Family
ID=62389302
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711317113.4A Active CN108134640B (zh) | 2017-12-12 | 2017-12-12 | 一种基于节点运动状态约束的协作定位系统和方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108134640B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109655786B (zh) * | 2018-12-29 | 2020-11-24 | 清华大学 | 移动自组网协作相对定位方法及装置 |
CN109901108A (zh) * | 2019-03-19 | 2019-06-18 | 南京航空航天大学 | 一种基于后验线性化置信传播的编队无人机协同定位方法 |
CN110191411B (zh) * | 2019-04-28 | 2020-06-19 | 浙江大学 | 一种基于时空域联合处理的分布式协作定位系统和方法 |
CN110213713B (zh) * | 2019-04-28 | 2020-06-23 | 浙江大学 | 一种基于时空域联合处理的集中式协作定位系统和方法 |
CN110274588B (zh) * | 2019-06-19 | 2020-12-08 | 南京航空航天大学 | 基于无人机集群信息的双层嵌套因子图多源融合导航方法 |
CN112325770B (zh) * | 2020-10-26 | 2022-08-02 | 武汉中海庭数据技术有限公司 | 一种车端单目视觉测量相对精度置信度评估方法及系统 |
CN114501310B (zh) * | 2022-01-17 | 2023-04-25 | 中国科学院国家授时中心 | 一种同时定位和跟踪的协同定位方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005119293A1 (de) * | 2004-06-04 | 2005-12-15 | Siemens Aktiengesellschaft | Verfahren zur bestimmung von positionsdaten |
CN102706342A (zh) * | 2012-05-31 | 2012-10-03 | 重庆邮电大学 | 一种智能移动机器人的定位与环境建模方法 |
CN103428733A (zh) * | 2013-07-15 | 2013-12-04 | 上海华为技术有限公司 | 一种预测方法和装置 |
CN106162869A (zh) * | 2016-07-07 | 2016-11-23 | 上海交通大学 | 移动自组织网络中高效协作定位方法 |
-
2017
- 2017-12-12 CN CN201711317113.4A patent/CN108134640B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005119293A1 (de) * | 2004-06-04 | 2005-12-15 | Siemens Aktiengesellschaft | Verfahren zur bestimmung von positionsdaten |
CN102706342A (zh) * | 2012-05-31 | 2012-10-03 | 重庆邮电大学 | 一种智能移动机器人的定位与环境建模方法 |
CN103428733A (zh) * | 2013-07-15 | 2013-12-04 | 上海华为技术有限公司 | 一种预测方法和装置 |
CN106162869A (zh) * | 2016-07-07 | 2016-11-23 | 上海交通大学 | 移动自组织网络中高效协作定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108134640A (zh) | 2018-06-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108134640B (zh) | 一种基于节点运动状态约束的协作定位系统和方法 | |
CN110231636B (zh) | Gps与bds双模卫星导航系统的自适应无迹卡尔曼滤波方法 | |
Ullah et al. | Evaluation of Localization by Extended Kalman Filter, Unscented Kalman Filter, and Particle Filter‐Based Techniques | |
CN113819906A (zh) | 一种基于统计相似度量的组合导航鲁棒滤波方法 | |
CN110191411B (zh) | 一种基于时空域联合处理的分布式协作定位系统和方法 | |
CN112923919B (zh) | 基于图优化的行人定位方法及系统 | |
CN113324546B (zh) | 罗经失效下的多潜航器协同定位自适应调节鲁棒滤波方法 | |
US11927687B2 (en) | Centralized cooperative positioning method based on joint time-space processing | |
CN114264301B (zh) | 车载多传感器融合定位方法、装置、芯片及终端 | |
KR101470081B1 (ko) | 이동 정보 결정 장치, 수신기 및 그에 의한 방법 | |
CN116182873B (zh) | 室内定位方法、系统及计算机可读介质 | |
Tang et al. | GNSS/inertial navigation/wireless station fusion UAV 3-D positioning algorithm with urban canyon environment | |
Wu et al. | UAV-based target tracking: Integrating sensing into communication signals | |
CN114442133A (zh) | 无人机定位方法、装置、设备及存储介质 | |
WO2024120187A1 (zh) | 一种用于信息拒止环境下的无人机动态目标估计方法 | |
CN116222541A (zh) | 利用因子图的智能多源组合导航方法及装置 | |
CN103727947B (zh) | 基于ukf滤波的bds与gis深耦合定位方法和系统 | |
Zhang et al. | GNSS velocimeter by adaptively combining carrier phase and Doppler measurements | |
CN114323034A (zh) | 一种卫星遮蔽环境中的基于置信度传播的多车协同定位方法 | |
Liu et al. | Effective Sage-Husa Kalman filter for SINS/Doppler/Platform compass integrated navigation system | |
CN113008235A (zh) | 基于矩阵k-l散度的多源导航信息融合方法 | |
Zeller et al. | Relative train localization for cooperative maneuvers using GNSS pseudoranges and geometric track information | |
Dai et al. | Spoofing-resilient LiDAR-GPS factor graph localization with chimera authentication | |
Fan et al. | A dynamic constrained cooperative localization algorithm | |
Gan et al. | Filtering approach to online estimate the position of high-speed train |
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 |