CN111274715A - 一种基于多维时空数据的高精度动态轨迹约束方法 - Google Patents
一种基于多维时空数据的高精度动态轨迹约束方法 Download PDFInfo
- Publication number
- CN111274715A CN111274715A CN202010179529.XA CN202010179529A CN111274715A CN 111274715 A CN111274715 A CN 111274715A CN 202010179529 A CN202010179529 A CN 202010179529A CN 111274715 A CN111274715 A CN 111274715A
- Authority
- CN
- China
- Prior art keywords
- kalman filtering
- motion
- time
- data
- interval
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000001914 filtration Methods 0.000 claims abstract description 121
- 238000012545 processing Methods 0.000 claims abstract description 37
- 230000001133 acceleration Effects 0.000 claims abstract description 25
- 238000013178 mathematical model Methods 0.000 claims abstract description 17
- 230000003068 static effect Effects 0.000 claims abstract description 17
- 238000004088 simulation Methods 0.000 claims abstract description 13
- 230000001174 ascending effect Effects 0.000 claims abstract description 9
- 238000004445 quantitative analysis Methods 0.000 claims abstract description 7
- 230000000630 rising effect Effects 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 6
- 241000270295 Serpentes Species 0.000 claims description 4
- 230000000694 effects Effects 0.000 abstract description 8
- 238000010586 diagram Methods 0.000 description 7
- WYTGDNHDOZPMIW-RCBQFDQVSA-N alstonine Natural products C1=CC2=C3C=CC=CC3=NC2=C2N1C[C@H]1[C@H](C)OC=C(C(=O)OC)[C@H]1C2 WYTGDNHDOZPMIW-RCBQFDQVSA-N 0.000 description 3
- 238000005259 measurement Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Operations Research (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Navigation (AREA)
Abstract
本发明公开一种基于多维时空数据的高精度动态轨迹约束方法,包括根据CA数学模型描述方法选取含时变噪声的静止状态、螺旋半径逐渐增大的螺旋上升运动和直线加速蛇形运动三种运动状态,通过仿真实验,将区间卡尔曼滤波算法和传统卡尔曼滤波算法进行对比;本发明通过CA数学模型对对动态目标三种运动状态对应的位置、速度和加速度信息,分别用卡尔曼滤波、区间卡尔曼滤波和未进行滤波处理的数据进行比较,得出不管是何种状态,经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势,再通过定量分析的方法得出区间卡尔曼滤波比传统的卡尔曼滤波对于带时变噪声的各种高动态目标处理效果均能提高5dB。
Description
技术领域
本发明涉及卡尔曼滤波动态轨技术领域,尤其涉及一种基于多维时空数据的高精度动态轨迹约束方法。
背景技术
卡尔曼滤波是一种利用线性系统状态方程,通过系统输入输出观测数据,对系统状态进行最优估计的算法。由于观测数据中包括系统中的噪声和干扰的影响,所以最优估计也可看作是滤波过程。数据滤波是去除噪声还原真实数据的一种数据处理技术,Kalman滤波在测量方差已知的情况下能够从一系列存在测量噪声的数据中,估计动态系统的状态。由于它便于计算机编程实现,并能够对现场采集的数据进行实时的更新和处理,Kalman滤波是目前应用最为广泛的滤波方法,在通信,导航,制导与控制等多领域得到了较好的应用;
现有传统的卡尔曼滤波对于时变噪声的滤波后的数据处理效果较差,与真实轨迹误差较大,会直接影响算法的最终结果,因此,本发明提出一种基于多维时空数据的高精度动态轨迹约束方法以解决现有技术中存在的问题。
发明内容
针对上述问题,本发明的目的在于提出一种基于多维时空数据的高精度动态轨迹约束方法,该基于多维时空数据的高精度动态轨迹约束方法通过CA数学模型对对动态目标三种运动状态对应的位置、速度和加速度信息,分别用卡尔曼滤波、区间卡尔曼滤波和未进行滤波处理的数据进行比较,得出不管是何种状态,经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势,再通过定量分析的方法得出区间卡尔曼滤波比传统的卡尔曼滤波对于带时变噪声的各种高动态目标处理效果均能提高5dB。
为实现本发明的目的,本发明通过以下技术方案实现:一种基于多维时空数据的高精度动态轨迹约束方法,包括根据CA数学模型描述方法选取含时变噪声的静止状态、螺旋半径逐渐增大的螺旋上升运动和直线加速蛇形运动三种运动状态,通过仿真实验,将区间卡尔曼滤波算法和传统卡尔曼滤波算法进行对比;
第一种运动状态:静止状态
真实运动轨迹静止在点上,运动方程为公式(1-1),真实运动轨迹加上时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波后的三维坐标点得出经过区间卡尔曼滤波的轨迹更接近目标真实位置,处理时变噪声有很大的优势;
静止状态仿真运动方程:
当静止目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经过区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势;
第二种运动状态:螺旋上升运动
真实运动轨迹为螺旋上升运动,运动方程为公式(1-2),真实轨迹加入时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波的三维坐标点得出区间卡尔曼滤波的结果更接近真实轨迹;
螺旋上升状态仿真运动方程:
当螺旋上升运动目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势。
第三种运动状态:加速蛇行运动
真实运动轨迹直线加速蛇形运动,运动方程为公式(1-3),真实轨迹加入时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波的三维坐标点得出区间卡尔曼滤波的结果更接近真实轨迹;
加速蛇行运动状态仿真运动方程:
当螺旋上升运动目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势。
进一步改进在于:所述CA数学模型中,Φk,k-1和Hk表示为:
通常用来描述在高动态目标导航定位,通过全球定位系统(GPS),惯性导航系统(INS)等系统得到运动物体的位置、速度、加速度信息,即假设在两个采样点间隔内的加速度值是常量。
进一步改进在于:所述动态目标的运动数学模型采用CA数学模型,三种运动状态中加入的噪声均为时变噪声。
进一步改进在于:所述时变噪声采样时间t=0.1s,并且取相同的估计值和区间范围:
Rk=10×diag([1 1 1 1 1 1 1 1 1])
Qk=diag([1 1 1 1 1 1 1 1 1])
ω(x)=[1 1 1 0.2 0.2 0.2 0.02 0.02 0.02]
进一步改进在于:所述三种运动状态的动态目标对应的位置、速度和加速度信息,分别用卡尔曼滤波和区间卡尔曼滤波处理,然后把处理结果同未进行滤波的数据作比较。
进一步改进在于:所述第一种运动状态中真实运动轨迹静止的点坐标为(10,10,10)。
进一步改进在于:所述静止状态、螺旋上升运动和直线加速蛇形运动目标的运动信息采用不同滤波算法分别进行1000次模拟,取信噪比的平均值,得到信噪比数据,以进行定量分析。
本发明的有益效果为:本发明通过CA数学模型对对动态目标三种运动状态对应的位置、速度和加速度信息,分别用卡尔曼滤波、区间卡尔曼滤波和未进行滤波处理的数据进行比较,得出不管是何种状态,经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势,再通过定量分析的方法得出区间卡尔曼滤波比传统的卡尔曼滤波对于带时变噪声的各种高动态目标处理效果均能提高5dB。
附图说明
图1为本发明静止状态运动轨迹图。
图2为本发明静止状态轨迹误差图。
图3为本发明螺旋上升运动轨迹图。
图4为本发明螺旋上升运动轨迹局部放大图。
图5为本发明螺旋上升运动轨迹误差图。
图6为本发明直线加速蛇形运动轨迹图。
图7为本发明直线加速蛇形运动轨迹局部放大图。
图8为本发明直线加速蛇形运动轨迹误差图。
具体实施方式
为了加深对本发明的理解,下面将结合实施例对本发明做进一步详述,本实施例仅用于解释本发明,并不构成对本发明保护范围的限定。
根据图1、2、3、4、5、6、7、8所示,本实施例提供了一种基于多维时空数据的高精度动态轨迹约束方法,包括根据CA数学模型描述方法选取含时变噪声的静止状态、螺旋半径逐渐增大的螺旋上升运动和直线加速蛇形运动三种运动状态,通过仿真实验,将区间卡尔曼滤波算法和传统卡尔曼滤波算法进行对比;
第一种运动状态:静止状态
根据图1真实运动轨迹静止在点上,所述真实运动轨迹静止的点坐标为(10,10,10),运动方程为公式(1-1),真实运动轨迹加上时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波后的三维坐标点图得出经过区间卡尔曼滤波的轨迹更接近目标真实位置,处理时变噪声有很大的优势;
静止状态仿真运动方程:
根据图2当静止目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经过区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势;
第二种运动状态:螺旋上升运动
根据图3真实运动轨迹为螺旋上升运动,运动方程为公式(1-2),真实轨迹加入时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波的三维坐标点图得出区间卡尔曼滤波的结果更接近真实轨迹;
螺旋上升状态仿真运动方程:
图4为图3的局部放大,很容易看出区间卡尔曼滤波相比于传统卡尔曼滤波的优势,根据图5当螺旋上升运动目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势;
第三种运动状态:加速蛇行运动
根据图6真实运动轨迹直线加速蛇形运动,运动方程为公式(1-3),真实轨迹加入时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波的三维坐标点得出区间卡尔曼滤波的结果更接近真实轨迹;
加速蛇行运动状态仿真运动方程:
图7为图6的局部放大,很容易看出区间卡尔曼滤波相比于传统卡尔曼滤波的优势,图8,当螺旋上升运动目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势。
所述CA数学模型中,Φk,k-1和Hk表示为:
通常用来描述在高动态目标导航定位,通过全球定位系统(GPS),惯性导航系统(INS)等系统得到运动物体的位置、速度、加速度信息,即假设在两个采样点间隔内的加速度值是常量。
所述动态目标的运动数学模型采用CA数学模型,三种运动状态中加入的噪声均为时变噪声,所述时变噪声采样时间t=0.1s,并且取相同的估计值和区间范围:
Rk=10×diag([1 1 1 1 1 1 1 1 1])
Qk=diag([1 1 1 1 1 1 1 1 1])
ω(x)=[1 1 1 0.2 0.2 0.2 0.02 0.02 0.02]
所述三种运动状态的动态目标对应的位置、速度和加速度信息,分别用卡尔曼滤波和区间卡尔曼滤波处理,然后把处理结果同未进行滤波的数据作比较。
所述静止状态、螺旋上升运动和直线加速蛇形运动目标的运动信息采用不同滤波算法分别进行1000次模拟,取信噪比的平均值,得到信噪比数据,以进行定量分析,数据如表1所示。
表1三种运动1000次模拟信噪比平均值
从表1得出,对于带时变噪声的各种高动态目标,区间卡尔曼滤波比传统的卡尔曼滤波效果均能提高5dB。
该基于多维时空数据的高精度动态轨迹约束方法通过CA数学模型对对动态目标三种运动状态对应的位置、速度和加速度信息,分别用卡尔曼滤波、区间卡尔曼滤波和未进行滤波处理的数据进行比较,得出不管是何种状态,经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势,再通过定量分析的方法得出区间卡尔曼滤波比传统的卡尔曼滤波对于带时变噪声的各种高动态目标处理效果均能提高5dB。
以上显示和描述了本发明的基本原理、主要特征和优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (7)
1.一种基于多维时空数据的高精度动态轨迹约束方法,其特征在于:包括根据CA数学模型描述方法选取含时变噪声的静止状态、螺旋半径逐渐增大的螺旋上升运动和直线加速蛇形运动三种运动状态,通过仿真实验,将区间卡尔曼滤波算法和传统卡尔曼滤波算法进行对比;
第一种运动状态:静止状态
真实运动轨迹静止在点上,运动方程为公式(1-1),真实运动轨迹加上时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波后的三维坐标点得出经过区间卡尔曼滤波的轨迹更接近目标真实位置,处理时变噪声有很大的优势;
静止状态仿真运动方程:
当静止目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经过区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势;
第二种运动状态:螺旋上升运动
真实运动轨迹为螺旋上升运动,运动方程为公式(1-2),真实轨迹加入时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波的三维坐标点得出区间卡尔曼滤波的结果更接近真实轨迹;
螺旋上升状态仿真运动方程:
当螺旋上升运动目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势;
第三种运动状态:加速蛇行运动
真实运动轨迹直线加速蛇形运动,运动方程为公式(1-3),真实轨迹加入时变噪声后,分别经过卡尔曼滤波和区间卡尔曼滤波的三维坐标点得出区间卡尔曼滤波的结果更接近真实轨迹;
加速蛇行运动状态仿真运动方程:
当螺旋上升运动目标加上时变噪声后,分别经过卡尔曼滤波、区间卡尔曼滤波以及未进行滤波处理的数据与目标真实轨迹的误差,得出经区间卡尔曼滤波的数据与目标真实轨迹误差最小,处理时变噪声有很大的优势。
3.根据权利要求1所述的一种基于多维时空数据的高精度动态轨迹约束方法,其特征在于:所述动态目标的运动数学模型采用CA数学模型,三种运动状态中加入的噪声均为时变噪声。
4.根据权利要求3所述的一种基于多维时空数据的高精度动态轨迹约束方法,其特征在于:所述时变噪声采样时间t=0.1s,并且取相同的估计值和区间范围:
Rk=10×diag([1 1 1 1 1 1 1 1 1])
Qk=diag([1 1 1 1 1 1 1 1 1])
ω(x)=[1 1 1 0.2 0.2 0.2 0.02 0.02 0.02]。
5.根据权利要求1所述的一种基于多维时空数据的高精度动态轨迹约束方法,其特征在于:所述三种运动状态的动态目标对应的位置、速度和加速度信息,分别用卡尔曼滤波和区间卡尔曼滤波处理,然后把处理结果同未进行滤波的数据作比较。
6.根据权利要求1所述的一种基于多维时空数据的高精度动态轨迹约束方法,其特征在于:所述第一种运动状态中真实运动轨迹静止的点坐标为(10,10,10)。
7.根据权利要求1所述的一种基于多维时空数据的高精度动态轨迹约束方法,其特征在于:所述静止状态、螺旋上升运动和直线加速蛇形运动目标的运动信息采用不同滤波算法分别进行1000次模拟,取信噪比的平均值,得到信噪比数据,以进行定量分析。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010179529.XA CN111274715A (zh) | 2020-03-16 | 2020-03-16 | 一种基于多维时空数据的高精度动态轨迹约束方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010179529.XA CN111274715A (zh) | 2020-03-16 | 2020-03-16 | 一种基于多维时空数据的高精度动态轨迹约束方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111274715A true CN111274715A (zh) | 2020-06-12 |
Family
ID=71003848
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010179529.XA Pending CN111274715A (zh) | 2020-03-16 | 2020-03-16 | 一种基于多维时空数据的高精度动态轨迹约束方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111274715A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113485127A (zh) * | 2021-08-24 | 2021-10-08 | 中国科学院长春光学精密机械与物理研究所 | 一种提高光电测量设备对动态目标跟踪性能的方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102749633A (zh) * | 2012-06-29 | 2012-10-24 | 北京航空航天大学 | 一种卫星导航接收机的动态定位解算方法 |
CN107014371A (zh) * | 2017-04-14 | 2017-08-04 | 东南大学 | 基于扩展自适应区间卡尔曼的无人机组合导航方法与装置 |
-
2020
- 2020-03-16 CN CN202010179529.XA patent/CN111274715A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102749633A (zh) * | 2012-06-29 | 2012-10-24 | 北京航空航天大学 | 一种卫星导航接收机的动态定位解算方法 |
CN107014371A (zh) * | 2017-04-14 | 2017-08-04 | 东南大学 | 基于扩展自适应区间卡尔曼的无人机组合导航方法与装置 |
Non-Patent Citations (1)
Title |
---|
沈悦 等: "区间卡尔曼滤波算法在高动态导航的研究", 《宇航学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113485127A (zh) * | 2021-08-24 | 2021-10-08 | 中国科学院长春光学精密机械与物理研究所 | 一种提高光电测量设备对动态目标跟踪性能的方法 |
CN113485127B (zh) * | 2021-08-24 | 2022-05-31 | 中国科学院长春光学精密机械与物理研究所 | 一种提高光电测量设备对动态目标跟踪性能的方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102999696A (zh) | 噪声相关系统基于容积信息滤波的纯方位跟踪方法 | |
CN103776449B (zh) | 一种提高鲁棒性的动基座初始对准方法 | |
Havangi | Target tracking based on improved unscented particle filter with Markov chain Monte Carlo | |
CN112665557B (zh) | 一种波浪数据处理方法、装置、电子设备和可读存储介质 | |
Wu et al. | Simultaneous hand–eye/robot–world/camera–IMU calibration | |
Jin et al. | Fast and accurate initialization for monocular vision/INS/GNSS integrated system on land vehicle | |
CN108871365B (zh) | 一种航向约束下的状态估计方法及系统 | |
CN111274715A (zh) | 一种基于多维时空数据的高精度动态轨迹约束方法 | |
CN109443393B (zh) | 一种基于盲分离算法的捷联惯导信号提取方法及系统 | |
Shi et al. | Attitude estimation of SINS on underwater dynamic base with variational Bayesian robust adaptive Kalman filter | |
Jiang et al. | Modeling of unbounded long-range drift in visual odometry | |
Fariña et al. | Sensor fusion algorithm selection for an autonomous wheelchair based on EKF/UKF comparison | |
Liu et al. | LGC-Net: A lightweight gyroscope calibration network for efficient attitude estimation | |
CN116430423B (zh) | 一种运动数据中卫星导航定位轨迹点坐标修正方法 | |
CN117145456A (zh) | 一种钻具欧拉角参数动态测量方法、介质及系统 | |
CN117075158A (zh) | 基于激光雷达的无人变形运动平台的位姿估计方法及系统 | |
CN116124161B (zh) | 一种基于先验地图的LiDAR/IMU融合定位方法 | |
CN116839587A (zh) | 一种基于约束因子图的三维磁矢量和pdr融合导航方法 | |
CN116608859A (zh) | 一种基于阈值处理的自适应无迹卡尔曼滤波的导航方法、存储介质和设备 | |
CN111339494A (zh) | 基于卡尔曼滤波的陀螺仪数据处理方法 | |
CN110095118A (zh) | 一种车身姿态角的实时测量方法及系统 | |
CN111998854B (zh) | 基于Cholesky分解计算的精确扩展Stirling插值滤波方法 | |
CN115982569A (zh) | 基于单源点检测的欠定混合矩阵估计方法、系统及介质 | |
Ankışhan et al. | Square root unscented based FastSlam optimized by particle swarm optimization passive congregation | |
Zhao et al. | A novel cross-line adaptive domain matching algorithm for underwater gravity aided navigation |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200612 |
|
RJ01 | Rejection of invention patent application after publication |