CN107064875A - 基于一步状态估计和协方差估计的距离野值剔除方法 - Google Patents
基于一步状态估计和协方差估计的距离野值剔除方法 Download PDFInfo
- Publication number
- CN107064875A CN107064875A CN201710204423.9A CN201710204423A CN107064875A CN 107064875 A CN107064875 A CN 107064875A CN 201710204423 A CN201710204423 A CN 201710204423A CN 107064875 A CN107064875 A CN 107064875A
- Authority
- CN
- China
- Prior art keywords
- estimate
- estimation
- covariance
- state estimation
- mrow
- 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
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
本发明提供的是一种基于一步状态估计和协方差估计的距离野值剔除方法。步骤一、得到当前时刻的状态估计和协方差估计;步骤二、获得估计量和估计方差;步骤三、计算得到与各声信标距离信息的估计值;步骤四、由估计方差得到估计区间;步骤五、判断距离信息量测值是否落在估计区间内,若在则继续更新计算,若不在则视为野值剔除。通过本发明提出的方法,实现了距离量测数据的预处理,减小由野值引起的误差和滤波发散。有利于接下来的滤波处理。
Description
技术领域
本发明涉及的是一种水下声信号的处理方法,具体地说是一种距离野值剔除方法。
背景技术
水下定位技术中,距离信息通过水下声信号的传播时延获得,随着宽带编码信号的普及,由测时分辨率低产生的随机误差已得到较好的抑制,可以保证系统的稳定性和可靠性。然而水声环境极其复杂,信号容易受到环境影响,比如水面/海底的反射和散射引起的多途信号干扰、多声信标信号叠加、同频带强声源干扰等,会导致信号无法被检测或者时延数据具有粗差,这是宽带信号体制无法完全解决的问题,且产生粗差数据往往是无固定规律的,由检测无效或错误带来的与真实值差异较大的粗差数据是容易识别的,然而由多途效应引起的小量级粗差则通常是难以甄别的,无法判别其与估计值的差异产生原因是多途效应还是系统模型不准确。
距离信息由于其粗差在大量级和小量级都有分布,对其进行野值剔除应更谨慎细致,卡尔曼滤波系统中,具有协方差矩阵用于描述各状态量的联合方差分布。
发明内容
本发明的目的在于提供一种能够解决传输过程产生的距离错误值的剔除问题的基于一步状态估计和协方差估计的距离野值剔除方法。
本发明的目的是这样实现的:
步骤一、得到当前时刻的状态估计和协方差估计;
步骤二、获得估计量和估计方差;
步骤三、计算得到与各声信标距离信息的估计值;
步骤四、由估计方差得到估计区间;
步骤五、判断距离信息量测值是否落在估计区间内,若在则继续更新计算,若不在则视为野值剔除。
本发明还可以包括:
1、所述得到当前时刻的状态估计和协方差估计具体包括:系统在k时刻时,根据上一时刻的状态更新和协方差更新Pk-1,得到此时的状态估计和协方差估计Pk/k-1。
2、所述获得估计量和估计方差具体包括:在状态估计和协方差估计Pk/k-1这两个矩阵中,具有对水平位置的估计量和估计方差,分别为x(k)、y(k)、和
3、所述计算得到与各声信标距离信息的估计值具体包括:设声信标的位置坐标为(xi,yi),i=1,2,3,…,由此得到与各声信标距离信息的估计值估计值的表达式为:
4、所述由估计方差得到估计区间具体包括:由估计方差和得到估计区间Δrσ,其满足
5、所述判断距离信息量测值是否落在估计区间内具体包括:若声信标i在k时刻得到的距离信息量测值Ri(k)未落在估计区间内,则被视为野值采取剔除处理;若落在此估计区间内则继续下个时刻的判断。
为了解决传输过程产生的距离错误值的剔除问题,本发明提出使用一步状态估计结合协方差估计用于距离信息的野值剔除。本发明的使用背景是在卡尔曼滤波系统中。
本发明与现有技术相比优点在于:
由于量测系统或者数据传输等方面的原因,会导致在量测数据中出现野值,其数值与实际量测值往往相差较大,通过本发明提出的方法,实现了距离量测数据的预处理,减小由野值引起的误差和滤波发散。有利于接下来的滤波处理。
附图说明
图1是本发明的流程图。
具体实施方式
下面结合附图举例对本发明作进一步描述。
结合图1,本发明的基于一步状态估计和协方差估计的距离野值剔除设计方法具体包括以下步骤:
步骤一、系统在k时刻时,可根据上一时刻的状态更新和协方差更新Pk-1,得到此时的状态估计和协方差估计Pk/k-1;
步骤二、在步骤一的两个矩阵中,具有对水平位置的估计量和估计方差,分别为x(k)、y(k)、和由此获得估计量和估计方差;
步骤三、计算得到与各声信标距离信息的估计值。假设声信标的位置坐标为(xi,yi),i=1,2,3,…,由此可以得到与各声信标距离信息的估计值只考虑2维,则可定义一个中心为宽度为2Δrσ的估计区间;
步骤四、由估计方差得到估计区间Δrσ,其中
步骤五、若声信标i在k得到的距离信息量测值Ri(k)未落在估计区间内,则被视为野值,若在则保留该距离信息量测值,并继续更新计算。
Claims (6)
1.一种基于一步状态估计和协方差估计的距离野值剔除方法,其特征是:
步骤一、得到当前时刻的状态估计和协方差估计;
步骤二、获得估计量和估计方差;
步骤三、计算得到与各声信标距离信息的估计值;
步骤四、由估计方差得到估计区间;
步骤五、判断距离信息量测值是否落在估计区间内,若在则继续更新计算,若不在则视为野值剔除。
2.根据权利要求1所述的基于一步状态估计和协方差估计的距离野值剔除方法,其特征是所述得到当前时刻的状态估计和协方差估计具体包括:系统在k时刻时,根据上一时刻的状态更新和协方差更新Pk-1,得到此时的状态估计和协方差估计Pk/k-1。
3.根据权利要求2所述的基于一步状态估计和协方差估计的距离野值剔除方法,其特征是所述获得估计量和估计方差具体包括:在状态估计和协方差估计Pk/k-1这两个矩阵中,具有对水平位置的估计量和估计方差,分别为x(k)、y(k)、和
4.根据权利要求3所述的基于一步状态估计和协方差估计的距离野值剔除方法,其特征是所述计算得到与各声信标距离信息的估计值具体包括:设声信标的位置坐标为(xi,yi),i=1,2,3,…,由此得到与各声信标距离信息的估计值估计值的表达式为:
<mrow>
<msub>
<mover>
<mi>R</mi>
<mo>^</mo>
</mover>
<mi>i</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>.</mo>
</mrow>
5.根据权利要求4所述的基于一步状态估计和协方差估计的距离野值剔除方法,其特征是所述由估计方差得到估计区间具体包括:由估计方差和得到估计区间Δrσ,其满足
6.根据权利要求5所述的基于一步状态估计和协方差估计的距离野值剔除方法,其特征是所述判断距离信息量测值是否落在估计区间内具体包括:若声信标i在k时刻得到的距离信息量测值Ri(k)未落在估计区间内,则被视为野值采取剔除处理;若落在此估计区间内则继续下个时刻的判断。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710204423.9A CN107064875B (zh) | 2017-03-31 | 2017-03-31 | 基于一步状态估计和协方差估计的距离野值剔除方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710204423.9A CN107064875B (zh) | 2017-03-31 | 2017-03-31 | 基于一步状态估计和协方差估计的距离野值剔除方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107064875A true CN107064875A (zh) | 2017-08-18 |
CN107064875B CN107064875B (zh) | 2020-11-03 |
Family
ID=59602841
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710204423.9A Active CN107064875B (zh) | 2017-03-31 | 2017-03-31 | 基于一步状态估计和协方差估计的距离野值剔除方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107064875B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108108335A (zh) * | 2017-12-26 | 2018-06-01 | 北京邮电大学 | 一种野值剔除方法及装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101603832A (zh) * | 2009-07-13 | 2009-12-16 | 中国船舶重工集团公司第七一五研究所 | 一种广播式多用户自主水声导航方法 |
CN101788679A (zh) * | 2010-02-08 | 2010-07-28 | 北京航空航天大学 | 一种基于新息正交的sins/gps自适应野值检测与实时补偿方法 |
CN102064907A (zh) * | 2009-11-16 | 2011-05-18 | 西安费斯达自动化工程有限公司 | Tcas系统接收信号野值剔除方法 |
-
2017
- 2017-03-31 CN CN201710204423.9A patent/CN107064875B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101603832A (zh) * | 2009-07-13 | 2009-12-16 | 中国船舶重工集团公司第七一五研究所 | 一种广播式多用户自主水声导航方法 |
CN102064907A (zh) * | 2009-11-16 | 2011-05-18 | 西安费斯达自动化工程有限公司 | Tcas系统接收信号野值剔除方法 |
CN101788679A (zh) * | 2010-02-08 | 2010-07-28 | 北京航空航天大学 | 一种基于新息正交的sins/gps自适应野值检测与实时补偿方法 |
Non-Patent Citations (1)
Title |
---|
韩云峰 等: "长基线声学定位系统跟踪解算优化方法", 《声学学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108108335A (zh) * | 2017-12-26 | 2018-06-01 | 北京邮电大学 | 一种野值剔除方法及装置 |
CN108108335B (zh) * | 2017-12-26 | 2020-07-17 | 北京邮电大学 | 一种野值剔除方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN107064875B (zh) | 2020-11-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2023045357A1 (zh) | 一种基于统计相似度量的组合导航鲁棒滤波方法 | |
CN107040885B (zh) | 用于鲁棒且准确的基于rssi的位置估计的系统和方法 | |
CN110081864B (zh) | 一种顾及水深值的水深测量综合延迟改正方法 | |
US9500484B2 (en) | System and method for water column aided navigation | |
US8073622B2 (en) | Long-range lightning detection and characterization system and method | |
WO2010021659A3 (en) | Gnss signal processing methods and apparatus with ambiguity convergence indication | |
CN108196267B (zh) | 一种基于gnss cp技术的不间断时间传递方法 | |
JP2011013189A (ja) | 測位装置及びプログラム | |
CN110657806B (zh) | 一种基于CKF、chan解算和Savitzky-Golay平滑滤波的位置解算方法 | |
CN108509379A (zh) | 全局估计自适应两阶段平方根容积滤波的方法 | |
JP5636410B2 (ja) | 移動情報判定装置、受信機、及びそれについての方法 | |
CN112630728B (zh) | 一种基于uwb的改进三边定位算法 | |
WO2019210065A3 (en) | Position determination system and method | |
CN108279007B (zh) | 一种基于随机信号的定位方法及装置 | |
Guo et al. | A robust SINS/USBL integrated navigation algorithm based on earth frame and right group error definition | |
CN110207721B (zh) | 一种考虑残差分布的无效地形匹配结果识别方法 | |
CN107064875A (zh) | 基于一步状态估计和协方差估计的距离野值剔除方法 | |
JP5352492B2 (ja) | 測位装置及びプログラム | |
CN104331087B (zh) | 一种鲁棒的水下传感器网络目标跟踪方法 | |
CN110244260A (zh) | 基于声能流矢量补偿的水下目标高精度doa估计方法 | |
Ji et al. | Systematic bias correction in source localization | |
CN104155669B (zh) | 基于北斗二代卫星导航系统的接收机深组合实现方法 | |
CN113821766B (zh) | 一种海洋声学导航系统误差改正方法 | |
CN114814779B (zh) | 浮标涌浪波高观测数据误差评估方法、系统、设备及介质 | |
CN110007298B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |