CN114040325A - 惯导辅助下的单锚节点网络协同定位方法 - Google Patents
惯导辅助下的单锚节点网络协同定位方法 Download PDFInfo
- Publication number
- CN114040325A CN114040325A CN202111306968.3A CN202111306968A CN114040325A CN 114040325 A CN114040325 A CN 114040325A CN 202111306968 A CN202111306968 A CN 202111306968A CN 114040325 A CN114040325 A CN 114040325A
- Authority
- CN
- China
- Prior art keywords
- node
- nodes
- inertial navigation
- user
- user node
- 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.)
- Granted
Links
Images
Classifications
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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
-
- 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
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
- H04W64/006—Locating users or terminals or network equipment for network management purposes, e.g. mobility management with additional information processing, e.g. for direction or speed determination
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Abstract
本发明提供了一种惯导辅助下的单锚节点网络协同定位方法,以锚节点为坐标原点建立本地坐标系,利用用户节点上的惯性导航系统获得用户节点的相对位移信息,利用节点上的无线传感器获得节点间的相互测距信息,构造时间序列上网络节点的联合后验分布,通过节点间消息的相互传递,利用和积算法进行消息计算,获得节点的位置以及位置不确定度信息。本发明建立惯导辅助下的单锚节点网络协同定位算法模型并结合和积算法,解决了单锚节点无线传感器网络系统无法定位的问题,大幅降低了锚节点的布设数量,降低了维护难度。
Description
技术领域
本发明是一种用于单锚节点无线传感器网络的定位方法,特别涉及一种惯性导航系统辅助的单锚节点无线传感器网络协同定位方法。
背景技术
导航与定位技术的快速发展正逐渐影响着人们的生活和生产方式,在智慧城市、紧急救援、物流管理、休闲娱乐等领域有着广泛的应用。全球卫星导航系统可以为室外开阔区域提供实时、全天候的位置服务,然而,在室内、大型商超、城市峡谷等复杂环境中,难以满足用户的定位需求。
无线技术的发展以及智能终端的普及为人们的定位需求提供了另一种方案,基于无线传感器网络的定位技术也已成为工业界和学术界的研究热点。但是,无线传感器网络节点存在传输距离较短的缺陷,导致基于无线传感器网络的定位技术需要在定位区域内布设大量的锚节点,造成了锚节点资源和能量的浪费。协同定位技术利用用户节点间的对等通信和测量信息,通过贝叶斯/非贝叶斯估计方法对用户节点位置进行估计,在提高定位精度的同时,提升定位的连续性和可用性。然而,现有的协同定位技术对锚节点的数量以及锚节点的位置分布仍然具有较高要求,无法解决单锚节点网络下的定位问题。因此,一种新的适用于单锚节点网络的协同定位方法亟待提出。
发明内容
为了克服现有技术的不足,实现单锚节点网络下的定位技术,本发明提供了一种惯导辅助下的单锚节点网络协同定位方法,通过该方法可以有效降低无线传感器网络定位对锚节点数量的依赖性,从而提高无线传感器网络定位的连续性和可用性。
本发明以锚节点为坐标原点建立本地坐标系,利用用户节点上的惯性导航系统获得用户节点的相对位移信息,利用节点上的无线传感器获得节点间的相互测距信息,构造时间序列上网络节点的联合后验分布,通过节点间消息的相互传递,利用和积算法进行消息计算,获得节点的位置以及位置不确定度信息。本发明建立惯导辅助下的单锚节点网络协同定位算法模型并结合和积算法,解决了单锚节点无线传感器网络系统无法定位的问题,大幅降低了锚节点的布设数量,降低了维护难度。
本发明解决其技术问题所采用的技术方案是:
(1)、以锚节点为坐标原点建立本地坐标系o-xy,则锚节点位置坐标为x0=(0,0),用编号i给用户节点进行编号,利用表示用户节点在时刻t的坐标,上标“t”为时刻,有t=1,2,……,T,下标“i”为用户节点编号,有i∈M={1,2,…,m};
(2)、无线传感器网络节点的最大感知距离为R,用户节点i的邻居节点集合为Si={j|||xj-xi||≤R,j≠i},符号||·||为2范数;
式中,σj→i为无线传感器网络测距误差标准差;
(5)、节点间的测距信息相互独立,计算节点关于测距信息的联合似然函数:
(7)、根据惯性导航系统获得的用户节点位移信息,计算用户节点i的似然函数:
式中,wi→i为惯性导航器件误差标准差;
(8)、用户节点的惯性导航器件测量信息相互独立,计算用户节点关于位移信息的联合似然函数:
(9)、将无线传感器网络测距信息与惯性导航系统推算的位移信息相融合,计算所有节点在时刻t的联合后验分布:
式中,p(X(t-1))为t-1时刻所有节点位置的联合概率分布函数,进一步的可表示为:
当t=1时,p(X(0))为无线传感器网络节点位置先验信息,锚节点位置固定已知,用户节点初始位置随机分布在定位区域内,即可以认为p(X(0))=1;当t>1时,使用高斯分布对用户节点位置分布进行近似,即因此式(6)可以进一步写为:
(10)、将式(2)和式(4)代入式(5),计算用户节点i的后验分布函数:
利用和积算法分别对式(8)和式(9)进行计算,将计算结果代入式(7),获得用户节点i的后验分布函数;
(12)、根据用户节点i的后验分布函数,随机生成k个粒子,粒子的权重为:
(13)、计算用户节点i的均值与协方差矩阵:
(14)、用户节点将其在t时刻的位置估计均值以及位置不确定度信息广播给邻居节点,用来计算t+1时刻的位置信息。
有益效果
本发明的有益效果是将惯导系统测得的用户节点相对位移引入无线传感器网络定位中,结合用户节点间的对等测量和通信,大幅降低了无线传感器网络定位对锚节点数量的要求,实现了单锚节点网络下的位置估计。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1是本发明的惯导辅助下的单锚节点单用户节点定位示意图,其中,锚节点用★表示,用户节点用·表示,锚节点坐标为x0=(0,0),A、B、C三点分别表示用户节点1在t-1时刻、t时刻以及t+1时刻的位置,其坐标分别为 用户节点1在t-1时刻、t时刻以及t+1时刻测得的与锚节点之间的距离分别为用户节点1在t-1时刻到t时刻以及t时刻到t+1时刻测得的相对位移分别为
图2是本发明的单锚节点多用户节点协同定位示意图,其中,网络包含1个锚节点和3个用户节点,用户节点1、2、3测得的与锚节点之间的距离分别为 用户节点1测得的与用户节点2、3之间的距离分别为和用户节点2测得的与用户节点1、3之间的距离分别为和用户节点3测得的与用户节点1、2之间的距离分别为和
图3是单锚节点定位系统定位误差比较曲线,其中,带上三角形标记实线代表本发明的惯导辅助的单锚节点定位方法10目标协同定位的定位误差曲线;带星号标记实线代表多天线分布式单锚节点定位误差曲线;带空心圆标记实线代表多天线信道冲激响应单锚节点定位误差曲线。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
本发明提出的惯导辅助下的单锚节点网络协同定位方法结合了单锚节点定位系统易于构建的优点和协同定位能够有效提升定位的连续性和可用性的优点。本发明建立惯导辅助下的单锚节点网络协同定位算法模型并结合和积算法,解决了单锚节点无线传感器网络系统无法定位的问题,大幅降低了锚节点的布设数量,降低了维护难度。本发明的原理步骤如下:
(1)、如图1所示,以锚节点为坐标原点建立本地坐标系o-xy,则锚节点位置坐标为x0=(0,0),用编号i给用户节点进行编号,利用表示用户节点在时刻t的坐标,上标“t”为时刻,有t=1,2,……,T,下标“i”为用户节点编号,有i∈M={1,2,…,m};
(2)、无线传感器网络节点的最大感知距离为R,用户节点i的邻居节点集合为Si={j|||xj-xi||≤R,j≠i},符号||·||为2范数;
式中,σj→i为无线传感器网络测距误差标准差;
(5)、节点间的测距信息相互独立,计算节点关于测距信息的联合似然函数:
(7)、根据惯性导航系统获得的用户节点位移信息,计算用户节点i的似然函数:
式中,wi→i为惯性导航器件误差标准差;
(8)、用户节点的惯性导航器件测量信息相互独立,计算用户节点关于位移信息的联合似然函数:
(9)、将无线传感器网络测距信息与惯性导航系统推算的位移信息相融合,计算所有节点在时刻t的联合后验分布:
式中,p(X(t-1))为t-1时刻所有节点位置的联合概率分布函数,进一步的可表示为:
当t=1时,p(X(0))为无线传感器网络节点位置先验信息,锚节点位置固定已知,用户节点初始位置随机分布在定位区域内,即可以认为p(X(0))=1;当t>1时,使用高斯分布对用户节点位置分布进行近似,即因此式(6)可以进一步写为:
(10)、将式(14)和式(16)代入式(17),计算用户节点i的后验分布函数:
利用和积算法分别对式(20)和式(21)进行计算,将计算结果代入式(19),获得用户节点i的后验分布函数;
(12)、根据用户节点i的后验分布函数,随机生成k个粒子,粒子的权重为:
(13)、计算用户节点i的均值与协方差矩阵:
(14)、用户节点将其在t时刻的位置估计均值以及位置不确定度信息广播给邻居节点,用来计算t+1时刻的位置信息。
性能分析
在仿真分析中,无线传感器网络设置1个锚节点和10个用户节点,仿真持续时间40秒,仿真过程中,用户节点在定位区域内随机移动,从图中可以看出,在前3秒时,本专利所提定位方法误差较大,随着时间增加,本专利所提方法定位误差迅速下降,在第5秒时,定位误差基本稳定在0.3米左右,优于多天线分布式定位方法的0.5米左右以及多天线信道冲激响应估计法的2.7米左右。这是由于本发明锚节点只装配了单天线,在定位初期仅能利用测距信息进行位置估计,误差较大,而多天线分布式定位方法以及多天线信道冲激响应估计法中的锚节点都需要装配天线阵,同时利用测距以及测向信息进行位置估计;随着时间增加,由于本发明充分利用了用户节点间的测距信息进行协同定位,定位误差迅速下降,可以实现单锚节点网络下的高精度位置估计。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (8)
1.一种惯导辅助下的单锚节点网络协同定位方法,其特征在于:包括以下步骤:
步骤1:以锚节点为坐标原点建立本地坐标系;
步骤2:利用用户节点上的惯性导航系统获得用户节点的相对位移信息,利用节点上的无线传感器获得节点间的相互测距信息,构造时间序列上网络节点的联合后验分布;
步骤3:通过节点间消息的相互传递,利用和积算法进行消息计算,获得节点的位置以及位置不确定度信息。
3.根据权利要求2所述一种惯导辅助下的单锚节点网络协同定位方法,其特征在于:步骤2中,锚节点与用户节点、用户节点与用户节点之间利用无线传感器进行测距,获得节点间的距离信息下标“j→i”表明节点i测得的与节点j之间的距离;无线传感器网络节点的最大感知距离为R,用户节点i的邻居节点集合为Si={j|||xj-xi||≤R,j≠i},符号||·||为2范数;
式中,σj→i为无线传感器网络测距误差标准差;
节点间的测距信息相互独立,计算节点关于测距信息的联合似然函数:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111306968.3A CN114040325B (zh) | 2021-11-05 | 2021-11-05 | 惯导辅助下的单锚节点网络协同定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111306968.3A CN114040325B (zh) | 2021-11-05 | 2021-11-05 | 惯导辅助下的单锚节点网络协同定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114040325A true CN114040325A (zh) | 2022-02-11 |
CN114040325B CN114040325B (zh) | 2022-08-19 |
Family
ID=80143064
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111306968.3A Active CN114040325B (zh) | 2021-11-05 | 2021-11-05 | 惯导辅助下的单锚节点网络协同定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114040325B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2542001A1 (en) * | 2011-06-30 | 2013-01-02 | Naser El-Sheimy | Method and apparatus for determining position of a wireless device |
CN103327606A (zh) * | 2013-06-14 | 2013-09-25 | 南京邮电大学 | 一种基于加速度传感器的无线传感器网络节点定位方法 |
CN104535963A (zh) * | 2014-12-22 | 2015-04-22 | 浙江大学 | 基于距离测量的多移动节点实现协同目标定位的方法 |
CN104793182A (zh) * | 2015-04-21 | 2015-07-22 | 东南大学 | 非高斯噪声条件下基于粒子滤波的室内定位方法 |
CN105823480A (zh) * | 2016-03-18 | 2016-08-03 | 中国海洋大学 | 基于单信标的水下移动目标定位算法 |
CN110530362A (zh) * | 2019-09-05 | 2019-12-03 | 北京航空航天大学 | 一种基于单参考节点/惯性组合的消防员室内定位方法 |
CN110749891A (zh) * | 2019-10-21 | 2020-02-04 | 哈尔滨工程大学 | 一种可估计未知有效声速的自适应水下单信标定位方法 |
CN112945224A (zh) * | 2021-02-05 | 2021-06-11 | 哈尔滨工程大学 | 一种采用因子图和和积算法的多auv协同导航方法 |
-
2021
- 2021-11-05 CN CN202111306968.3A patent/CN114040325B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2542001A1 (en) * | 2011-06-30 | 2013-01-02 | Naser El-Sheimy | Method and apparatus for determining position of a wireless device |
CN103327606A (zh) * | 2013-06-14 | 2013-09-25 | 南京邮电大学 | 一种基于加速度传感器的无线传感器网络节点定位方法 |
CN104535963A (zh) * | 2014-12-22 | 2015-04-22 | 浙江大学 | 基于距离测量的多移动节点实现协同目标定位的方法 |
CN104793182A (zh) * | 2015-04-21 | 2015-07-22 | 东南大学 | 非高斯噪声条件下基于粒子滤波的室内定位方法 |
CN105823480A (zh) * | 2016-03-18 | 2016-08-03 | 中国海洋大学 | 基于单信标的水下移动目标定位算法 |
CN110530362A (zh) * | 2019-09-05 | 2019-12-03 | 北京航空航天大学 | 一种基于单参考节点/惯性组合的消防员室内定位方法 |
CN110749891A (zh) * | 2019-10-21 | 2020-02-04 | 哈尔滨工程大学 | 一种可估计未知有效声速的自适应水下单信标定位方法 |
CN112945224A (zh) * | 2021-02-05 | 2021-06-11 | 哈尔滨工程大学 | 一种采用因子图和和积算法的多auv协同导航方法 |
Non-Patent Citations (1)
Title |
---|
王英志等: ""水下导航定位技术研究进展"", 《数字海洋与水下攻防》 * |
Also Published As
Publication number | Publication date |
---|---|
CN114040325B (zh) | 2022-08-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhu et al. | Adapted error map based mobile robot UWB indoor positioning | |
CN1988550B (zh) | 一种无线传感器网络无锚点定位的分布式实现方法 | |
Zhang et al. | 3D mapping database aided GNSS based collaborative positioning using factor graph optimization | |
Liu et al. | Improving positioning accuracy using GPS pseudorange measurements for cooperative vehicular localization | |
CN107801195B (zh) | 一种车联网定位中的路边单元优化部署方法 | |
Han et al. | Automatic precision control positioning for wireless sensor network | |
US8279840B2 (en) | Systems and methods for providing location based services (LBS) utilizing WLAN and/or GPS signals for seamless indoor and outdoor tracking | |
WO2019062030A1 (zh) | 基于星型网络的bds/gps广播式网络rtk算法 | |
Chen et al. | Information filter with speed detection for indoor Bluetooth positioning | |
Chu et al. | Vehicle localization via cooperative channel mapping | |
CN110933599A (zh) | 一种融合uwb与wifi指纹的自适应定位方法 | |
CN103270801A (zh) | 用于定位用户设备的方位的方法和系统 | |
Liu et al. | A V2X-integrated positioning methodology in ultradense networks | |
Li et al. | Three-dimensional cooperative localization via space-air-ground integrated networks | |
Shit et al. | AI-enabled fingerprinting and crowdsource-based vehicle localization for resilient and safe transportation systems | |
CN115379558A (zh) | 一种基于粒子群优化乌鸦算法的移动台位置估计方法 | |
Kjærgaard et al. | Efficient indoor proximity and separation detection for location fingerprinting | |
Afifi et al. | Cellular Network-Supported Machine Learning Techniques for Autonomous UAV Trajectory Planning | |
CN114040325B (zh) | 惯导辅助下的单锚节点网络协同定位方法 | |
Soatti et al. | Enhanced vehicle positioning in cooperative ITS by joint sensing of passive features | |
CN110941004B (zh) | 一种基于gnss/uwb的移动机器人室内外联合定位方法及装置 | |
Wu et al. | GROLO: realistic range-based localization for mobile IoTs through global rigidity | |
CN117031519A (zh) | 一种多目标三维协同定位方法及系统 | |
Ahmed et al. | Localization schemes in underwater sensor network (UWSN): A survey | |
Lee et al. | Performance evaluation and hybrid application of the greedy and predictive UAV trajectory optimization methods for localizing a target mobile device |
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 |