CN112346479B - 一种基于集中式卡尔曼滤波的无人航行器状态估计方法 - Google Patents
一种基于集中式卡尔曼滤波的无人航行器状态估计方法 Download PDFInfo
- Publication number
- CN112346479B CN112346479B CN202011296332.0A CN202011296332A CN112346479B CN 112346479 B CN112346479 B CN 112346479B CN 202011296332 A CN202011296332 A CN 202011296332A CN 112346479 B CN112346479 B CN 112346479B
- Authority
- CN
- China
- Prior art keywords
- speed
- value
- unmanned aircraft
- moment
- reliable
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000001914 filtration Methods 0.000 title claims abstract description 17
- 238000005259 measurement Methods 0.000 claims abstract description 53
- 238000005315 distribution function Methods 0.000 claims abstract description 7
- 238000012360 testing method Methods 0.000 abstract description 3
- 238000001514 detection method Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 239000011159 matrix material Substances 0.000 description 4
- 238000005070 sampling Methods 0.000 description 3
- 230000004927 fusion Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于集中式卡尔曼滤波的无人航行器状态估计方法,包括以下步骤:建立无人航行器关于位置和速度的状态方程和量测方程;预测无人航行器的下一时刻速度和位置,得到无人航行器的下一时刻速度预测值和位置预测值,建立下一时刻速度和位置真值的分布函数,通过引入置信概率,得到无人航行器当前时刻可靠的速度和位置量测值;基于新型集中式卡尔曼滤波器的结构,确定无人航行器更新过程的协方差和卡尔曼滤波器的增益,再通过结合当前时刻速度和位置量测值得到无人航行器的位置信息和速度信息最优估计值,将此方法具有置信检验环节的集中式卡尔曼滤波,对速度和位置信息的最终估计值更加准确。
Description
技术领域
本发明涉及传感器信息融合领域,尤其涉及一种基于集中式卡尔曼滤波的无人航行器状态估计方法。
背景技术
对线性***进行分析时,集中式卡尔曼滤波是一种常用的参数估计方法,多个子***的观测信息在集中卡尔曼滤波中被同时处理,所有相关的状态量在同一个全局滤波器中被处理,最后得到的结果为多个参数的最优估计解。集中式卡尔曼滤波器结构中由于其主滤波器需对全部子滤波器的估计值进行处理,故其具备相应的缺点:由于多个传感器为并行估计,当任意一个传感器出现故障时,最终的估计值将会受到影响;
采用集中式卡尔曼滤波进行状态估计时,当任一传感器信息出现不可靠测量时,最终估计值的精度将会受到或多或少的影响。
发明内容
根据现有技术存在的问题,本发明公开了一种基于集中式卡尔曼滤波的无人航行器状态估计方法,包括以下步骤:
S1:建立无人航行器关于位置和速度的状态方程和量测方程;
S2:根据无人航行器的状态方程,预测无人航行器的下一时刻速度和位置,得到无人航行器的下一时刻速度预测值和位置预测值;
S3:根据无人航行器的下一时刻速度预测值和位置预测值,建立下一时刻速度和位置真值的分布函数,下一时刻速度和位置真值应服从期望为预测值,方差为***噪声方差的正态分布,通过引入置信概率,得到无人航行器当前时刻可靠的速度和位置量测值;
S4:基于新型集中式卡尔曼滤波器的结构,确定无人航行器更新过程的协方差和卡尔曼滤波器的增益,再通过结合当前时刻速度和位置量测值得到无人航行器的位置信息和速度信息最优估计值。
进一步地,所述通过引入置信概率,得到无人航行器当前时刻可靠的速度和位置量测值,过程如下:
通过引入置信概率,判断无人航行器当前时刻速度和位置量测值是否可靠;当无人航行器当前时刻速度和位置量测值可靠,则采用当前时刻速度和位置量;当无人航行器当前时刻速度和位置量测值不可靠,利用量测方程获得无人航行器的速度和位置可靠的量测值。
进一步地,所述新型集中式卡尔曼滤波器包括N个子滤波器,所述子滤波器的卡尔曼增益如下:
其中:Kl(k)为第l个子滤波器在k时刻的增益,X(k)为k时刻的状态值,X(k|k-1)为对k时刻进行预测的预测值,Zl(k)为第l个子滤波器在k时刻的量测值,Zl(k|k-1)为第l个子滤波器对k时刻进行预测的预测量测值。
进一步地,所述速度和位置量测值是否可靠的判断方法如下:
引入一个置信概率α,为使得速度和位置量测值处于置信区间内,根据高斯分布的分布函数Φ(x),则可令:
当Z(k)∈(x1,x2]时,其中x1+x2=2X′,下一时刻的Z(k)属于可靠测量,其中,Z(k)表示当前时刻的量测值。
由于采用了上述技术方案,本发明提供的一种基于集中式卡尔曼滤波的无人航行器状态估计方法,该方法引入一个置信概率,在每次预测过程中量测值均与状态预测值进行对比,对于位于置信区间之内的量测值选择相信,对于位于置信区间之外的量测值进行剔除,进行野值剔除后考虑使用前一时刻的最优估计值进行下一时刻的预测,将此方法应用于机动目标中的CV模型进行验证后,仿真实验验证了当传感器出现故障时,具有置信检验环节的集中式卡尔曼滤波对速度和位置信息的最终估计值更加准确。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请中记载的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为具备置信检验的最优估计集中式卡尔曼滤波器结构图;
图2为不同置信概率下CV模型的最优位置估计图;
图3为不同置信概率下CV模型的最优速度估计图;
图4为不同置信概率下CV模型的位置误差对比图;
图5为不同置信概率下CV模型的速度误差对比图。
具体实施方式
为使本发明的技术方案和优点更加清楚,下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚完整的描述:
一种基于集中式卡尔曼滤波的无人航行器状态估计方法,主要可应用于包含多个传感器测量信息的导航定位、目标跟踪等领域;该方法包括以下步骤:
S1:建立无人航行器关于位置和速度的状态方程和量测方程;
S2:根据无人航行器的状态方程,预测无人航行器的下一时刻速度和位置,得到无人航行器的下一时刻速度预测值和位置预测值;
S3:根据无人航行器的下一时刻速度预测值和位置预测值,建立下一时刻速度和位置真值的分布函数,下一时刻速度和位置真值应服从期望为预测值,方差为***噪声方差的正态分布,通过引入置信概率,得到无人航行器当前时刻可靠的速度和位置量测值;
S4:基于新型集中式卡尔曼滤波器的结构,确定无人航行器更新过程的协方差和卡尔曼滤波器的增益,再通过结合当前时刻速度和位置量测值得到无人航行器的位置信息和速度信息最优估计值。
在传统集中式卡尔曼滤波的融合结构中,需使用下一时刻对应的量测值对下一时刻的状态进行最优估计,针对每次利用量测值进行估计的环节,考虑对量测值的可靠性进行判断,即是否包含野值,通过引入一个置信概率,对每次下一阶段预测时使用的量测值进行判断,如若量测值在置信区间内,则可认为本时刻的量测值值得信赖,可以用以进行下一时刻的预测过程,同时根据这一处理环节的加入,每次预测时均使用主滤波器得到的最优估计值进行下一阶段的预测,提高最终的估计精度。
传统集中式卡尔曼滤波的状态方程和量测方程为:
对于多传感器测量***来说,状态方程不变,量测方程可表示为:
其中,v(k)和wl(k)(l=1,2,…,n)均为零均值高斯白噪声,其协方差分别为Q和Rl,且满足E[wl(k)(wm(k))T]=0(m≠l,m∈{1,2,…,n}),其中,l=1,2,…,n,为子滤波器个数,X(k+1)为无人航行器位置与速度估计***对k时刻的状态估计值,F为无人航行器位置与速度估计***的状态转移矩阵,X(k)为无人航行器位置与速度估计***k时刻的状态变量,v(k)为无人航行器位置与速度估计***在k时刻的预测噪声,Zi(k)为无人航行器位置与速度估计***子滤波器l在k时刻的量测值,Hl为无人航行器位置与速度估计***子滤波器l在k时刻的量测矩阵,wl(k)为无人航行器位置与速度估计***子滤波器l在k时刻的量测噪声。
对各个传统子滤波器而言,无人航行器的位置和速度预测过程为:
Xl(k|k-1)=FXl(k|k-1)(l=1,2,…n) (3)
Pl(k|k-1)=FPl(k-1|k-1)FT+Q (4)
Kl(k)=Pl(k|k-1)HT(HPl(k|k-1)HT+R)-1 (5)
其中,Pl(k+1|k)为子滤波器l的一步预测误差协方差矩阵,Xl(k+1|k)为子滤波器l的状态一步预测,Kl(k)为子滤波器l的增益矩阵。
更新过程为:
Xl(k|k)=Xl(k|k-1)+Kl(k)(Zl(k)-HlXl(k|k-1))(l=1,2,…n) (6)
Pl(k|k)=(I-Kl(k)H)Pl(k|k-1) (7)
每一时刻的最优估计值可表述为:
在每次对下一阶段进行预测时,受各方面因素的影响,量测值均存在一定的不可靠性,为避免不可靠测量对最终的估计结果造成影响,应对量测值进行可靠性估计。
对任何一个子滤波器的任意一个时刻而言,下一时刻状态的预测值为:
Xl(k|k-1)=FXl(k-1|k-1) (9)
为判定量测值的可靠度,设预测值为X′,可认为下一时刻的最优估计值服从均值为X′,方差为Q的高斯分布,即最优估计值~N(X′,Q)。
引入一个置信概率α,为使得Z(k)处于置信区间内,根据高斯分布的分布函数Φ(x),则可令当Z(k)∈(x1,x2]时,其中x1+x2=2X′,可认为下一时刻的Z(k)属于可靠测量,可用于接下来的预测环节,又每一子滤波器的协方差均相同,故将预测过程进行合并,
图1为具备置信检验的最优估计集中式卡尔曼滤波器结构图。
改变滤波结构后,子滤波器的预测过程不变,如下所示:
X(k|k-1)=FX(k-1|k-1) (10)
Pl(k|k-1)=FPl(k-1|k-1)FT+Q (11)
当Zl(k)满足相应范围时,定义每个子滤波器新的卡尔曼增益,如下所示:
其中,Kl(k)为第l个子滤波器在k时刻的增益,X(k)为k时刻的状态值,X(k|k-1)为对k时刻进行预测的预测值,Zl(k)为第l个子滤波器在k时刻的量测值,Zl(k|k-1)为第l个子滤波器对k时刻进行预测的预测量测值。
每个子滤波器的估计值可表示为:
Zl(k|k-1)=HlX(k|k-1) (13)
Xl(k|k)=X(k|k-1)+Kl(k)[Zl(k)-Zl(k|k-1)] (14)
主滤波器得到的最优状态估计值与传统集中式卡尔曼滤波器相同:
因状态方程唯一,故每一时刻各子滤波器的协方差均相同,即
故最优估计值化简可得:
为了说明方法的有效性和可行性,选取无人航行器的运动模型选取CV模型,虽然干扰的存在会改变目标下一时刻的运动速度,但是无人航行器在整体上是匀速运动(非机动状态)。这一模型的最大优点是形式简单,当目标机动幅度很小或采样间隔很短时,目标的运动完全可以有效近似为匀速运动。
CV模型可表示为:
当采样周期间隔较短时,对采样周期为T的离散时间状态方程为:
其中X(k)=[x(k),v(k)]T。
为了避免卡尔曼滤波器的整个滤波***的运算量过大,同时说明本方法的有效性,取n=3,则量测方程为:
Zl(k)=[1 0]X(k)+wl(k)(l=1,2,3) (19)
同时为验证结果的有效性,取T=1,Q=0.1,R1=0.1,R2=0.2,R3=0.3,初始状态为[0,0.5]T,滤波次数为500,分别取置信概率为95%、90%和80%。图2为不同置信概率下CV模型的最优位置估计图,展示的是置信概率为95%、90%、80%和未引入置信检测环节的位置对比图,从图中可以看出加入了置信环节后对位置的估计精度比未加入置信检测环节对位置的估计精度高,同时置信概率选的越高,精度越高。
图3为不同置信概率下CV模型的最优速度估计图;图3中展示的是置信概率为95%、90%、80%和未引入置信检测环节的速度对比关系,从图中可以看出加入了置信环节后对速度的估计精度比未加入置信检测环节对速度的估计精度高,同时置信概率选的越高,精度越高。
图4为不同置信概率下CV模型的位置误差对比图;图4中展示的是置信概率为95%、90%、80%和未引入置信检测环节的位置误差对比关系,从图4中可以看出置信概率选的越高,对位置的估计误差越小。
图5为不同置信概率下CV模型的速度误差对比图;图中展示置信概率为95%、90%、80%和未引入置信检测环节的速度误差对比关系,从图5中可以看出置信概率选的越高,对速度的估计误差越小。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。
Claims (2)
1.一种基于集中式卡尔曼滤波的无人航行器状态估计方法,其特征在于:包括以下步骤:
S1:建立无人航行器关于位置和速度的状态方程和量测方程;
S2:根据无人航行器的状态方程,预测无人航行器的下一时刻速度和位置,得到无人航行器的下一时刻速度预测值和位置预测值;
S3:根据无人航行器的下一时刻速度预测值和位置预测值,建立下一时刻速度和位置真值的分布函数,下一时刻速度和位置真值应服从期望为预测值,方差为***噪声方差的正态分布,通过引入置信概率,得到无人航行器当前时刻可靠的速度和位置量测值;
S4:基于新型集中式卡尔曼滤波器的结构,确定无人航行器更新过程的协方差和卡尔曼滤波器的增益,再通过结合当前时刻速度和位置量测值得到无人航行器的位置信息和速度信息最优估计值;
所述新型集中式卡尔曼滤波器包括N个子滤波器,所述子滤波器的卡尔曼增益如下:
其中:Kl(k)为第l个子滤波器在k时刻的增益,X(k)为k时刻的状态值,X(k|k-1)为对k时刻进行预测的预测值,Zl(k)为第l个子滤波器在k时刻的量测值,Zl(k|k-1)为第l个子滤波器对k时刻进行预测的预测量测值;
所述速度和位置量测值是否可靠的判断方法如下:
引入一个置信概率α,为使得速度和位置量测值处于置信区间内,根据高斯分布的分布函数Φ(x),则可令:
当Z(k)∈(x1,x2]时,其中x1+x2=2X′,下一时刻的Z(k)属于可靠测量,其中,Z(k)表示当前时刻的量测值。
2.根据权利要求1所述的一种基于集中式卡尔曼滤波的无人航行器状态估计方法,其特征还在于:所述通过引入置信概率,得到无人航行器当前时刻可靠的速度和位置量测值,过程如下:
通过引入置信概率,判断无人航行器当前时刻速度和位置量测值是否可靠;当无人航行器当前时刻速度和位置量测值可靠,则采用当前时刻速度和位置量;当无人航行器当前时刻速度和位置量测值不可靠,利用量测方程获得无人航行器的速度和位置可靠的量测值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011296332.0A CN112346479B (zh) | 2020-11-18 | 2020-11-18 | 一种基于集中式卡尔曼滤波的无人航行器状态估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011296332.0A CN112346479B (zh) | 2020-11-18 | 2020-11-18 | 一种基于集中式卡尔曼滤波的无人航行器状态估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112346479A CN112346479A (zh) | 2021-02-09 |
CN112346479B true CN112346479B (zh) | 2023-08-22 |
Family
ID=74363062
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011296332.0A Active CN112346479B (zh) | 2020-11-18 | 2020-11-18 | 一种基于集中式卡尔曼滤波的无人航行器状态估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112346479B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115033844A (zh) * | 2022-05-12 | 2022-09-09 | 合肥赛为智能有限公司 | 一种无人机状态估计方法、***、设备及可读存储介质 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101505532A (zh) * | 2009-03-12 | 2009-08-12 | 华南理工大学 | 一种基于分布式处理的无线传感器网络目标跟踪方法 |
CN105487088A (zh) * | 2015-09-12 | 2016-04-13 | 北京大学 | 一种卫星导航***中基于卡尔曼滤波的raim算法 |
CN105588566A (zh) * | 2016-01-08 | 2016-05-18 | 重庆邮电大学 | 一种基于蓝牙与mems融合的室内定位***及方法 |
CN109001787A (zh) * | 2018-05-25 | 2018-12-14 | 北京大学深圳研究生院 | 一种姿态角解算与定位的方法及其融合传感器 |
CN109633589A (zh) * | 2019-01-08 | 2019-04-16 | 沈阳理工大学 | 目标跟踪中基于多模型优化多假设的多目标数据关联方法 |
CN109712173A (zh) * | 2018-12-05 | 2019-05-03 | 北京空间机电研究所 | 一种基于卡尔曼滤波器的图像位置运动估计方法 |
CN110579740A (zh) * | 2019-09-17 | 2019-12-17 | 大连海事大学 | 一种基于自适应联邦卡尔曼滤波的无人船组合导航方法 |
CN110850457A (zh) * | 2019-10-22 | 2020-02-28 | 同济大学 | 一种用于室内煤场的无人机定位导航方法 |
CN111160266A (zh) * | 2019-12-30 | 2020-05-15 | 三一重工股份有限公司 | 物体跟踪方法和装置 |
RU2733453C1 (ru) * | 2020-07-07 | 2020-10-01 | федеральное государственное автономное образовательное учреждение высшего образования "Северо-Кавказский федеральный университет" | Способ автоматического управления движением роботизированного беспилотного летательного аппарата в автономном режиме |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10118610B2 (en) * | 2016-08-31 | 2018-11-06 | Ford Global Technologies, Llc | Autonomous vehicle using path prediction |
-
2020
- 2020-11-18 CN CN202011296332.0A patent/CN112346479B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101505532A (zh) * | 2009-03-12 | 2009-08-12 | 华南理工大学 | 一种基于分布式处理的无线传感器网络目标跟踪方法 |
CN105487088A (zh) * | 2015-09-12 | 2016-04-13 | 北京大学 | 一种卫星导航***中基于卡尔曼滤波的raim算法 |
CN105588566A (zh) * | 2016-01-08 | 2016-05-18 | 重庆邮电大学 | 一种基于蓝牙与mems融合的室内定位***及方法 |
CN109001787A (zh) * | 2018-05-25 | 2018-12-14 | 北京大学深圳研究生院 | 一种姿态角解算与定位的方法及其融合传感器 |
CN109712173A (zh) * | 2018-12-05 | 2019-05-03 | 北京空间机电研究所 | 一种基于卡尔曼滤波器的图像位置运动估计方法 |
CN109633589A (zh) * | 2019-01-08 | 2019-04-16 | 沈阳理工大学 | 目标跟踪中基于多模型优化多假设的多目标数据关联方法 |
CN110579740A (zh) * | 2019-09-17 | 2019-12-17 | 大连海事大学 | 一种基于自适应联邦卡尔曼滤波的无人船组合导航方法 |
CN110850457A (zh) * | 2019-10-22 | 2020-02-28 | 同济大学 | 一种用于室内煤场的无人机定位导航方法 |
CN111160266A (zh) * | 2019-12-30 | 2020-05-15 | 三一重工股份有限公司 | 物体跟踪方法和装置 |
RU2733453C1 (ru) * | 2020-07-07 | 2020-10-01 | федеральное государственное автономное образовательное учреждение высшего образования "Северо-Кавказский федеральный университет" | Способ автоматического управления движением роботизированного беспилотного летательного аппарата в автономном режиме |
Non-Patent Citations (1)
Title |
---|
一种小型无人船导航-制导-控制***设计与验证;王宁;吴亚;杨毅;高云程;;大连海事大学学报(第04期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112346479A (zh) | 2021-02-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1200802B1 (en) | Vibration compensation for sensors | |
CN109143224B (zh) | 一种多目标关联方法和装置 | |
JP2001201553A (ja) | 汎用位置決めシステム、およびハイブリッド位置決め機能をもった多重モデルナビゲーションフィルタ | |
CN114912551B (zh) | 面向桥梁变形监测的gnss和加速度计实时融合方法 | |
WO2016015140A2 (en) | Method and system for improving inertial measurement unit sensor signals | |
CN112762944B (zh) | 零速区间检测及零速更新方法 | |
CN112346479B (zh) | 一种基于集中式卡尔曼滤波的无人航行器状态估计方法 | |
EP2685214A2 (en) | Multiple truth reference system and method | |
JP2012233800A (ja) | マルチセンサ判定装置及びプログラム | |
Yukun et al. | Research on Kalman-filter based multisensor data fusion | |
CN107218917B (zh) | 一种移动机器人航向角估计方法 | |
CN114413934A (zh) | 一种车辆定位***校正方法和装置 | |
CN110672103B (zh) | 一种多传感器目标跟踪滤波方法及*** | |
Jurado et al. | Towards an online sensor model validation and estimation framework | |
JP2002181926A (ja) | 目標追尾方法およびその装置 | |
CN115291253B (zh) | 一种基于残差检测的车辆定位完好性监测方法及*** | |
CN111339494A (zh) | 基于卡尔曼滤波的陀螺仪数据处理方法 | |
CN115790603A (zh) | 一种用于信息拒止环境下的无人机动态目标估计方法 | |
Trehag et al. | Onboard estimation and classification of a railroad curvature | |
Rui | K-means aided Kalman Filter noise estimation calibration for integrated GPS/INS Navigation | |
CN112880659B (zh) | 一种基于信息概率的融合定位方法 | |
CN111090281B (zh) | 基于改进粒子滤波算法估算机器人方位的方法和装置 | |
CN101118160A (zh) | 低精度压电陀螺零偏实时估计补偿方法 | |
CN113470070A (zh) | 驾驶场景目标跟踪方法、装置、设备及存储介质 | |
JP2017215153A (ja) | 角速度センサ補正装置および角速度センサ補正方法 |
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 |