CN103886192B - 基于二次规划的运动目标单站定位方法 - Google Patents
基于二次规划的运动目标单站定位方法 Download PDFInfo
- Publication number
- CN103886192B CN103886192B CN201410093019.5A CN201410093019A CN103886192B CN 103886192 B CN103886192 B CN 103886192B CN 201410093019 A CN201410093019 A CN 201410093019A CN 103886192 B CN103886192 B CN 103886192B
- Authority
- CN
- China
- Prior art keywords
- moving target
- moving
- target
- quadratic programming
- doa
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 17
- 238000005259 measurement Methods 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 17
- 238000010276 construction Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000002939 conjugate gradient method Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种基于二次规划的运动目标单站定位技术,包括:将运动观测平台在其自身运动轨迹上获得的运动目标信号进行波达方向(DoA)估计,得出所述运动目标的DoA不连续测量值;利用得出的DoA不连续测量值,建立目标分段直线运动模型,构造基于二次规划的算法,进行所述运动目标的定位,估计所述运动目标的运动轨迹。本发明可实现在样本捕获量较小的情况,仍然能够运用单站定位技术对一个运动目标进行单站定位,并保持定位结果的精确性。
Description
技术领域
本发明涉及一种单站定位技术,具体涉及一种某单站定位系统,可用于对小样本量、动目标的单站定位。
背景技术
目前定位的方法有很多种:时差(TDOA)无源定位、频差(FDOA)无源定位、测向(DF)定位、测相位变化率联合定位、混合定位,包括测向/测时差联合定位、测向/测相位变化率联合定位、测向/测频联合定位、时差/频差联合定位(TDOA/FDOA)等。对某种具体的定位技术体制而言,按实现方法还可以细分。例如测向定位,按测向定位的实现方法还可以细分为比幅、比相、时差、高分辨率阵列测向定位法等。
不同的定位技术体制和实现方法在使用上有其不同的优缺点。比如在基于相位差变化率的定位中,由于需要利用Kalman滤波器计算相位差变化率,因此如果捕获的样本量小,那么相位差变化率就很难估计的准确。而在基于多普勒变化率的定位中,由于需要计算非常精细的多普勒频移,对于复杂电磁环境而言,需要存储大量的原始数据样本,这在硬件上有时是不可行的。并且以往的所有单站定位算法基本上都只针对目标是静止的情况。
发明内容
针对现有技术的不足,本发明旨在提供一种基于二次规划的运动目标单站定位方法,在即使捕获的样本量较小的情况下,也能实现对运动目标的较为精确的单位定位。
为达到上述目的,本发明提供技术方案如下:
步骤1,运动观测平台截获运动目标的信号;
步骤2,所述运动观测平台对在其自身运动轨迹上获得的所述运动目标信号进行波达方向(DoA)估计,得出所述运动目标的DoA不连续测量值,具体实现步骤如下:
记ti,i=0,1,2,...,M-1表示平台截获到目标信号并进行了DoA估计的时刻,φi,θi,ri分别表示在ti时刻所述运动观测平台观测到的所述运动目标相对所述运动观测平台的方位角、俯仰角和距离在大地坐标系x-O-y中的值;所述运动观测平台的位置用矩阵pPi=[xPi yPi zPi]T表示,所述运动目标的位置用矩阵pTi=[xTi yTi zTi]T表示;则所述ti时刻的方位角、俯仰角和距离在大地坐标系x-O-y中的值、所述运动观测平台位置以及所述运动目标位置之间的关系表示为:
步骤3,利用所述步骤2得出的DoA不连续测量值,建立目标分段直线运动模型,即:
将所述运动目标的运动轨迹按照ti时刻划分成若干段,并且假设在每段上,所述运动目标是匀速直线运动,速度为vTi=[vxi vyi vzi]T,且此速度小于某个极限值;
为目标与平台之间的距离、目标速度和目标初始位置的矩阵,其矩阵大小为(M+6)×1;为所述运动观测平台位置矩阵,其大小为3M×1,则
所述运动观测平台位置估计值与理论值的误差e表示为:
e=Bx-pP
矩阵B为大小为3M×(M+6),其中矩阵Ai=[sinθicosφi sinθisinφi cosθi]T;
则所述误差的平方E表示为:
步骤4,利用所述步骤3得出的目标分段直线运动模型,构造基于二次规划的运动目标定位,获得所述运动目标的运动轨迹,具体可表示如下:
s.t.lb≤x≤ub;
其中lb与ub为x的约束范围,其中lb为x的下限,ub为x的上限。
本发明提供了一种基于二次规划的运动目标单站定位方法,使得在样本捕获量较小的情况下,也能对运动目标实现单站定位,并且保持定位结果的精确度。
附图说明
图1为运动目标单站定位模型示意图;
图2为所述二次规划算法仿真示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,本实施例将参照附图,对本发明的实施方式进行进一步详述。需要说明的是,本实施例在以本发明技术方案为前提下进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
步骤1,运动观测平台截获运动目标的信号;
步骤2,所述运动观测平台对在其自身运动轨迹上获得的所述运动目标信号进行波达方向(DoA)估计,得出所述运动目标的DoA不连续测量值:
如图1所示,ti,i=0,1,2,...,M-1表示平台截获到目标信号并进行了DoA估计的时刻,φi,θi,ri分别表示在ti时刻所述运动观测平台观测到的所述运动目标相对所述运动观测平台的方位角、俯仰角和距离在大地坐标系x-O-y中的值。ti时刻的φi,θi,ri与平台位置pPi=[xPi yPi zPi]T以及目标位置pTi=[xTi yTi zTi]T之间的关系表示为:
步骤3,利用所述步骤2得出的DoA不连续测量值,建立目标分段直线运动模型:
将所述运动目标的运动轨迹按照ti时刻划分成若干段,并且假设在每段上,所述运动目标是匀速直线运动,速度为vTi=[vxi vyi vzi]T,且此速度小于某个极限值;
为目标与平台之间的距离、目标速度和目标初始位置的矩阵,其矩阵大小为(M+6)×1;为平台位置矩阵,其大小为3M×1,则
平台位置估计值与理论值的误差e表示为:
e=Bx-pP
矩阵B为大小为3M×(M+6),其中矩阵Ai=[sinθicosφi sinθisinφi cosθi]T;
则误差的平方E表示为:
步骤4,利用所述步骤3得出的所述信号模型,构造基于二次规划的运动目标定位,获得所述运动目标的运动轨迹:
所述基于二次规划的运动目标定位算法可表示为:
s.t.lb≤x≤ub;
其中lb与ub为x的约束范围,其中lb为x的下限,ub为x的上限;
仿真实验
运用内点法(interior point)、active set和共轭梯度法等方法将所述基于二次规划的运动目标定位算法进行仿真,结果如附图2所示,图中的加号代表平台的运动轨迹,圆圈代表目标位置的理论值,星号代表的是目标的DoA测量误差引起的位置偏差,三角代表的是目标经过所述基于二次规划的运动目标单站定位算法以后的位置估计值。可以看出仅仅在有10个样本点以及目标存在运动的情况下,目标的运动轨迹仍然可以进行估计,并且保证了较高的相对精度,这是以往的静止目标定位算法所不能实现的。
Claims (4)
1.基于二次规划的运动目标单站定位方法,其特征在于,所述基于二次规划的运动目标单站定位方法的实施步骤如下:
步骤1,运动观测平台截获运动目标的信号;
步骤2,所述运动观测平台对在其自身运动轨迹上获得的所述运动目标信号进行波达方向(DoA)估计,得出所述运动目标的DoA不连续测量值;
步骤3,利用所述步骤2得出的所述DoA不连续测量值,建立信号模型;
步骤4,利用所述步骤3得出的信号模型构造构造基于二次规划的运动目标定位,获得所述运动目标的运动轨迹。
2.根据权利要求1所述的基于二次规划的运动目标单站定位方法,其特征在于,步骤2实现步骤如下:
记ti,i=0,1,2,...,M-1表示平台截获到目标信号并进行了DoA估计的时刻,φi,θi,ri分别表示在ti时刻所述运动观测平台观测到的所述运动目标相对所述运动观测平台的方位角、俯仰角和距离在大地坐标系x-O-y中的值;所述运动观测平台的位置用矩阵pPi=[xPiyPi zPi]T表示,所述运动目标的位置用矩阵pTi=[xTi yTi zTi]T表示;则所述ti时刻的方位角、俯仰角和距离在大地坐标系x-O-y中的值、所述运动观测平台位置以及所述运动目标位置之间的关系表示为:
3.根据权利要求1所述的基于二次规划的运动目标单站定位方法,其特征在于,所述步骤3中,利用所述DoA不连续测量值建立的信号模型为目标分段直线模型,实现步骤如下:
将所述运动目标的运动轨迹按照ti时刻划分成若干段,并且假设在每段上,所述运动目标是匀速直线运动,速度为vTi=[vxi vyi vzi]T,且此速度小于某个极限值;
为目标与平台之间的距离、目标速度和目标初始位置的矩阵,其矩阵大小为(M+6)×1;为所述运动观测平台位置矩阵,其大小为3M×1,则
所述运动观测平台位置估计值与理论值的误差e表示为:
e=Bx-pP
矩阵B为大小为3M×(M+6),其中矩阵Ai=[sinθi cosφisinθi sinφi cosθi]T;
则所述误差的平方E表示为:
4.根据权利要求1所述的基于二次规划的运动目标单站定位方法,其特征在于,所述步骤4中利用所述步骤3得出的信号模型构造的基于二次规划的运动目标定位为:
s.t.lb≤x≤ub;
其中lb与ub为x的约束范围,其中lb为x的下限,ub为x的上限。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410093019.5A CN103886192B (zh) | 2014-03-13 | 2014-03-13 | 基于二次规划的运动目标单站定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410093019.5A CN103886192B (zh) | 2014-03-13 | 2014-03-13 | 基于二次规划的运动目标单站定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103886192A CN103886192A (zh) | 2014-06-25 |
CN103886192B true CN103886192B (zh) | 2017-01-11 |
Family
ID=50955082
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410093019.5A Expired - Fee Related CN103886192B (zh) | 2014-03-13 | 2014-03-13 | 基于二次规划的运动目标单站定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103886192B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108089147B (zh) * | 2017-12-07 | 2021-05-11 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 改进的短波单站定位方法 |
CN111413669A (zh) * | 2020-03-20 | 2020-07-14 | 西安电子科技大学 | 基于相位差及其变化率和多普勒频率变化率的定位方法 |
CN113484855B (zh) * | 2021-07-21 | 2023-02-28 | 电子科技大学 | 一种外辐射源的单站定位方法 |
CN116520237A (zh) * | 2022-01-20 | 2023-08-01 | 大唐移动通信设备有限公司 | 检测方法、通信设备、装置及存储介质 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101561499A (zh) * | 2009-05-25 | 2009-10-21 | 中国航空无线电电子研究所 | 一种单站多普勒测距定位方法 |
CN102147455A (zh) * | 2010-01-18 | 2011-08-10 | 张登科 | 多天线单元信号分析处理、测向方法及系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9084217B2 (en) * | 2012-01-03 | 2015-07-14 | Wavion Ltd. | Single-site localization via multipath fingerprinting |
-
2014
- 2014-03-13 CN CN201410093019.5A patent/CN103886192B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101561499A (zh) * | 2009-05-25 | 2009-10-21 | 中国航空无线电电子研究所 | 一种单站多普勒测距定位方法 |
CN102147455A (zh) * | 2010-01-18 | 2011-08-10 | 张登科 | 多天线单元信号分析处理、测向方法及系统 |
Non-Patent Citations (2)
Title |
---|
《Convex Quadratic Programming for Object Localization》;Hao Jiang 等;《The 18th International Conference on Pattern Recognition》;20061231;全文 * |
《基于TOA和DOA的两部单站定位算法》;王旭 等;《AEIT 2011》;20111231;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN103886192A (zh) | 2014-06-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Feng et al. | Kalman-filter-based integration of IMU and UWB for high-accuracy indoor positioning and navigation | |
CN105928518B (zh) | 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法 | |
CN103886192B (zh) | 基于二次规划的运动目标单站定位方法 | |
CN107300697A (zh) | 基于无人机的运动目标ukf滤波方法 | |
CN103744052B (zh) | 一种应用于空中目标定位的双星测时差测向方法及装置 | |
CN106352869A (zh) | 移动机器人室内定位系统及其计算方法 | |
CN106019217A (zh) | 基于aoa的二维无线传感器网络半定规划定位方法 | |
CN102506872B (zh) | 一种判定飞行航路偏离的方法 | |
CN105992959B (zh) | 用于确定至少两个传感器的布置的方法和传感器网络 | |
CN104535080B (zh) | 大方位失准角下基于误差四元数的传递对准方法 | |
CN103148854A (zh) | 基于单轴正反转动的mems惯导系统姿态测量方法 | |
CN104501801A (zh) | 一种室内定位方法 | |
CN109061615A (zh) | 被动声纳中非线性系统的目标运动参数估计方法及装置 | |
CN105044667A (zh) | 一种运动目标的双星跟踪方法、装置和系统 | |
CN104316058B (zh) | 一种采用交互多模型的移动机器人wsn/ins组合导航方法 | |
CN106054185B (zh) | 一种基于分布式POS的机载双天线InSAR基线计算方法 | |
CN108398670A (zh) | 一种基于旋转干涉仪的脉冲信号测向方法及装置 | |
CN104569915A (zh) | 多光电探测系统中基于目标运动模型的定位方法 | |
CN102384755A (zh) | 机载相控阵天气雷达高精度测量瞬时航速方法 | |
CN106646413A (zh) | 一种雷达组网垂线交叉融合定位方法及误差解算方法 | |
CN102707268A (zh) | 机动雷达组网批处理式误差配准器 | |
CN104050641A (zh) | 基于形状方位描述符的集中式多传感器编队目标粒子滤波算法 | |
CN103759922A (zh) | 一种航天遥感器二维指向镜指向精度测量方法 | |
CN110471029A (zh) | 一种基于扩展卡尔曼滤波的单站无源定位方法及装置 | |
CN108387229A (zh) | 一种基于单轴旋转调制的mems惯性导航系统及寻北方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170111 Termination date: 20180313 |