CN113923590A - 一种锚节点位置不确定情况下的toa定位方法 - Google Patents

一种锚节点位置不确定情况下的toa定位方法 Download PDF

Info

Publication number
CN113923590A
CN113923590A CN202111125863.8A CN202111125863A CN113923590A CN 113923590 A CN113923590 A CN 113923590A CN 202111125863 A CN202111125863 A CN 202111125863A CN 113923590 A CN113923590 A CN 113923590A
Authority
CN
China
Prior art keywords
anchor node
node
anchor
error
vector
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
Application number
CN202111125863.8A
Other languages
English (en)
Other versions
CN113923590B (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.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
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 Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN202111125863.8A priority Critical patent/CN113923590B/zh
Publication of CN113923590A publication Critical patent/CN113923590A/zh
Application granted granted Critical
Publication of CN113923590B publication Critical patent/CN113923590B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
    • 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
    • H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/30—Services specially adapted for particular environments, situations or purposes
    • H04W4/38—Services specially adapted for particular environments, situations or purposes for collecting sensor information
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明提供了一种锚节点位置不确定情况下的TOA定位方法，获取原始TOA量测，对节点位置误差进行建模，在锚节点与目标节点通信的原始TOA量测中引入锚节点误差项，对锚节点误差项进行转化，将定位问题转化为一个凸问题，将凸优化问题用MATLAB求解，从而得到目标位置坐标的估计。本发明仅减弱了先验信息要求的苛求程度，实用性得到了较大的提升；有效解决了在锚节点位置误差项不服从任何先验分布的这种更符合实际的情况下，以往发明所没有解决的过度松弛问题，在定位系统受环境影响，导致锚节点真实位置与量测得到的位置出现较大偏差时仍然能够较为准确地得到目标位置的估计，具有较强的实用性。

Description

一种锚节点位置不确定情况下的TOA定位方法
技术领域
本发明涉及信号处理领域，尤其是一种TOA定位方法，适合应用于非合作无线传感器网络中多个锚节点定位一个目标节点的定位系统。
背景技术
无线传感器网络(WSN)的灵活性，广泛的覆盖范围和易于部署的特性在过去的几年中引起了广泛的关注。通常，一个无线传感器网络由一群在一定空间范围内分布的低成本和低功耗的锚节点组成，它们可以用来执行常见的信号处理任务，例如探测、定位以及目标跟踪和目标状态变化的监测。在并行网络拓扑结构下，这些传感器获取到某种量测(例如温度，湿度，到达时间等)，并将量测结果传送给融合中心。融合中心再通过对接收到的量测结果进行数据处理，得出最终的估计结果。
目标定位是无线传感器网络中最重要的信号处理任务之一。融合中心在已知锚节点位置的假设下，有效地融合各个锚节点的量测，完成目标定位任务。许多类型的量测值都可以用来进行目标定位，例如到达时间(TOA)，到达时间差(TDOA)，到达角度(AOA)和信号强度(RSSI)。其中基于TOA与TDOA量测的定位方法取得了广泛的应用，尤其是针对非合作目标的定位问题。
基于TOA与TDOA的目标定位问题的常见的处理方法是在最大似然估计框架下估计目标位置，该方法涉及非线性优化问题求解。常用的处理方法有：最大似然估计方法(Maximum Likelihood Estimation,MLE)、最小二乘估计方法(Least SquaresEstimation,LSE)、凸优化方法(Convex Optimization,CVX)。其中凸优化方法取得了广泛的应用。凸优化方法不用设置初始值，只要将问题松弛为一个凸问题，所得结果就是最优的。而基于最大似然与最小二乘的估计方法需要设定迭代初值进行搜索，因此在非合作定位场景下，其实用性就会大大降低。
在基于TOA的定位问题中，往往存在锚节点与待定位的目标节点时钟不同步的问题，即目标节点的信号产生时刻未知。消除时间不同步的影响主要有两种方法，一是将TOA定位问题转化为TDOA定位问题；二是将目标节点未知的信号产生时刻与目标位置一同估计。另外，传统模型大多假设锚节点的位置是精确已知的，但是在实际应用中，这个条件很难达到，因为受环境的影响，锚节点的真实位置和通过量测得到的位置总会存在一定的误差。例如水上浮标节点，即使预先使用GPS获取了其位置，在定位过程中，受洋流的影响，节点也会发生漂移，导致其真实位置偏离量测得到的位置。如果不采取一定的措施，就会造成定位性能的下降。
为了处理节点位置误差项，首先需要对锚节点误差项进行建模，再进行后续处理。目前大多数研究都假设锚节点位置误差向量服从零均值的高斯分布。这种建模方法的优点是形式简单，有利于理论分析和推导。还有少部分研究不假设锚节点位置误差服从任何先验分布，而是只假设锚节点误差向量模的最大值已知。在实际环境中，后一种假设更符合实际情况，因为后一种假设减弱了对先验信息的苛求程度。同时，想要获取锚节点误差向量的协方差矩阵有时并不是一件容易的事，而锚节点误差向量模的最大值却较易估计。因此，只假设锚节点误差模的最大值已知是一种较为合理的模型。然而在假设锚节点误差模的最大值已知的研究中，往往都将不同节点的位置误差项向量化，再对这个向量进行处理，这样就带来了过度松弛的问题；因此，为了提升性能，这些算法又都引入了惩罚项。惩罚项是指设置一个较小的惩罚因子乘以一个变量，再将其与目标函数相加，作为新的目标函数。引入了惩罚项的定位算法的性能受惩罚因子的变化而发生剧烈变化，而最优惩罚因子的选择过程是无法通过理论推导得到的。这就使算法陷入了繁琐的惩罚因子选择过程，增加了计算复杂度，降低了算法实用性。
综上所述，基于锚节点位置不确定的TOA定位方法研究还不是很充分，因此，需要研究使用凸优化方法基于TOA量测的锚节点位置不确定的定位问题，并解决由于向量化节点位置误差向量而带来的过度松弛问题。
发明内容
为了克服现有技术的不足，本发明提供一种锚节点位置不确定情况下的TOA定位方法。针对TOA定位问题中锚节点位置受环境影响而与量测所得位置不一致的问题，提出了一种在锚节点位置存在误差情况下的TOA定位方法。本发明仅仅需要已知锚节点误差向量的模的最大值，而不需要提前已知误差的统计分布，减弱了先验信息要求的苛求程度。同时对节点位置误差项进行逐个处理，而没有进行向量化，且没有设置需要手动调节的惩罚项，使算法的实用性得到了较大的提升。
本发明解决其技术问题所采用的技术方案的详细步骤如下：
第一步：获取原始TOA量测，对节点位置误差进行建模；
选择l维定位场景；传感器网络中共M个锚节点和1个目标节点，锚节点位置已知但是存在误差，目标节点位置待估计，M个位置已知的锚节点的真实坐标分别为x1，x2，…，xM，位置待估计的目标节点的坐标为y；
设目标节点的信号产生时刻为t0，M个锚节点分别在ti时刻收到信号，ti的表达式为：
Figure BDA0003276439050000031
其中i＝1，2，...，M，xi为M个锚节点的坐标，位置为锚节点的真实位置；y是未知的目标节点的坐标，c是信号传播速度，ni为量测噪声，服从均值为零，标准差为σi的高斯分布，“||·||”表示取模，也即求向量的2-范数；
锚节点的真实位置坐标是未知的，已知的只有通过量测得到的带有误差的锚节点位置坐标，带有误差的锚节点位置坐标与真实的锚节点位置坐标的关系为：
Figure BDA0003276439050000032
其中
Figure BDA0003276439050000033
是带有误差但是已知的锚节点位置坐标，ξi是锚节点误差向量，其2-范数值小于一个预设的已知值ε；
第二步：在锚节点与目标节点通信的原始TOA量测中引入锚节点误差项；
将式(2)代入到原始TOA量测的表达式中，并在左右两边同时乘以声速c，得到：
Figure BDA0003276439050000034
使用一阶泰勒展开式将式(3)线性化，得到：
Figure BDA0003276439050000035
式(4)中(.)T表示向量的转置；
同时，令
Figure BDA0003276439050000036
则带有锚节点误差项的TOA量测表达式最终转化为：
ri＝di-δi+t0c+ni (5)
同时，经过推导得到：
|δi|≤ε
其中，ri表示锚节点i与目标节点之间通过量测得到的伪距，di表示锚节点i与目标节点之间的距离，锚节点i的坐标是已知的带有误差的锚节点位置，δi表示锚节点i与目标节点之间的模的误差值，符号“||”为求绝对值符号；
第三步：对锚节点误差项进行转化；
根据已有条件，将待优化的原始目标函数表示为如下的最小二乘问题：
Figure BDA0003276439050000041
根据第二步所得到的带锚节点误差项的TOA量测，将式(6)中的目标函数用式(5)代替，同时为了使最小二乘问题包括所有的锚节点位置误差项δi，得到如下的min-max优化问题：
Figure BDA0003276439050000042
其中，d0＝t0×c，s.t.表示“受约束于”；
待优化的目标函数是非线性且非凸的，并且带有锚节点误差项，直接求解很容易陷入局部最优，因此需要一定的方法进行处理；与其他研究对节点位置误差向量化为δ＝[δ1，δ2，…，δM]T，再应用S-过程对该向量进行处理不同，本发明不对节点位置进行向量化，而是对每个节点的位置误差项使用S-过程进行逐个处理，这样可以使约束的松弛程度减轻；处理步骤如下：
将锚节点误差项与其他项进行分离：
Figure BDA0003276439050000043
这里，令
Figure BDA0003276439050000051
即：
Figure BDA0003276439050000052
令qi＝ri-di-d0，则式(10)转化为：
Figure BDA0003276439050000053
令
q＝[q1，q2，…，qM]T
Q＝qqT
则
Figure BDA0003276439050000054
进一步转化为：
Figure BDA0003276439050000055
应用S-过程，得到：
Figure BDA0003276439050000056
经过上述处理，优化问题被转化为：
Figure BDA0003276439050000057
式中，q＝[q1，q2，…，qM]T，Q＝qqT，是为了解决优化问题新引入的向量和矩阵，且向量q的元素qi满足qi＝ri-di-d0，αi，βi和μi是为了转化锚节点误差向量新引进的M个常数，
Figure BDA0003276439050000061
表示矩阵正定；
第四步：将定位问题转化为一个凸问题；
经过第三步的转化后，锚节点误差项被消除，但这时仍然存在非凸约束，该定位问题仍然不是一个可解的凸问题；需要通过对目标函数及约束条件的一系列转化和松弛，使问题转化为一个凸问题；采用的松弛方法是半正定松弛方法，最终，目标函数被转化为一个凸函数，约束条件被转化为凸约束条件，从而该问题变为一个可解的凸问题。
定义锚节点与目标节点之间通过量测得到的伪距的集合为向量r＝[r1，r2，...rM]T，带有位置误差的锚节点与目标节点之间的距离的集合为d＝[d1，d2，...dM]T，同时定义向量d0＝[d0，d0，...d0]T，该向量共有M个元素，且所有元素都是d0；
定义中间向量及矩阵h＝[d1，d2，...，dM，d0]T，H＝hhT，同时定义常量矩阵U＝[IM，1M]，其中IM表示M×M的单位矩阵，1M表示所有元素均为1的M维列向量。通过该中间向量与矩阵与待优化变量建立联系，并进行适当的松弛，就将所有的约束转化为凸约束，从而问题转化为了一个可解的凸问题；
优化问题的最终形式为：
Figure BDA0003276439050000062
Figure BDA0003276439050000071
其中，z是为解决优化问题引入的中间变量，Hii表示矩阵H的第i行第i列的元素，Hij表示矩阵H第i行第j列的元素，hi表示向量h第i个元素，HM+1，M+1表示矩阵H第M+1行第M+1列的元素，hM+1表示向量h第M+1个元素；
第五步：求解凸优化问题，得到目标位置的估计；
将第四步得到的凸优化问题用MATLAB中的CVX凸优化工具箱求解，从而得到目标位置坐标的估计。
所述l取值为2或3。
所述M≥3。
本发明的有益效果在于提出了一种在锚节点位置存在误差情况下的基于凸优化的TOA定位方法。以往的发明大多假设锚节点位置误差向量服从高斯分布，但是在水下等复杂环境中，高斯分布并不符合实际，且需要获得先验统计信息，十分不方便。为了有效避免该问题，本发明只假设锚节点误差向量的模的最大值已知，这更符合实际情况。在得到锚节点与目标节点之间的TOA量测信息后，列出目标函数，并引入锚节点误差量，并利用S-过程消除锚节点误差向量，最后再经过转化与松弛将问题变为一个可以解决的凸问题。以往的基于位置误差向量模的最大值已知的方法往往对节点误差进行向量化后对向量进行处理，但是这种转化并非等价转化，会造成过度松弛的问题。为了解决这个问题，本发明不对误差向量进行向量化处理，而是单独对每个误差量应用S-过程。所以，本发明有效解决了在锚节点位置误差项不服从任何先验分布的这种更符合实际的情况下，以往发明所没有解决的过度松弛问题。本发明在定位系统受环境影响，导致锚节点真实位置与量测得到的位置出现较大偏差时仍然能够较为准确地得到目标位置的估计，具有较强的实用性。
附图说明
图1是本发明锚节点位置不确定情况下TOA定位方法的流程图。
图2是本发明方法性能与TOA量测噪声方差的关系图，其中图(a)为y＝[150，50]时的关系图，图(b)为y＝[150，600]时的关系图。
图3是本发明方法性能与锚节点误差向量模的最大值的关系图，图(a)为y＝[150，50]时的关系图，图(b)为y＝[150,600]时的关系图。
图4是本发明方法性能与锚节点位置误差模的最大值的估计值的关系图，图(a)为y＝[150,50]时的关系图，图(b)为y＝[150,600]时的关系图。
图5是本发明方法性能与TOA量测噪声方差的关系图，图(a)为y在锚节点组成的凸包内随机变化图，图(b)为y在锚节点组成的凸包外随机变化图。
图6是本发明方法性能与TOA量测噪声方差的关系图，锚节点和目标节点均在给定区域内随机变化曲线。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
本发明的总体方法流程图如图1所示。
方法性能的评价标准为均方误差(RMSE)计算公式为：
Figure BDA0003276439050000081
其中N为蒙特卡洛实验次数，这里设为1000，
Figure BDA0003276439050000084
是第j次蒙特洛实验中的目标节点的估计值。
仿真中设置5个位置已知但有误差的锚节点和2个待定位的目标节点，5个锚节点的真实位置为[-400,400]，[-400,-400]，[400,-400]，[400,400]，[0,400]。5个锚节点围成一个800m×800m的区域。目标节点的真实位置为[150,50]和[150,600]。其中[150,50]位于锚节点组成的凸包内，[150,600]位于凸包外。未知的信号产生时刻t0服从[0,1.5]s的均匀分布。
采用混合截断高斯模型来生成锚节点误差向量，两个截断高斯模型的均值μ1,μ2与标准差σ1,σ2满足：
μ1＝0,σ1＝1,截断区间为[μ1-2σ1,μ1+2σ1]
μ2＝1,σ2＞0,截断区间为[μ2-2σ2,μ2+2σ2]
这样，在二维情况下，节点误差模的最大值为
Figure BDA0003276439050000082
在仿真设置中，由于预设了节点误差模的最大值ε已知，因此根据上式可导出
Figure BDA0003276439050000083
根据两个截断高斯模型的均值与方差，就可以生成节点误差向量。其中，两个高斯模型混合的概率比例设置为0.6和0.4。
方法性能与TOA量测噪声方差的关系如图2所示。
方法性能与锚节点误差向量模的最大值的关系如图3所示。
方法性能与模的最大值的估计值的关系如图4所示。
在目标位置随机的情况下，方法性能与TOA量测噪声方差的关系如图5所示。
在锚节点与目标节点位置均随机的情况下，方法性能与TOA量测噪声方差的关系如图6所示。
考虑二维空间的定位问题。设在一个800m×800m的区域内有5个位置已知的锚节点，即M＝5。待定位的目标节点可以在该区域内，也可以在该区域外。设5个位置已知的锚节点的真实坐标分别为x1，x2，x3，x4，x5，待估计的目标节点的坐标为y。
第一步：获取原始TOA量测，对节点位置误差进行建模
设目标节点的信号产生时刻为t0，5个锚节点分别在ti时刻(i＝1，2，...，5)收到信号。ti的表达式为：
Figure BDA0003276439050000091
其中i＝1，2，...，5，xi为M个锚节点的坐标，位置为锚节点的真实位置；y是未知的目标节点的坐标，c是信号传播速度。ni为量测噪声，它服从均值为零，标准差为σi的高斯分布，“||·||”表示取模，也即求向量的2-范数。
这里锚节点的真实位置坐标是未知的，已知的只有通过量测得到的带有误差的锚节点位置坐标。带有误差的锚节点位置坐标与真实的锚节点位置坐标的关系为：
Figure BDA0003276439050000092
其中
Figure BDA0003276439050000093
是带有误差但是已知的锚节点位置坐标，ξi是锚节点误差向量，其2-范数值小于一个预设的已知值ε。
第二步：在锚节点与目标节点通信的原始TOA量测中引入锚节点误差项将式(18)代入到原始TOA量测的表达式中，并在左右两边同时乘以声速c，可得：
Figure BDA0003276439050000094
使用一阶泰勒展开式将上式线性化，得：
Figure BDA0003276439050000101
式中()T表示向量的转置。
同时，令
Figure BDA0003276439050000102
则带有锚节点误差项的TOA量测表达式最终可以转化为：
ri＝di-δi+t0c+ni (21)
同时，经过简单推导可推出：
|δi|≤ε
其中，ri表示锚节点i与目标节点之间通过量测得到的伪距，di表示锚节点i与目标节点之间的距离，注意这里的使用的锚节点i的坐标是已知的带有误差的锚节点位置。δi表示锚节点i与目标节点之间的模的误差值，符号“||”为求绝对值符号。
第三步：对锚节点误差项进行转化
根据已有条件，可以将待优化的原始目标函数表示为如下的最小二乘问题：
Figure BDA0003276439050000103
根据第二步所得到的带锚节点误差项的TOA量测，可以得到如下的min-max优化问题：
Figure BDA0003276439050000104
其中d0＝t0×c，s.t.表示“受约束于”。
待优化的目标函数是非线性且非凸的，并且带有锚节点误差项，直接求解很容易陷入局部最优。因此需要一定的方法进行处理。与其他研究对节点位置误差向量化为δ＝[δ1，δ2，…，δM]T，再应用S-过程对该向量进行处理不同，本研究不对节点位置进行向量化，而是对每个节点的位置误差项使用S-过程进行逐个处理，这样可以使约束的松弛程度减轻。
处理步骤如下：
将锚节点误差项与其他项进行分离：
Figure BDA0003276439050000111
这里，令
Figure BDA0003276439050000112
即：
Figure BDA0003276439050000113
令qi＝ri-di-d0，则式(20)转化为：
Figure BDA0003276439050000114
令
q＝[q1，q2，…，qM]T
Q＝qqT
则：
Figure BDA0003276439050000115
进一步转化为：
Figure BDA0003276439050000116
应用S-过程，可得：
Figure BDA0003276439050000121
经过上述处理，优化问题被转化为：
Figure BDA0003276439050000122
第四步：将定位问题转化为一个凸问题
经过第三步的转化后，锚节点误差项被消除，但这时仍然存在非凸约束，该定位问题仍然不是一个可解的凸问题。这时需要通过对目标函数及约束条件的一系列转化和松弛，使问题转化为一个凸问题。拟采用的松弛方法是半正定松弛方法，最终，目标函数被转化为一个凸函数，约束条件被转化为凸约束条件，从而该问题变为一个可解的凸问题。
令r＝[r1，r2，…rM]T，d＝[d1，d2，...dM]T，d0＝[d0，d0，...d0]T，则：
Q＝(r-d-d0)(r-d-d0)T
＝(r-Uh)(r-Uh)T (31)
＝rrT-2UhrT+UHUT
这里
d+d0＝Uh
U＝[IM，1M]
h＝[d1，d2，…，dM，d0]T
H＝hhT
矩阵H的对角线元素与非对角线元素满足以下性质：
Figure BDA0003276439050000131
这里，
z＝yTy (33)
接下来将三个非凸的约束Q＝qqT，H＝hhT，z＝yTy松弛成凸约束：
Figure BDA0003276439050000132
从矩阵H中还可以挖掘出另外一个凸约束条件：
HM+1，M+1≥0 (35)
同时，引入二阶锥松弛约束条件
Figure BDA0003276439050000133
这样就可得最终的凸优化问题为：
Figure BDA0003276439050000134
Figure BDA0003276439050000141
第五步：求解凸优化问题，得到目标位置的估计
将第四步得到的凸优化问题用MATLAB中的CVX凸优化工具箱求解，从而得到目标位置的估计，求解器为Sedumi。

Claims (3)

1.一种锚节点位置不确定情况下的TOA定位方法，其特征在于包括下述步骤：
第一步：获取原始TOA量测，对节点位置误差进行建模；
选择l维定位场景；传感器网络中共M个锚节点和1个目标节点，锚节点位置已知但是存在误差，目标节点位置待估计，M个位置已知的锚节点的真实坐标分别为x1,x2,…,xM，位置待估计的目标节点的坐标为y；
设目标节点的信号产生时刻为t0，M个锚节点分别在ti时刻收到信号，ti的表达式为：
Figure FDA0003276439040000011
其中i＝1,2,…,M，xi为M个锚节点的坐标，位置为锚节点的真实位置；y是未知的目标节点的坐标，c是信号传播速度，ni为量测噪声，服从均值为零，标准差为σi的高斯分布，“||·||”表示取模，也即求向量的2-范数；
锚节点的真实位置坐标是未知的，已知的只有通过量测得到的带有误差的锚节点位置坐标，带有误差的锚节点位置坐标与真实的锚节点位置坐标的关系为：
Figure FDA0003276439040000012
其中
Figure FDA0003276439040000013
是带有误差但是已知的锚节点位置坐标，ξi是锚节点误差向量，其2-范数值小于一个预设的已知值ε；
第二步：在锚节点与目标节点通信的原始TOA量测中引入锚节点误差项；
将式(2)代入到原始TOA量测的表达式中，并在左右两边同时乘以声速c，得到：
Figure FDA0003276439040000014
使用一阶泰勒展开式将式(3)线性化，得到：
Figure FDA0003276439040000015
式(4)中(.)T表示向量的转置；
同时，令
Figure FDA0003276439040000016
则带有锚节点误差项的TOA量测表达式最终转化为：
ri＝di-δi+t0c+ni (5)
同时，经过推导得到：
|δi|≤ε
其中，ri表示锚节点i与目标节点之间通过量测得到的伪距，di表示锚节点i与目标节点之间的距离，锚节点i的坐标是已知的带有误差的锚节点位置，δi表示锚节点i与目标节点之间的模的误差值，符号“||”为求绝对值符号；
第三步：对锚节点误差项进行转化；
根据已有条件，将待优化的原始目标函数表示为如下的最小二乘问题：
Figure FDA0003276439040000021
根据第二步所得到的带锚节点误差项的TOA量测，将式(6)中的目标函数用式(5)代替，同时为了使最小二乘问题包括所有的锚节点位置误差项δi，得到如下的min-max优化问题：
Figure FDA0003276439040000022
Figure FDA0003276439040000023
其中，d0＝t0×c，s.t.表示“受约束于”；
对每个节点的位置误差项使用S-过程进行逐个处理，处理步骤如下：
将锚节点误差项与其他项进行分离：
Figure FDA0003276439040000024
这里，令
Figure FDA0003276439040000025
即：
Figure FDA0003276439040000031
令qi＝ri-di-d0，则式(10)转化为：
Figure FDA0003276439040000032
令
q＝[q1，q2，…，qM]T
Q＝qqT
则
Figure FDA0003276439040000033
进一步转化为：
Figure FDA0003276439040000034
应用S-过程，得到：
Figure FDA0003276439040000035
经过上述处理，优化问题被转化为：
Figure FDA0003276439040000036
Figure FDA0003276439040000037
Figure FDA0003276439040000038
αi，βi≥0，μi≤0，i＝1，2，…，M.
Q＝qqT，qi＝ri-di-d0，i＝1，2，…，M
Figure FDA0003276439040000039
式中，q＝[q1，q2，…，qM]T，Q＝qqT，是为了解决优化问题新引入的向量和矩阵，且向量q的元素qi满足qi＝ri-di-d0，αi，βi和μi是为了转化锚节点误差向量新引进的M个常数，
Figure FDA0003276439040000048
表示矩阵正定；
第四步：将定位问题转化为一个凸问题
定义锚节点与目标节点之间通过量测得到的伪距的集合为向量r＝[r1,r2,…rM]T，带有位置误差的锚节点与目标节点之间的距离的集合为d＝[d1,d2,…dM]T，同时定义向量d0＝[d0,d0,…d0]T，该向量共有M个元素，且所有元素都是d0；
定义中间向量及矩阵h＝[d1,d2,...,dM,d0]T，H＝hhT，同时定义常量矩阵U＝[IM,1M]，其中IM表示M×M的单位矩阵，1M表示所有元素均为1的M维列向量。通过该中间向量与矩阵与待优化变量建立联系，并进行适当的松弛，就将所有的约束转化为凸约束，从而问题转化为了一个可解的凸问题；
优化问题的最终形式为：
Figure FDA0003276439040000041
Figure FDA0003276439040000042
αi，βi≥0，μi≥0，i＝1，2，…，M
Q＝rrT-2UhrT+UHUT
Figure FDA0003276439040000043
Figure FDA0003276439040000044
Figure FDA0003276439040000045
HM+1，M+1≥0
Figure FDA0003276439040000046
Figure FDA0003276439040000047
其中，z是为解决优化问题引入的中间变量，Hii表示矩阵H的第i行第i列的元素，Hij表示矩阵H第i行第j列的元素，hi表示向量h第i个元素，HM+1,M+1表示矩阵H第M+1行第M+1列的元素，hM+1表示向量h第M+1个元素；
第五步：求解凸优化问题，得到目标位置的估计；
将第四步得到的凸优化问题用MATLAB中的CVX凸优化工具箱求解，从而得到目标位置坐标的估计。
2.根据权利要求1所述的锚节点位置不确定情况下的TOA定位方法，其特征在于：
所述l取值为2或3。
3.据权利要求1所述的锚节点位置不确定情况下的TOA定位方法，其特征在于：
所述M≥3。
CN202111125863.8A 2021-09-24 2021-09-24 一种锚节点位置不确定情况下的toa定位方法 Active CN113923590B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111125863.8A CN113923590B (zh) 2021-09-24 2021-09-24 一种锚节点位置不确定情况下的toa定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111125863.8A CN113923590B (zh) 2021-09-24 2021-09-24 一种锚节点位置不确定情况下的toa定位方法

Publications (2)

Publication Number Publication Date
CN113923590A true CN113923590A (zh) 2022-01-11
CN113923590B CN113923590B (zh) 2023-07-21

Family

ID=79235888

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111125863.8A Active CN113923590B (zh) 2021-09-24 2021-09-24 一种锚节点位置不确定情况下的toa定位方法

Country Status (1)

Country Link
CN (1) CN113923590B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115906413A (zh) * 2022-10-26 2023-04-04 西北工业大学 一种基于重要性采样的Dirichlet过程混合模型节点自定位方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8179251B2 (en) * 2009-09-30 2012-05-15 Mitsubishi Electric Research Laboratories, Inc. Method and network for determining positions of wireless nodes while minimizing propagation of positioning errors
WO2018024751A1 (fr) * 2016-08-02 2018-02-08 Thales Systeme et procede global de geolocalisation a partir de mesures de distances et de positions d'ancres imprecises
CN110221245A (zh) * 2019-05-28 2019-09-10 宁波大学 联合估计目标位置和非视距误差的鲁棒tdoa定位方法
CN110221244A (zh) * 2019-05-24 2019-09-10 宁波大学 非视距条件下基于到达时间差的鲁棒定位方法
CN111432368A (zh) * 2020-03-31 2020-07-17 中国人民解放军国防科技大学 一种适用于稀疏锚节点wsn的测距定位方法
CN112954637A (zh) * 2021-01-23 2021-06-11 西北工业大学 一种锚节点位置不确定情况下的目标定位方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8179251B2 (en) * 2009-09-30 2012-05-15 Mitsubishi Electric Research Laboratories, Inc. Method and network for determining positions of wireless nodes while minimizing propagation of positioning errors
WO2018024751A1 (fr) * 2016-08-02 2018-02-08 Thales Systeme et procede global de geolocalisation a partir de mesures de distances et de positions d'ancres imprecises
CN110221244A (zh) * 2019-05-24 2019-09-10 宁波大学 非视距条件下基于到达时间差的鲁棒定位方法
CN110221245A (zh) * 2019-05-28 2019-09-10 宁波大学 联合估计目标位置和非视距误差的鲁棒tdoa定位方法
CN111432368A (zh) * 2020-03-31 2020-07-17 中国人民解放军国防科技大学 一种适用于稀疏锚节点wsn的测距定位方法
CN112954637A (zh) * 2021-01-23 2021-06-11 西北工业大学 一种锚节点位置不确定情况下的目标定位方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115906413A (zh) * 2022-10-26 2023-04-04 西北工业大学 一种基于重要性采样的Dirichlet过程混合模型节点自定位方法
CN115906413B (zh) * 2022-10-26 2023-12-08 西北工业大学 一种Dirichlet过程混合模型节点自定位方法

Also Published As

Publication number Publication date
CN113923590B (zh) 2023-07-21

Similar Documents

Publication Publication Date Title
CN110907932B (zh) 分布式InSAR卫星测高精度影响因素分析方法及系统
CN110673089B (zh) 未知视距和非视距分布情况下基于到达时间的定位方法
CN111157943B (zh) 在异步网络中基于toa的传感器位置误差抑制方法
US9213100B1 (en) Bearing-only tracking for horizontal linear arrays with rapid, accurate initiation and a robust track accuracy threshold
CN110658490B (zh) 基于rss和aoa的三维无线传感网络非协作定位方法
CN110662163A (zh) 基于rss和aoa的三维无线传感网络协作定位方法
Su et al. Underwater angle-only tracking with propagation delay and time-offset between observers
CN112887901A (zh) 一种基于量化toa量测的凸优化目标定位方法
CN113923590B (zh) 一种锚节点位置不确定情况下的toa定位方法
CN112954637B (zh) 一种锚节点位置不确定情况下的目标定位方法
Yan et al. UAM-RDE: an uncertainty analysis method for RSSI-based distance estimation in wireless sensor networks
Garcia et al. Localization using a particle filter and magnetic induction transmissions: Theory and experiments in air
Lin et al. Source localization by frequency measurements in unknown signal propagation speed environments
CN110673088B (zh) 混合视距和非视距环境中基于到达时间的目标定位方法
CN114035182B (zh) 一种基于电离层反射的多站时差多变量短波目标定位方法
CN114325581A (zh) 一种存在时钟同步误差的椭圆目标定位方法
CN112835020B (zh) 面向非视距参数估计的刚体定位方法
CN115616477A (zh) 一种非平面波单脉冲测角方法
CN112533284B (zh) 一种基于到达角的近远场统一定位方法
Yang et al. TDOA location based on modified Newton method
CN110850366B (zh) 混合视距和非视距环境下基于接收信号强度的定位方法
Rajani et al. Direction of arrival estimation by using artificial neural networks
Zhang et al. Identifiability analysis for array shape self-calibration in MIMO radar
Ghanbarpour Asl et al. A new non-linear algorithm for complete pre-flight calibration of magnetometers in the geomagnetic field domain
Springer et al. Joint localization and calibration in partly and fully uncalibrated array sensor networks

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