CN109975745A - 一种基于到达时间差的近远场统一定位方法 - Google Patents

一种基于到达时间差的近远场统一定位方法 Download PDF

Info

Publication number
CN109975745A
CN109975745A CN201910153360.8A CN201910153360A CN109975745A CN 109975745 A CN109975745 A CN 109975745A CN 201910153360 A CN201910153360 A CN 201910153360A CN 109975745 A CN109975745 A CN 109975745A
Authority
CN
China
Prior art keywords
row
sensor
far field
unified
matrix
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
CN201910153360.8A
Other languages
English (en)
Other versions
CN109975745B (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.)
Hefei Lougao Information Technology Co ltd
Xuzhou Chenci Network Technology Co ltd
Original Assignee
Ningbo 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 Ningbo University filed Critical Ningbo University
Priority to CN201910153360.8A priority Critical patent/CN109975745B/zh
Publication of CN109975745A publication Critical patent/CN109975745A/zh
Application granted granted Critical
Publication of CN109975745B publication Critical patent/CN109975745B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明涉及一种基于到达时间差的近远场统一定位方法,通过使用更改的极坐标(MPR)表示形式重新表示目标位置,建立近远场统一的定位模型。根据转化后的定位模型,将近远场统一定位问题数学描述为非凸的约束优化问题,并通过凸松弛技术将其松弛为混合半正定/二阶锥规划问题,从而近似求解了该非凸约束优化问题。通过混合半正定/二阶锥规划问题的解,在近场时最终获得目标位置估计、在远场时获得目标方位角和俯仰角估计。本发明的优点是,不需已知目标处于近场或远场的先验信息,并且能够获得原非凸约束优化问题的近似全局最优解。

Description

一种基于到达时间差的近远场统一定位方法
技术领域
本发明属于目标定位方法,具体涉及一种基于到达时间差的近远场统一定位方法。
背景技术
目标定位是对用户提供位置信息,这些信息对目标跟踪与导航、紧急安全以及国防安全等至关重要。
根据从目标到传感器阵列的距离远近可将定位问题分为近场定位和远场定位。在近场定位中,目标与传感器之间的距离与传感器基线的比值较小,目标信号到达传感器阵列时波阵面为曲面,从而可以获得唯一的目标位置估计。在远场环境中,目标与传感器阵列之间的距离与传感器基线比值较大,信号源信号到达传感器阵列的波阵面可以认为是平面,因而,唯一能够确定的有效信息只有目标发射信号的到达方向角 (Direction ofArrival, DOA)。由于近场和远场目标信号到达传感器阵列的信号形式不同,近场和远场目标定位需采用不同的测量模型,因此对近场和远场目标的定位通常也需采用不同的方法。然而,在很多非合作目标定位中,目标处于近场或远场的先验信息并不已知。若采用错误的模型实施定位将造成巨大的定位误差。
为解决近远场定位中模型不匹配的问题,本文提出一种基于到达时间差(TDOA)的近远场统一定位方法,即在不需要已知近远场先验信息的条件,采用近远场统一的定位模型,实施近远场统一的定位方法,在目标处于近场时给出目标的具体位置估计,而在目标处于远场时给出DOA估计。
发明内容
本发明的目的是解决上述问题,提供一种基于到达时间差的近远场统一定位方法,通过建立近远场统一的定位模型,建立关于目标位置参数的优化问题,并采用半正定松弛技术,获得该优化问题的近似最优解。
为实现上述目的,本发明提供如下技术方案:
一种基于到达时间差的近远场统一定位方法,包括以下步骤:
S1:在无线传感器网络中建立一个平面坐标系或空间坐标系作为参考坐标系;设定无线传感器网络中存在一个用于发射测量信号的目标源和 个用于接收测量信号的传感器,且设定个传感器的时钟同步;设第0个传感器为参考传感器,并将其在参考坐标系中的坐标位置记为,将其余个传感器在参考坐标系中的坐标位置对应记为,将目标源在参考坐标系中的坐标位置记为
S2:将测得目标源与第个传感器和目标源与参考传感器之间的到达时间差测量值记为;计算与第个传感器和目标源与参考传感器之间的距离差测量值,
S3:将测量的距离差测量值以模型方式进行描述,将的模型表示为:;将所有距离差测量值和噪声分别写成向量形式,;假设服从均值为0,协方差矩阵为Q的高斯分布;通过模型变换,将转化为;将目标位置表示为,将代入中,可得
S4:根据,可得如下约束优化问题:
其中min表示“最小化”, 表示“受约束于”,
S5:令,上述问题可以等价转化为:
其中
S6:将上述优化问题松弛为所示凸的混合半正定/二阶锥规划问题:;
S7:采用内点法求解上述半正定/二阶锥规划,记其最优解为,若为秩1矩阵,对做特征值分解,即,二维情况下令,三维情况下令,其中分别表示的第1,2,3,4个元素,
;
近场情况下目标源位置估计表达式为,其中二维情况下,三维情况下。远场情况下,没有意义,分别为方位角和俯仰角估计,若不为秩1矩阵,构造如下混合半正定/二阶锥规划问题:
;
S8: 采用内点法求解混合半正定/二阶锥规划问题,记其最优解为,对做特征值分解,即。二维情况下令,三维情况下令,其中分别表示的第1,2,3,4个元素,
则近场情况下目标源位置估计表达式为,其中二维情况下,三维情况下,远场情况下,没有意义,分别为方位角和俯仰角估计。
进一步的,所述步骤S1中,表示维列向量,为定位系统维度,即平面定位时,空间定位时表示第1个传感器在参考坐标系中的坐标位置,表示第个传感器在参考坐标系中的坐标位置。
进一步的,所述步骤S2中,表示光速。
进一步的,所述步骤S3中:符号“”为求欧几里德范数符号,表示第个传感器在参考坐标系中的坐标位置,表示第个测量噪声;表示向量转置。
进一步的,所述步骤S3中二维情况下,三维情况下为方位角,为俯仰角,为目标源位置到原点之间距离的倒数。
进一步的,所述步骤S5中表示是半正定矩阵,表示矩阵中第行第列的元素,表示矩阵的迹,表示矩阵的秩。
进一步的,所述步骤S6中表示矩阵中第1列中,从第2行到第行所有元素构成的向量, 表示矩阵第1行第1列的元素,表示第行第1列的元素,矩阵中第列中,从第2行到第行所有元素构成的向量,表示矩阵第1行第列的元素,表示矩阵中第行第列的元素。
进一步的,所述步骤S7中矩阵中第列中,从第2行到第行所有元素构成的向量,表示矩阵中第行第列的元素,表示矩阵中第行第列的元素,矩阵中第行第1列的元素,表示取正负号操作。
本发明的有益效果在于:
本发明通过使用MPR重新表示目标位置,建立近远场统一的定位模型。根据转化后的定位模型,将近远场统一定位问题数学描述为非凸的约束优化问题,并通过凸松弛技术近似求解该非凸约束优化问题。最终,在近场时获得目标位置估计、在远场时获得目标DOA(方位角和俯仰角)估计。本发明提供的目标定位方法的优势在于:不需要已知目标处于近场或远场的先验信息,且能够获得原非凸约束优化问题的(近似)全局最优解。
附图说明
为了更清楚地说明本发明实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明为了更清楚地说明本发明实施例或现有技术中的技术方案,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明总体流程框图;
图2为本发明与现有的约束最小二乘方法,现有的半正定规划方法,克拉美-罗界的对数均方误差随目标到原点距离变化的图;
图3为本发明与现有的约束最小二乘方法,现有的半正定规划方法,对数偏差值随目标到原点距离变化的图。
具体实施方式
为了使本领域技术人员更好地理解本发明的技术方案能予以实施,下面结合具体实施例对本发明作进一步说明,但所举实施例不作为对本发明的限定。
如图1所示的一种基于到达时间差的近远场统一定位方法,其包括以下步骤:
S1:在无线传感器网络中建立一个平面坐标系或空间坐标系作为参考坐标系;设定无线传感器网络中存在一个用于发射测量信号的目标源和个用于接收测量信号的传感器,且设定个传感器的时钟同步;设第0个传感器为参考传感器,并将其在参考坐标系中的坐标位置记为,其中表示维列向量,为定位系统维度,即平面定位时,空间定位时。将其余个传感器在参考坐标系中的坐标位置对应记为表示第1个传感器在参考坐标系中的坐标位置,表示第个传感器在参考坐标系中的坐标位置,将目标源在参考坐标系中的坐标位置记为
S2:将测得目标源与第个传感器和目标源与参考传感器之间的到达时间差测量值记为,其中,。计算与第个传感器目标源与参考传感器之间的距离差测量值,,其中,表示光速;
S3:将测量的距离差测量值以模型方式进行描述,将的模型表示为:,其中符号“”为求欧几里德范数符号,表示第个传感器在参考坐标系中的坐标位置,表示第个测量噪声。将所有距离差测量值和噪声分别写成向量形式,表示向量转置。假设服从均值为0,协方差矩阵为的高斯分布。通过模型变换,将转化为。将目标位置表示为,其中二维情况下,三维情况下为方位角,为俯仰角,为目标源位置到原点之间距离的倒数,将代入中,可得
S4:根据,可得如下约束优化问题:
其中min表示“最小化”, 代表“受约束于”,
S5:令,上述问题可以等价转化为如下形式:
其中 表示是半正定矩阵,表示矩阵中第行第列的元素,表示矩阵的迹,表示矩阵的秩;
S6:将上述优化问题松弛为如下所示凸的混合半正定/二阶锥规划问题:
其中表示矩阵中第1列中,从第2行到第行所有元素构成的向量, 表示矩阵第1行第1列的元素,表示第行第1列的元素,矩阵中第列中,从第2行到第行所有元素构成的向量,表示矩阵第1行第列的元素,表示矩阵中第行第列的元素;
S7:采用常见的内点法软件求解上述半正定/二阶锥规划问题,记上述问题的最优解为,若为秩1矩阵,对做特征值分解,即,二维情况下令,三维情况下令,其中分别表示的第1,2,3,4个元素,
近场情况下目标源位置估计表达式为,其中二维情况下,三维情况下。远场情况下,没有意义,分别为方位角和俯仰角估计,若不为秩1矩阵,构造如下混合半正定/二阶锥规划问题:
其中矩阵中第列中,从第2行到第行所有元素构成的向量,表示矩阵中第行第列的元素,表示矩阵中第行第列的元素,矩阵中第行第1列的元素,表示取正负号操作;
S8:采用常见的内点法软件求解上述混合半正定/二阶锥规划问题,记其最优解为,对做特征值分解,即。二维情况下令,三维情况下令,其中分别表示的第1,2,3,4个元素,
则近场情况下目标源位置估计表达式为,其中二维情况下,三维情况下,远场情况下,没有意义,分别为方位角和俯仰角估计。
为验证本发明方法的可行性和有效性,对本发明方法进行仿真试验:
假设有6个普通传感器和1个参照传感器,其位置如表1所示,其中参照传感器位于坐标原点。目标源的方位角设为和俯仰角谁为。噪声的协方差矩阵定义为,其中为噪声功率,的单位矩阵,的全1矩阵。
表1 传感器位置
测试本方法的性能在固定噪声功率的情况下,定位性能随目标到原点的距离变化情况。图2给出的情况下目标位置的定位对数均方误差(MSE)随目标到原点距离增加的变化情况。图3给出的情况下目标位置的对数偏差值(Bias)随目标到原点距离增加的变化情况。从图中可以看出,在此场景下,近远场的分界点在90左右。现有的约束最小二乘方法仅在近场时性能良好,但无法估计目标处于远场时的DOA。现有的半正定规划方法在远场时能够给出较好的DOA估计,但在近场时无法给出精确的目标位置估计。相比之下,本发明提出的方法在近场和远场都有良好的性能。
本发明中未做详细描述的内容均为现有技术。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (8)

1.一种基于到达时间差的近远场统一定位方法,其特征在于,包括以下步骤:
S1:在无线传感器网络中建立一个平面坐标系或空间坐标系作为参考坐标系;设定无线传感器网络中存在一个用于发射测量信号的目标源和个用于接收测量信号的传感器,且设定个传感器的时钟同步;设第0个传感器为参考传感器,并将其在参考坐标系中的坐标位置记为,将其余个传感器在参考坐标系中的坐标位置对应记为,将目标源在参考坐标系中的坐标位置记为
S2:将测得目标源与第个传感器和目标源与参考传感器之间的到达时间差测量值记为;计算目标源与第个传感器和目标源与参考传感器之间的距离差测量值,
S3:将测量的距离差测量值以模型方式进行描述,将的模型表示为:;将所有距离差测量值和噪声分别写成向量形式,假设服从均值为0,协方差矩阵为的高斯分布;通过模型变换,将转化为将目标位置表示为,将代入中,可得
S4:根据,可得约束优化问题:
其中min表示“最小化”,表示“受约束于”,
S5:令,上述问题可以等价转化为:
其中
S6: 将上述优化问题松弛为如下所示凸的混合半正定/二阶锥规划问题:
S7:采用内点法求解上述半正定/二阶锥规划,记其最优解为。若为秩1矩阵,对做特征值分解,即,二维情况下令,三维情况下令其中分别表示的第1,2,3,4个元素,
近场情况下目标源位置估计表达式为,其中二维情况下,三维情况下;远场情况下,没有意义,分别为方位角和俯仰角估计,若不为秩1矩阵,构造如下混合半正定/二阶锥规划问题:
S8:采用内点法求解混合半正定/二阶锥规划问题,记其最优解为,对做特征值分解,即。二维情况下令,三维情况下令,其中分别表示的第1,2,3,4个元素,
则近场情况下目标源位置估计表达式为,其中二维情况下,三维情况下,远场情况下,没有意义,分别为方位角和俯仰角估计。
2.根据权利要求1所述的一种基于到达时间差的近远场统一定位方法,其特征在于,所述步骤S1中,表示维列向量,为定位系统维度,即平面定位时,空间定位时表示第1个传感器在参考坐标系中的坐标位置,表示第个传感器在参考坐标系中的坐标位置。
3.根据权利要求1所述的一种基于到达时间差的近远场统一定位方法,其特征在于,所述步骤S2中,表示光速。
4.根据权利要求1所述的一种基于到达时间差的近远场统一定位方法,其特征在于,所述步骤S3中:符号“”为求欧几里德范数符号,表示第个传感器在参考坐标系中的坐标位置,表示第个测量噪声;表示向量转置。
5.根据权利要求1所述的一种基于到达时间差的近远场统一定位方法,其特征在于,所述步骤S3中二维情况下,三维情况下为方位角,为俯仰角,为目标源位置到原点之间距离的倒数。
6.根据权利要求1任一项所述的一种基于到达时间差的近远场统一定位方法,其特征在于,所述步骤S5中表示是半正定矩阵,表示矩阵中第行第列的元素,表示矩阵的迹,表示矩阵的秩。
7.根据权利要求1所述的一种基于到达时间差的近远场统一定位方法,其特征在于,所述步骤S6中表示矩阵中第1列中,从第2行到第行所有元素构成的向量,表示矩阵第1行第1列的元素,表示第行第1列的元素,矩阵中第列中,从第2行到第行所有元素构成的向量,表示矩阵第1行第列的元素,表示矩阵中第行第列的元素。
8.根据权利要求1至7任一项所述的一种基于到达时间差的近远场统一定位方法,其特征在于,所述步骤S7中矩阵中第列中,从第2行到第行所有元素构成的向量,表示矩阵中第行第列的元素,表示矩阵中第行第列的元素,矩阵中第行第1列的元素,表示取正负号操作。
CN201910153360.8A 2019-02-28 2019-02-28 一种基于到达时间差的近远场统一定位方法 Active CN109975745B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910153360.8A CN109975745B (zh) 2019-02-28 2019-02-28 一种基于到达时间差的近远场统一定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910153360.8A CN109975745B (zh) 2019-02-28 2019-02-28 一种基于到达时间差的近远场统一定位方法

Publications (2)

Publication Number Publication Date
CN109975745A true CN109975745A (zh) 2019-07-05
CN109975745B CN109975745B (zh) 2023-11-14

Family

ID=67077652

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910153360.8A Active CN109975745B (zh) 2019-02-28 2019-02-28 一种基于到达时间差的近远场统一定位方法

Country Status (1)

Country Link
CN (1) CN109975745B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110658490A (zh) * 2019-08-23 2020-01-07 宁波大学 基于rss和aoa的三维无线传感网络非协作定位方法
CN112533284A (zh) * 2020-09-23 2021-03-19 宁波大学 一种基于到达角的近远场统一定位方法
CN113084801A (zh) * 2021-03-30 2021-07-09 深圳市人工智能与机器人研究院 基于半正定规划优化的多机器人初始位姿相对定位方法
CN114035181A (zh) * 2021-09-30 2022-02-11 宁波大学 一种未知发射机位置和速度的移动目标椭圆定位方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001324557A (ja) * 2000-05-18 2001-11-22 Sony Corp 近距離場における信号発信源の位置をアレーアンテナを用いて推定する装置及び方法
CN107367709A (zh) * 2017-06-05 2017-11-21 宁波大学 混合环境中基于到达时间鲁棒加权最小二乘定位方法
CN109061563A (zh) * 2018-09-25 2018-12-21 宁波大学 一种非同步网络中基于分数规划的定位方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001324557A (ja) * 2000-05-18 2001-11-22 Sony Corp 近距離場における信号発信源の位置をアレーアンテナを用いて推定する装置及び方法
CN107367709A (zh) * 2017-06-05 2017-11-21 宁波大学 混合环境中基于到达时间鲁棒加权最小二乘定位方法
CN109061563A (zh) * 2018-09-25 2018-12-21 宁波大学 一种非同步网络中基于分数规划的定位方法

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110658490A (zh) * 2019-08-23 2020-01-07 宁波大学 基于rss和aoa的三维无线传感网络非协作定位方法
CN112533284A (zh) * 2020-09-23 2021-03-19 宁波大学 一种基于到达角的近远场统一定位方法
CN112533284B (zh) * 2020-09-23 2022-05-27 宁波大学 一种基于到达角的近远场统一定位方法
CN113084801A (zh) * 2021-03-30 2021-07-09 深圳市人工智能与机器人研究院 基于半正定规划优化的多机器人初始位姿相对定位方法
CN114035181A (zh) * 2021-09-30 2022-02-11 宁波大学 一种未知发射机位置和速度的移动目标椭圆定位方法

Also Published As

Publication number Publication date
CN109975745B (zh) 2023-11-14

Similar Documents

Publication Publication Date Title
CN109975745A (zh) 一种基于到达时间差的近远场统一定位方法
CN103323855B (zh) 一种基线动态测量系统的精度获取方法
CN104237849B (zh) 一种双五元十字阵被动声定位融合方法
CN106441311B (zh) 一种基于激光成像雷达的非合作航天器相对位姿测量方法
US10670689B2 (en) System and method for determining geo location of a target using a cone coordinate system
CN109597028B (zh) 一种混合视距非视距条件下基于到达时间的鲁棒定位方法
WO2021098808A1 (zh) 激光跟踪仪站位确定方法、系统、电子设备及介质
CN105738915A (zh) 三维雷达测量方法及装置
CN105678076A (zh) 点云测量数据质量评估优化的方法及装置
CN109959898B (zh) 一种座底式水声被动定位基阵自校准方法
CN109917333A (zh) 融合aoa观测量与tdoa观测量的无源定位方法
CN110220491A (zh) 一种无人机的光学吊舱安装误差角估算方法
CN108668358A (zh) 一种应用于无线传感网络的基于到达时间的协作定位方法
CN109357677B (zh) 一种应用于水下单信标导航的航路规划方法
Zhu et al. A calibration method of USBL installation error based on attitude determination
CN105425206A (zh) 一种非同步无线网络中的稳健最小二乘定位方法
CN108917698B (zh) 一种方位角计算方法
CN105627916A (zh) 一种建立跟踪仪地理坐标系及六自由度测量的方法
CN110221245B (zh) 联合估计目标位置和非视距误差的鲁棒tdoa定位方法
CN110673088B (zh) 混合视距和非视距环境中基于到达时间的目标定位方法
CN110398702B (zh) 一种基于多传感器融合的实时在线磁校准方法
CN108828509B (zh) 一种多平台多辐射源承载关系判定方法
CN104330078B (zh) 一种基于三点后方交会模型的联合测量方法
CN112596026B (zh) 一种未知发射机位置的椭圆目标定位方法
CN110850366B (zh) 混合视距和非视距环境下基于接收信号强度的定位方法

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
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20231017

Address after: 221400 Room 602, Building A-1, East Longhai Science Park, No. 10, Huangshan Road, Beigou Street, Xinyi City, Xuzhou City, Jiangsu Province

Applicant after: XUZHOU CHENCI NETWORK TECHNOLOGY CO.,LTD.

Address before: Room 1003, Building G1, Phase 2, Donghongjun, Liaoyuan Road, Feidong Economic Development Zone, Feidong County, Hefei City, Anhui Province, 231699

Applicant before: Hefei lougao Information Technology Co.,Ltd.

Effective date of registration: 20231017

Address after: Room 1003, Building G1, Phase 2, Donghongjun, Liaoyuan Road, Feidong Economic Development Zone, Feidong County, Hefei City, Anhui Province, 231699

Applicant after: Hefei lougao Information Technology Co.,Ltd.

Address before: 315000 Fenghua Road, Jiangbei District, Ningbo, Zhejiang Province, No. 818

Applicant before: Ningbo University

GR01 Patent grant
GR01 Patent grant