| 查看: 1983 | 回复: 4 | ||
[求助]
组合导航kalman滤波中的增广状态如何使用
|
看书上说，通常是把INS输出的偏差作为一个状态变量进行估计。但是我在按照这种设计思路进行卡尔曼状态方程和量测方程的时候却遇到了困惑。假设INS和激光测距仪组合，以INS的加速度计和陀螺输出，以及激光测距仪通过多个距离交会出来的位置作为滤波输入，输出滤波后位置、速度和姿态信息，状态方程如下 其中，x,y,z是位置；vx,vy,vz是速度；a, β，γ是姿态角；ax,ay,az是三轴加速度信息;wx,wy,wz是陀螺输出的三轴角速度信息；δax,δay,δaz是加速度输出的偏差，δwx,δwy,δwz是陀螺输出的偏差；e是白噪声向量. 如果把偏差建立为随机游走模型，如下:  其中s代表白噪声。那么联合起来，把偏差放到状态量中去，按我的理解，状态方程应该是如下形式：  上式中vk是ek和sk的综合,为白噪声。另外，量测方程可以表示为  其中x’,y’,z’是激光测距仪交会出来的位置，F是当前状态和测量值的观测矩阵，t是激光测距仪得到的位置的误差，看做白噪声。 我疑惑的问题是：在扩展后的状态方程中，方程左右两边都涉及K时刻陀螺和加速度输出的偏差值，那个这个方程就不满足卡尔曼滤波的状态方程，就不能用经典卡尔曼的滤波递推公式，应该怎样求解呢？ |
回复此楼» 猜你喜欢
323求调剂
已经有6人回复
-
一志愿北京化工大学 070300 学硕 336分 求调剂
已经有4人回复
-
352求调剂
已经有3人回复
-
一志愿东华大学化学070300，求调剂
已经有8人回复
-
277材料科学与工程080500求调剂
已经有7人回复
-
317求调剂
已经有18人回复
-
293求调剂
已经有5人回复
-
280分求调剂 一志愿085802
已经有7人回复
-
0854电子信息求调剂
已经有3人回复
-
263求调剂
已经有4人回复
2楼2017-07-15 12:47:24
liuzeqing
新虫 (小有名气)
- 应助: 0 (幼儿园)
- 金币: 1481.2
- 散金: 50
- 帖子: 88
- 在线: 53.5小时
- 虫号: 3795158
- 注册: 2015-04-08
- 性别: GG
- 专业: 测量与地图学
★ ★ ★
wenwenkong(conanwj代发): 金币+3 2017-11-26 21:54:42
wenwenkong(conanwj代发): 金币+3 2017-11-26 21:54:42
|
你的主要问题应该是怎么把k时刻的角速度和加速度联系起来吧！如果采样时间不长的话，可以考虑假设加速度和角速度基本不变，这样k时刻的输入值就都可以转换为k-1时刻的输入值了 发自小木虫Android客户端 |
3楼2017-07-15 17:43:29
xueshu_yang
银虫 (小有名气)
- 应助: 1 (幼儿园)
- 金币: 652.7
- 散金: 117
- 帖子: 97
- 在线: 40.3小时
- 虫号: 4550800
- 注册: 2016-03-29
- 性别: GG
- 专业: 导航、制导与传感技术
★ ★ ★
wenwenkong(conanwj代发): 金币+3 2017-11-26 21:54:54
wenwenkong(conanwj代发): 金币+3 2017-11-26 21:54:54
|
你这直接找份惯导GPS的松组合的论文看看，去掉GPS的速度量测。就是你想要的klm滤波方程了 发自小木虫Android客户端 |
4楼2017-11-04 09:01:34
5楼2018-11-28 16:06:04
