CN100359336C - 基于小波变换的双平台纯角度机动目标融合跟踪方法 - Google Patents
基于小波变换的双平台纯角度机动目标融合跟踪方法 Download PDFInfo
- Publication number
- CN100359336C CN100359336C CNB2003101089349A CN200310108934A CN100359336C CN 100359336 C CN100359336 C CN 100359336C CN B2003101089349 A CNB2003101089349 A CN B2003101089349A CN 200310108934 A CN200310108934 A CN 200310108934A CN 100359336 C CN100359336 C CN 100359336C
- Authority
- CN
- China
- Prior art keywords
- target
- space
- model
- information
- platform
- 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
Images
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
一种基于小波变换的双平台纯角度机动目标融合跟踪方法,使用无源定位的方法对各个观测平台角度观测下的目标进行定位,以避免纯角度跟踪下的非线性滤波,对目标的高速定位数据使用小波变换的方法进行数据压缩和特征提取,在模式空间使用基于多速率运动模型的交互式多模型算法进行目标运动估计,模式空间的估计结果使用小波逆变换的方法转回量测空间从而获得了目标的状态估计。本发明提供了一种高速双平台角度量测下的机动目标跟踪方法,具有运算量小和滤波精度高的特点,可广泛应用于机器人,智能交通,空中交通管制和航天、航空、航海等各领域。
Description
技术领域:
本发明涉及一种基于小波变换的双平台纯角度机动目标融合跟踪方法,是融合跟踪领域内的一种关于高速率角度量测下的目标跟踪方法,可在民用领域(机器人、空中交通管制和智能交通等领域)和军事领域(光学、声学纯角度机动目标跟踪等领域)广泛应用。
背景技术:
纯角度跟踪是跟踪领域内的一种重要的跟踪方法,该方法利用观测平台获得的关于目标的角度信息对目标的状态进行估计。但由于单站纯角度跟踪本身固有的非线性和量测数据的不完全性以及机动目标运动状态的多交性使得纯角度跟踪的跟踪效果不能令人满意。为了提高纯角度跟踪的效果在实际使用中往往采用布置在不同平台上的两个角度传感器对机动目标的运动状态进行估计。当目标和两个传感器不共线时目标的量测数据是完全的,可以对机动目标进行较好的估计。
纯角度跟踪中常用的滤波方法主要有:扩展Kalman滤波算法,伪线性滤波算法和修正极坐标滤波算法等。其中扩展Kalman滤波算法因概念清晰、运算简单而获得广泛的应用。但该方法由于是非线性滤波方法,属于次优滤波方法。
在机动目标跟踪算法方面,近些年出现了多种算法,其中交互式多模型算法以其较好的滤波效果和合理的费效比而获得跟踪领域研究人员的青睐。交互式多模型算法具有自动调整滤波器带宽的特点,当模型集的选择能覆盖目标的运动状态时,可对目标实现自适应跟踪。
随着技术的发展,角度量测数据的获得速率越来越高,合理有效利用高速率量测数据成为跟踪领域内的一个重要问题。传统的数据压缩方法采用的是等权或变权平均量测预处理方法。该类方法有效降低了量测噪声,但是由于在计算平均残差时要多次进行目标状态的一步预测,因此计算量较大。另外,该方法在数据压缩中只简单利用序列量测数据,对序列量测数据中的相关信息(速度信息)没有充分利用,因此等权或变权平均量测预处理方法对速度和加速度状态的估计效果不是很理想。
发明内容:
本发明的目的在于针对现有技术存在的不足,提供一种基于小波变换的双平台纯角度机动目标融合跟踪方法,避免角度量测下的非线性滤波,减少计算量,在数据压缩的同时合理利用序列量测信息,提取量测序列的高频信息,对估计精度的提高起到重要作用。
为实现上述目的,本发明技术方案的创新点在于首先把各个平台的角度量测利用无源定位的方法进行融合定位,以避免纯角度跟踪的非线性滤波,同时为使用小波变换的方法对量测信息进行数据压缩创造条件。然后,使用小波变换的方法对高速率融合定位的数据进行数据压缩和特征提取,并使用基于多速率运动模型的交互式多模型算法在模式空间进行状态估计。最后,模式空间的滤波结果通过小波逆变换的方法变换回量测空间。
本发明的方法包括如下具体步骤:
1.确定观测平台在统一坐标系内的坐标。观测平台位置的确定有多种方法,可以由GPS(全球定位系统)或类似GPS的系统定位,也可以利用GPS和INS(惯性导航系统)组合导航等方法进行定位,将观测平台本身的定位信息通过坐标转换的方法转换到与观测目标统一的坐标系。
2.确定观测目标在统一坐标系内的坐标。在获得观测平台本身的定位信息和目标的高速角度量测信息情况下,使用无源定位的方法对目标进行融合定位,并计算融合定位的误差的协方差矩阵,由此获得目标的高速融合定位信息。
3.对获得的高速融合定位信息使用小波变换的方法进行数据压缩和特征提取,获得序列高速融合定位信息的高频分量和低频分量,高频分量对应测量空间的速度信息,低频分量对应测量空间的位置信息。提取的高频分量和低频分量即为模式空间的量测信息。
4.对获得的模式空间的量测信息使用基于多速率运动模型的交互式多模型算法在模式空间进行交互、滤波、模型概率更新和模式空间输出组合从而完成模式空间的状态估计。
5.使用小波逆变换将该模式空间的估计结果转换为在量测空间中对目标的估计。这样就完成了基于小波变换的双平台纯角度机动目标融合跟踪。
本发明通过引入无源定位的方法和小波变换的方法提出了基于小波变换的双平台纯角度机动目标融合跟踪方法,把纯角度跟踪中的非线性滤波问题,化为线性滤波问题,避免了非线性滤波算法在泰勒展开时引入的舍入误差。本发明使用基于小波变换的数据压缩的方法,降低了量测噪声。小波变换的数据压缩的方法和常用的数据压缩方法相比,在数据压缩的同时合理利用了序列量测信息,提取了量测序列的高频信息(速度信息),这对估计精度的提高起到重要作用,另外使用小波变换的方法对量测数据进行压缩避免了传统数据压缩方法要多次预测目标的状态这一步骤,因此大大减少了计算量。
本发明为处理双站高速率角度量测数据下的机动目标跟踪提供了一种新的有效方法,具有运算量小和滤波精度高的特点,可广泛应用于机器人,智能交通,空中交通管制和航天、航空、航海等各领域。
附图说明:
图1为本发明基于小波变换的双平台纯角度机动目标融合跟踪方法流程图。
图2为本发明基于小波变换的双平台纯角度机动目标融合跟踪方法计算流程图。
图3为本发明实施例中观测平台、目标运动轨迹图。
图4为本发明实施例中目标x轴方向位置均方根误差比较图(无站址误差)。
图5为本发明实施例中目标x轴方向上速度均方根误差比较图(无站址误差)。
图6为本发明实施例中目标y轴方向上位置均方根误差比较图(无站址误差)。
图7为本发明实施例中目标y轴方向上速度均方根误差比较图(无站址误差)。
图8为本发明实施例中目标x轴方向位置均方根误差比较图(有站址误差)。
图9为本发明实施例中目标x轴方向上速度均方根误差比较图(有站址误差)。
图10为本发明实施例中目标y轴方向上位置均方根误差比较图(有站址误差)。
图11为本发明实施例中目标y轴方向上速度均方根误差比较图(有站址误差)。
具体实施方式:
为了更好地理解本发明的技术方案,以下结合实施例对本发明的实施步骤作进一步描述。
实施例中假设目标和载机在二维平面内运动,其运动情况如图3所示。其中载机速度为300m/s,且分别以(10000,10000)和(10000,30000)为圆心作向心加速度为30m/s2圆周运动。目标运动分为三阶段:开始目标从起始点(30000,15000)以300m/s的速度沿x轴正方向飞行67s;然后目标以20m/s2的向心加速度左转机动,机动时间为47s;目标机动结束后继续以300m/s的速度作匀速直线运动到180s结束。目标角度量测误差的标准差为0.001rad。
本发明基于小波变换的双平台纯角度机动目标融合跟踪方法按图1所示流程进行。
首先由GPS定位系统获得观测平台本身的定位信息,并把该定位信息转换到和目标相同的坐标系内。由观测平台自身携带的角度传感器获得目标相对于观测平台的角度测量信息,由上述信息获得目标的融合定位信息。目标的融合定位信息可由下式获得:
对获得的高速率融合定位信息采用小波变换的方法进行数据压缩和特征提取,具体方法如下:
zi表示第i个时刻直角坐标系下融合定位信息。Zk p为第k个时刻模式空间内的量测信息。
获得模式空间内的量测信息后采用基于多速率运动模型的交互式多模型算法在模式空间进行滤波。多速率运动模型采用1/3速率运动模型。1/3速率常速模型和1/3速率常加速模型分别为:
1/3速率常速模型:
状态方程:
量测方程:
1/3速率常加速模型:
基于多速率运动模型的交互式多模型算法包括四部分,具体实现为:
1、交互作用:已知模式空间k-3时刻的滤波结果
和模型概率μi(k-3),则交互作用可表述为:
j=m,n。m表示多速率常加速模型模型,n表示多速率常速模型。
2、滤波:
在模式空间使用各个多速率运动模型进行Kalman滤波
3、模型概率更新:
似然函数:
Λj(k)=N(rj(k);0,Sj(k)) (8)
概率更新:
4、式空间输出组合:
模式空间内的滤波结果由小波逆变换的方法转换回测量空间,具体实现为
由此完成基于小波变换的双平台纯角度机动目标融合跟踪。
以下给出观测平台自身位置无量测误差 和观测平台自身位置有量测误差(误差的标准差为5m)两种情况下的仿真实例,并和使用扩展Kalman滤波器的交互式多模型算法(表示为IMMEKF)进行了比较。
仿真结果如图4-图11所示,其中从图4-图7可以看出在无站址误差的情况下本发明方法(MRIMM方法)对目标各方向轴上的位置、速度估计比使用扩展Kalman滤波器的交互式多模型方法(IMMEKF方法)有了一定的提高,从仿真结果图8-图11可以看出在观测平台存在站值误差时MRIMM方法比IMMEKF方法也有一定提高。从实现方法可以看出本方法(MRIMM方法)计算量仅为原来算法(IMMEKF方法)的三分之一。
Claims (1)
1、一种基于小波变换的双平台纯角度机动目标融合跟踪方法,其特征在于包括如下具体步骤:
1)确定观测平台在统一坐标系内的坐标,将观测平台本身的定位信息通过坐标转换的方法转换到与观测目标统一的坐标系;
2)确定观测目标在统一坐标系内的坐标,在获得观测平台本身的定位信息和目标的高速角度量测信息情况下,使用无源定位的方法对目标进行融合定位,并计算融合定位的误差的协方差矩阵,由此获得目标的高速融合定位信息;
3)对获得的高速融合定位信息使用小波变换方法进行数据压缩和特征提取,获得序列高速融合定位信息的高频分量和低频分量,高频分量对应测量空间的速度信息,低频分量对应测量空间的位置信息,提取的高频分量和低频分量即为模式空间的量测信息;
4)对获得的模式空间的量测信息使用基于多速率运动模型的交互式多模型算法在模式空间进行交互、滤波、模型概率更新和模式空间输出组合,从而完成模式空间的状态估计;
5)使用小波逆变换将该模式空间的估计结果转换为在量测空间中对目标的估计,完成基于小波变换的双平台纯角度机动目标融合跟踪。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2003101089349A CN100359336C (zh) | 2003-11-27 | 2003-11-27 | 基于小波变换的双平台纯角度机动目标融合跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2003101089349A CN100359336C (zh) | 2003-11-27 | 2003-11-27 | 基于小波变换的双平台纯角度机动目标融合跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1544957A CN1544957A (zh) | 2004-11-10 |
CN100359336C true CN100359336C (zh) | 2008-01-02 |
Family
ID=34334948
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB2003101089349A Expired - Fee Related CN100359336C (zh) | 2003-11-27 | 2003-11-27 | 基于小波变换的双平台纯角度机动目标融合跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100359336C (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070182623A1 (en) * | 2006-02-03 | 2007-08-09 | Shuqing Zeng | Method and apparatus for on-vehicle calibration and orientation of object-tracking systems |
CN110208791B (zh) * | 2019-06-24 | 2020-02-14 | 哈尔滨工业大学 | 一种纯角度跟踪伪线性滤波方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1389710A (zh) * | 2002-07-18 | 2003-01-08 | 上海交通大学 | 多传感器多目标信息融合方法 |
WO2003021288A2 (en) * | 2001-08-29 | 2003-03-13 | Isis Innovation Limited | Surface texture determination method and apparatus |
CN1431523A (zh) * | 2003-01-16 | 2003-07-23 | 上海交通大学 | 遥感图像双线性插值小波变换融合的优化方法 |
-
2003
- 2003-11-27 CN CNB2003101089349A patent/CN100359336C/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2003021288A2 (en) * | 2001-08-29 | 2003-03-13 | Isis Innovation Limited | Surface texture determination method and apparatus |
CN1389710A (zh) * | 2002-07-18 | 2003-01-08 | 上海交通大学 | 多传感器多目标信息融合方法 |
CN1431523A (zh) * | 2003-01-16 | 2003-07-23 | 上海交通大学 | 遥感图像双线性插值小波变换融合的优化方法 |
Non-Patent Citations (2)
Title |
---|
仅有角测量的被动式机动目标跟踪. 王晓华,敬忠良.控制理论与应用,第19卷第6期. 2002 * |
基于交互多模算法在非线性测量方程下的机动目标跟踪. 刘丹,王宏强,黎湘.电光与控制,第9卷第4期. 2002 * |
Also Published As
Publication number | Publication date |
---|---|
CN1544957A (zh) | 2004-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110703762B (zh) | 一种复杂环境下水面无人艇混合路径规划方法 | |
CN103471589B (zh) | 一种室内行人行走模式识别和轨迹追踪的方法 | |
CN105891863B (zh) | 一种基于高度约束的扩展卡尔曼滤波定位方法 | |
CN103471595A (zh) | 一种面向ins/wsn室内移动机器人紧组合导航的迭代扩展rts均值滤波方法 | |
CN109283490B (zh) | 基于混合最小二乘法的泰勒级数展开的uwb定位方法 | |
CN106643694B (zh) | 一种机器人室内定位方法 | |
CN104914865A (zh) | 变电站巡检机器人定位导航系统及方法 | |
CN103487047A (zh) | 一种基于改进粒子滤波的移动机器人定位方法 | |
CN103400416B (zh) | 一种基于概率多层地形的城市环境机器人导航方法 | |
CN104061932A (zh) | 一种利用引力矢量和梯度张量进行导航定位的方法 | |
CN105222780A (zh) | 一种基于Stirling插值多项式逼近的椭球集员滤波方法 | |
CN114013427B (zh) | 用于自动泊车测试的泊车数据处理方法 | |
CN108387236A (zh) | 一种基于扩展卡尔曼滤波的偏振光slam方法 | |
CN104507097A (zh) | 一种基于WiFi位置指纹的半监督训练方法 | |
CN112857370A (zh) | 一种基于时序信息建模的机器人无地图导航方法 | |
CN108332756B (zh) | 一种基于拓扑信息的水下航行器协同定位方法 | |
CN111025229B (zh) | 一种水下机器人纯方位目标估计方法 | |
CN107356932A (zh) | 机器人激光定位方法 | |
CN100359336C (zh) | 基于小波变换的双平台纯角度机动目标融合跟踪方法 | |
CN112683263B (zh) | 一种基于改进模型的uwb/imu/odom多传感器数据融合移动机器人定位方法 | |
CN112595320A (zh) | 基于ros的室内智能轮椅高精定位自主导航方法及系统 | |
CN111693044A (zh) | 一种融合定位方法 | |
CN115103437B (zh) | 一种蓝牙和惯性测量单元的紧耦合室内定位方法 | |
CN114840003B (zh) | 一种单领航多auv协同定位及轨迹跟踪控制方法 | |
CN116242348A (zh) | 一种室内移动机器人自动导航系统及其导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20080102 Termination date: 20101127 |