| 查看: 1872 | 回复: 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时刻陀螺和加速度输出的偏差值，那个这个方程就不满足卡尔曼滤波的状态方程，就不能用经典卡尔曼的滤波递推公式，应该怎样求解呢？ |
回复此楼» 猜你喜欢
真诚求助：手里的省社科项目结项要求主持人一篇中文核心，有什么渠道能发核心吗
已经有8人回复
-
寻求一种能扛住强氧化性腐蚀性的容器密封件
已经有5人回复
-
论文投稿，期刊推荐
已经有6人回复
-
请问哪里可以有青B申请的本子可以借鉴一下。
已经有4人回复
-
孩子确诊有中度注意力缺陷
已经有14人回复
-
请问下大家为什么这个铃木偶联几乎不反应呢
已经有5人回复
-
请问有评职称，把科研教学业绩算分排序的高校吗
已经有5人回复
-
2025冷门绝学什么时候出结果
已经有3人回复
-
天津工业大学郑柳春团队欢迎化学化工、高分子化学或有机合成方向的博士生和硕士生加入
已经有4人回复
-
康复大学泰山学者周祺惠团队招收博士研究生
已经有6人回复
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