CN106569179A - 一种基于遗传粒子滤波算法的水下目标跟踪定位方法 - Google Patents
一种基于遗传粒子滤波算法的水下目标跟踪定位方法 Download PDFInfo
- Publication number
- CN106569179A CN106569179A CN201610981816.6A CN201610981816A CN106569179A CN 106569179 A CN106569179 A CN 106569179A CN 201610981816 A CN201610981816 A CN 201610981816A CN 106569179 A CN106569179 A CN 106569179A
- Authority
- CN
- China
- Prior art keywords
- particle
- moment
- target
- coordinate
- hydrophone
- 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
Classifications
-
- 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/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
- G01S5/30—Determining absolute distances from a plurality of spaced points of known location
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种基于遗传粒子滤波算法的水下目标跟踪定位方法包括以下步骤:(1)部署水下目标跟踪定位系统:在水域内安装m个水听器,在跟踪定位目标上安装超声波换能器和水压深度计;(2)在水域内建立三维坐标系,获取水听器坐标(xj,yj,zj)、跟踪定位目标与m个水听器之间的测量距离sj、定位目标的深度h,其中j∈(1,2,...,m),表示水听器序号;(3)根据跟踪定位目标与水听器之间的测量距离建立测量方程;(4)应用遗传粒子滤波算法对水下目标进行跟踪定位,即预测跟踪定位目标在k时刻的坐标值。与现有技术相比,该方法具有较高的稳定性和定位精度。
Description
技术领域
本发明属于目标跟踪定位导航领域,具体涉及一种水下目标跟踪定位方法。
背景技术
粒子滤波(PF:Particle Filter)的思想基于蒙特卡洛方法(Monte Carlomethods),它是利用粒子集来表示概率,可以用在任何形式的状态空间模型上。其核心思想是通过从后验概率中抽取的随机状态粒子来表达其分布,是一种顺序重要性采样法。尽管算法中的概率分布只是真实分布的一种近似,但由于非参数化的特点,它摆脱了解决非线性滤波问题时随机量必须满足高斯分布的制约,能表达比高斯模型更广泛的分布,也对变量参数的非线性特性有更强的建模能力。
水下目标跟踪定位系统多采用水声定位的方法,即基线定位导航形式。以一定阵列形式在水域内分布一定数量的水听器,超声波换能器和水压深度计安装在定位目标上,利用这些水听器接收超声波换能器发出的脉冲,将接收的脉冲信号进行处理后,再按照预定的数学模型对其计算,声源的位置就可得到。为提高精度及简化计算量,也可用深度传感器测量目标的深度值,结合目标与已知参照点的距离信息跟踪目标位置。
由于水下定位的数学模型是非线性的,故一般的最小二乘、卡尔曼滤波等方法不能有效的进行解算。应用加权最小二乘法或其他经典迭代法进行解算,对定位精度的提升效果也不大。
发明内容
发明目的:针对现有技术中存在的问题,本发明公开了一种基于遗传优化粒子滤波算法的水下目标跟踪定位方法以提高定位精度。
技术方案:一种基于遗传粒子滤波算法的水下目标跟踪定位方法,包括以下步骤:
(1)部署水下目标跟踪定位系统:在水域内安装m个水听器,在跟踪定位目标上安装超声波换能器和水压深度计;
(2)在水域内建立三维坐标系,获取水听器坐标(xj,yj,zj)、跟踪定位目标与m个水听器之间的测量距离sj、定位目标的深度h,其中j∈(1,2,...,m),表示水听器序号;记跟踪定位目标在k时刻的坐标值为Xk=(xk,yk,h);
(3)根据跟踪定位目标与水听器之间的测量距离建立k时刻测量方程:
其中 表示k时刻目标与第j个水听器之间的测量距离,为k时刻定位目标与第j个水听器之间的实际距离,为k时刻测量时引入的噪声,是方差为σ2的高斯白噪声;
(4)应用遗传粒子滤波算法对水下目标进行跟踪定位,即预测跟踪定位目标在k时刻的坐标值。
优选地,水听器以一定阵列的形式分布在水域内。
优选地,三维坐标系以任意一个水听器位置为坐标原点。
具体地,步骤(4)具体包括如下步骤:
(41)算法参数初始化:定义k时刻适应度函数:
其中S0 k|k-1为预测测量距离;
定义S1,k={S1,S2,…,Sk},X1,k={X1,X2,…,Xk};以前一时刻的预测结果作为初始状态,根据先验概率在取值范围内采样,得到一个初始的N点目标坐标粒子集其中每个粒子表示跟踪定位目标的一个可能坐标值,i为粒子序号;令每个粒子权值的初始值为1/N,重采样门限为Nth=N/2;
(42)在k时刻进行重要性采样,得到k时刻的目标坐标粒子集其中表示k时刻目标坐标粒子集中的第i个粒子,即k时刻跟踪定位目标的一个可能坐标值;为此粒子权值;
(43)判断是否要重采样:如果则进行重采样;否则粒子集即为预测粒子集;
(44)如果需要重采样,对目标坐标粒子集重采样获得预测粒子集其中表示k时刻目标坐标粒子集中的第i个粒子的预测值,为此粒子权值;
(45)根据预测粒子集计算跟踪定位目标坐标在k时刻的预测坐标值
(46)若跟踪定位未完成则进行状态更新,跳转到步骤(42)预测下一时刻的坐标值。
具体地,步骤(42)具体包括如下步骤:
(421)对重要性函数进行采样:从重要性函数中采样得到粒子集其中表示k时刻目标坐标粒子集中的第i个粒子,代表粒子权值;优选地,重要性函数选取概率密度函数p(Xk|Xk-1);
(422)权值更新:计算每个粒子的权值
其中i∈(1,...,N);
(423)权值归一化:
具体地,步骤(44)具体包括如下步骤:
(441)选择新粒子集:采用轮盘赌算法,以粒子权值为选择概率选择N个新粒子构成新粒子集
(442)交叉操作:新旧粒子集中分别随机取对应粒子进行交叉,产生两个新粒子,任选其一代替重复操作产生新粒子集其中交叉概率为:
k1为防止种群停止进化设置的偏移量,0<k1<1;
(443)变异操作:在粒子集中随机选取粒子进行变异操作,即以变异概率改变粒子某一些基因值为其他值,产生预测粒子构成预测粒子集变异概率为:
其中k2为偏移量,0<k2<1。
有益效果:与现有技术相比,本发明公开的水下目标跟踪定位方法通过采用基线原理结合遗传粒子滤波算法对水下目标进行跟踪定位求解,极大的提高了目标定位精度,且其具有有效性、鲁棒性和实时性。
附图说明
图1为本发明应用遗传粒子滤波算法对水下目标跟踪定位的流程图;
图2实施例中水下目标跟踪定位系统部署示意图。
具体实施方式
下面结合附图和具体实施方式,进一步阐明本发明。
图1为本发明公开的基于遗传粒子滤波算法对水下目标跟踪定位的流程图,包括以下步骤:
(1)部署水下目标跟踪定位系统:在水域内安装m个水听器,在跟踪定位目标上安装超声波换能器和水压深度计;
本实施例中采用3个水听器以三角阵列形式分布在水域内。
(2)在水域内建立三维坐标系,获取水听器坐标(xj,yj,zj)、跟踪定位目标与m个水听器之间的测量距离sj、定位目标的深度h,其中j∈(1,2,...,m),表示水听器序号;记跟踪定位目标在k时刻的坐标值为Xk=(xk,yk,h);
水域内水听器有3个,以水听器1位置为原点建立三维坐标系,取东为x轴,北为y轴,深度方向为z轴,目标即换能器与水听器的距离通过水声测距原理得到,深度信息由水压计测得。水听器的坐标记为(xj,yj,zj),j=1,2,3,目标与水听器之间的距离记为sj,j=1,2,3,目标的深度为h,目标的xy平面坐标为(x,y);其中有:
上式中c为声波传播速度,dj是时延估计测量值,为定位目标与第j个水听器之间的实际距离,vj为测量时引入的噪声,可认为是独立同分布的方差为σ2的高斯白噪声。
(3)根据跟踪定位目标与水听器之间的测量距离建立k时刻测量方程;
目标位于水域内,根据几何定律,目标坐标与水听器坐标之间存在以下定位关系:
记,S=[s1,s2,s3],k时刻目标的XY平面坐标即状态量为Xk=(xk,yk),可得k时刻系统测量方程为:
即:
其 表示k时刻目标与第j个水听器之间的测量距离,为定位目标与第j个水听器之间的实际距离,为k时刻测量时引入的噪声,是方差为σ2的高斯白噪声;
k时刻的状态方程为:
Xk=AXk-1+Buk
上式中uk的每一分量均为服从高斯分布N(0,Q)的白噪声,A为状态转移矩阵,根据目标运动状态确定;矩阵B为
其中,T是系统观察周期。
(4)应用遗传粒子滤波算法对水下目标进行跟踪定位,即预测跟踪定位目标在k时刻的坐标值,具体包括如下步骤:
(41)算法参数初始化:获取测量值,定义k时刻适应度函数:
其中S0 k|k-1为预测测量距离;
定义S1,k={S1,S2,…,Sk},X1,k={X1,X2,…,Xk};以前一时刻的预测结果作为初始状态,根据先验概率在取值范围内采样,得到一个初始的N点目标坐标粒子集其中每个粒子表示跟踪定位目标的一个可能坐标值,i为粒子序号;令每个粒子权值的初始值为1/N,重采样门限为Nth=N/2;
(42)在k时刻进行重要性采样,得到k时刻的目标坐标粒子集其中表示k时刻目标坐标粒子集中的第i个粒子,即k时刻跟踪定位目标的一个可能坐标值;为此粒子权值;
重要性采样包括如下步骤:
(421)对重要性函数进行采样:从重要性函数中采样得到粒子集其中表示k时刻目标坐标粒子集中的第i个粒子,代表粒子权值;重要性函数选取为概率密度函数p(Xk|Xk-1);
(422)权值更新:计算每个粒子的权值
其中i∈(1,...,N);
(423)权值归一化:
(43)判断是否要重采样:
如果则进行重采样;否则粒子集即为预测粒子集;
(44)如果需要重采样,对目标坐标粒子集重采样获得预测粒子集其中表示k时刻目标坐标粒子集中的第i个粒子的预测值,为此粒子权值;
重采样获得预测粒子集包括如下步骤:
(441)选择新粒子集:采用轮盘赌算法,以粒子权值为选择概率选择N个新粒子构成新粒子集
(442)交叉操作:新旧粒子集中分别随机取对应粒子进行交叉,产生两个新粒子,任选其一代替重复操作产生新粒子集其中交叉概率为:
k1为防止种群停止进化设置的偏移量,0<k1<1;
(443)变异操作:在粒子集中随机选取粒子进行变异操作,即以变异概率改变粒子某一些基因值为其他值,产生预测粒子构成预测粒子集变异概率为:
其中k2为偏移量,0<k2<1。
(45)根据预测粒子集计算跟踪定位目标坐标在k时刻的预测坐标值
(46)若跟踪定位未完成则进行状态更新,跳转到步骤(41)预测下一时刻的坐标值,直至目标跟踪结束。
Claims (7)
1.一种基于遗传粒子滤波算法的水下目标跟踪定位方法,其特征在于,包括以下步骤:
(1)部署水下目标跟踪定位系统:在水域内安装m个水听器,在跟踪定位目标上安装超声波换能器和水压深度计;
(2)在水域内建立三维坐标系,获取水听器坐标(xj,yj,zj)、跟踪定位目标与m个水听器之间的测量距离sj、定位目标的深度h,其中j∈(1,2,...,m),表示水听器序号;记跟踪定位目标在k时刻的坐标值为Xk=(xk,yk,h);
(3)根据跟踪定位目标与水听器之间的测量距离建立k时刻测量方程:
其中 表示k时刻目标与第j个水听器之间的测量距离,为k时刻定位目标与第j个水听器之间的实际距离,为k时刻测量时引入的噪声,是方差为σ2的高斯白噪声;
(4)应用遗传粒子滤波算法对水下目标进行跟踪定位,即预测跟踪定位目标在k时刻的坐标值。
2.根据权利要求1所述的基于遗传粒子滤波算法的水下目标跟踪定位方法,其特征在于,步骤(1)中所述水听器以一定阵列的形式分布在水域内。
3.根据权利要求1所述的基于遗传粒子滤波算法的水下目标跟踪定位方法,其特征在于,步骤(2)中所述的三维坐标系以任意一个水听器位置为坐标原点。
4.根据权利要求1所述的基于遗传粒子滤波算法的水下目标跟踪定位方法,其特征在于,步骤(4)具体包括如下步骤:
(41)算法参数初始化:定义k时刻适应度函数:
其中S0 k|k-1为预测测量距离;
定义S0,k={S0,S1,…,Sk},X1,k={X1,X2,…,Xk}为到k时刻所有测量和状态量集合;以前一时刻的估计结果作为初始状态,根据先验概率在定位目标坐标值取值范围内采样,得到一个初始的N点目标坐标粒子集其中每个粒子表示跟踪定位目标的一个可能坐标值,i为粒子序号;令每个粒子权值的初始值为1/N,重采样门限为Nth=N/2;
(42)在k时刻进行重要性采样,得到k时刻的目标坐标粒子集其中表示k时刻目标坐标粒子集中的第i个粒子,即k时刻跟踪定位目标的一个可能坐标值;为此粒子权值;
(43)判断是否要重采样:如果则进行重采样;否则粒子集即为预测粒子集;
(44)如果需要重采样,对粒子集重采样获得预测粒子集其中表示k时刻目标坐标粒子集中的第i个粒子的预测值,为此粒子权值;
(45)根据预测粒子集计算跟踪定位目标坐标在k时刻的预测坐标值
(46)若跟踪定位未完成则进行状态更新,跳转到步骤(41)预测下一时刻的坐标值。
5.根据权利要求4所述的基于遗传粒子滤波算法的水下目标跟踪定位方法,其特征在于,步骤(42)具体包括如下步骤:
(421)对重要性函数进行采样:从重要性函数中采样得到粒子集其中表示k时刻目标坐标粒子集中的第i个粒子,代表粒子权值;重要性函数选取为概率密度函数p(Xk|Xk-1);
(422)权值更新:计算每个粒子的权值
其中i∈(1,...,N)。
6.根据权利要求5所述的基于遗传粒子滤波算法的水下目标跟踪定位方法,其特征在于,所述重要性函数为概率密度函数p(Xk|Xk-1)。
7.根据权利要求4所述的基于遗传粒子滤波算法的水下目标跟踪定位方法,其特征在于,步骤(44)具体包括如下步骤:
(441)选择新粒子集:采用轮盘赌算法,以粒子权值为选择概率选择N个新粒子构成新粒子集
(442)交叉操作:新旧粒子集中分别随机取对应粒子进行交叉,产生两个新粒子,任选其一代替重复操作产生新粒子集其中交叉概率为:
k1为防止种群停止进化设置的偏移量,0<k1<1;
(443)变异操作:在粒子集中随机选取粒子进行变异操作,即以变异概率改变粒子某一些基因值为其他值,产生预测粒子构成预测粒子集变异概率为:
其中k2为偏移量,0<k2<1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610981816.6A CN106569179B (zh) | 2016-11-08 | 2016-11-08 | 一种基于遗传粒子滤波算法的水下目标跟踪定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610981816.6A CN106569179B (zh) | 2016-11-08 | 2016-11-08 | 一种基于遗传粒子滤波算法的水下目标跟踪定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106569179A true CN106569179A (zh) | 2017-04-19 |
CN106569179B CN106569179B (zh) | 2019-04-30 |
Family
ID=58540511
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610981816.6A Active CN106569179B (zh) | 2016-11-08 | 2016-11-08 | 一种基于遗传粒子滤波算法的水下目标跟踪定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106569179B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109596128A (zh) * | 2019-01-14 | 2019-04-09 | 哈尔滨工程大学 | 一种基于多水听器提高多auv协同定位性能的方法 |
CN111427011A (zh) * | 2020-04-20 | 2020-07-17 | 中国电子科技集团公司电子科学研究院 | 海底资产位置标定方法及系统 |
WO2021045679A1 (en) * | 2019-09-02 | 2021-03-11 | National University Of Singapore | Method and system for object localization, and controlling movement of an autonomous underwater vehicle for object intervention |
CN115130361A (zh) * | 2022-06-27 | 2022-09-30 | 水利部交通运输部国家能源局南京水利科学研究院 | 一种基于粒子算法的水下定位方法 |
CN117807356A (zh) * | 2024-02-29 | 2024-04-02 | 齐鲁工业大学(山东省科学院) | 基于改进麻雀算法优化粒子滤波的双矢量水听器定位方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102830402A (zh) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | 水下传感器网络目标跟踪系统及方法 |
CN105388460A (zh) * | 2015-10-19 | 2016-03-09 | 东南大学 | 一种基于遗传算法的室内水下目标定位方法 |
-
2016
- 2016-11-08 CN CN201610981816.6A patent/CN106569179B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102830402A (zh) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | 水下传感器网络目标跟踪系统及方法 |
CN105388460A (zh) * | 2015-10-19 | 2016-03-09 | 东南大学 | 一种基于遗传算法的室内水下目标定位方法 |
Non-Patent Citations (3)
Title |
---|
叶龙 等: "遗传重采样粒子滤波器", 《自动化学报》 * |
徐驰: "无线传感器网络中机动目标定位与跟踪算法研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
王玲玲 等: "基于形态学与遗传粒子滤波器的红外小目标检测与跟踪算法", 《光子学报》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109596128A (zh) * | 2019-01-14 | 2019-04-09 | 哈尔滨工程大学 | 一种基于多水听器提高多auv协同定位性能的方法 |
CN109596128B (zh) * | 2019-01-14 | 2022-06-21 | 哈尔滨工程大学 | 一种基于多水听器提高多auv协同定位性能的方法 |
WO2021045679A1 (en) * | 2019-09-02 | 2021-03-11 | National University Of Singapore | Method and system for object localization, and controlling movement of an autonomous underwater vehicle for object intervention |
CN111427011A (zh) * | 2020-04-20 | 2020-07-17 | 中国电子科技集团公司电子科学研究院 | 海底资产位置标定方法及系统 |
CN115130361A (zh) * | 2022-06-27 | 2022-09-30 | 水利部交通运输部国家能源局南京水利科学研究院 | 一种基于粒子算法的水下定位方法 |
CN115130361B (zh) * | 2022-06-27 | 2023-05-16 | 水利部交通运输部国家能源局南京水利科学研究院 | 一种基于粒子算法的水下定位方法 |
CN117807356A (zh) * | 2024-02-29 | 2024-04-02 | 齐鲁工业大学(山东省科学院) | 基于改进麻雀算法优化粒子滤波的双矢量水听器定位方法 |
CN117807356B (zh) * | 2024-02-29 | 2024-05-10 | 齐鲁工业大学(山东省科学院) | 基于改进麻雀算法优化粒子滤波的双矢量水听器定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106569179B (zh) | 2019-04-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106569179A (zh) | 一种基于遗传粒子滤波算法的水下目标跟踪定位方法 | |
CN104318059B (zh) | 用于非线性高斯系统的目标跟踪方法和跟踪系统 | |
CN108489498A (zh) | 一种基于最大互相关熵无迹粒子滤波的auv协同导航方法 | |
CN102147465A (zh) | 一种混沌寻优雷达海上目标检测系统及方法 | |
CN104318593B (zh) | 一种雷达海杂波的仿真方法和系统 | |
CN109031229B (zh) | 一种杂波环境下目标跟踪的概率假设密度方法 | |
Wang et al. | Bayesian stochastic soil modeling framework using Gaussian Markov random fields | |
CN107037418A (zh) | 一种低频超指向性多极子矢量阵的有界空间校正方法 | |
CN104066178A (zh) | 一种基于人工神经元网络的室内无线定位指纹生成方法 | |
CN103984996B (zh) | 水华机理时变模型的禁忌搜索及遗传算法优化预测方法 | |
CN117198330A (zh) | 一种声源识别方法、系统及电子设备 | |
Azim | Estimation of fracture network properties from FMI and conventional well logs data using artificial neural network | |
JP3562494B2 (ja) | ソーナー探知範囲予察可視化システム、方法及びプログラム | |
CN113158315B (zh) | 一种基于静力触探数据的岩土体参数三维非平稳条件随机场建模方法 | |
CN105388460A (zh) | 一种基于遗传算法的室内水下目标定位方法 | |
CN109975816A (zh) | 一种微型水下机器人的传感器信息融合方法 | |
CN109933921B (zh) | 一种滚石灾害风险评估方法、装置、系统及存储介质 | |
CN111736127B (zh) | 面向未知海域海杂波的源域生成和分布参数泛化方法 | |
CN104765028B (zh) | 一种高斯随机起伏海底界面混响信号仿真方法 | |
CN113888380A (zh) | 一种人员落水轨迹预测方法、装置、设备和介质 | |
CN107063195A (zh) | 一种基于递归位置估计的大规模水下网络定位方法 | |
de Kerckhove et al. | Measuring fish school swimming speeds with two acoustic beams and determining the angle of the school detection | |
CN117405175B (zh) | 海洋环境智能监测系统 | |
Lin et al. | Backpropagation Neural Network as Earthquake Early Warning Tool using a new Elementary Modified Levenberg–Marquardt Algorithm to minimise Back-propagation Errors | |
KR101568819B1 (ko) | 능동형 정보수집 스크립트 및 수치모형을 이용한 연안침식 자동 예측 방법 |
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 |