INS时间更新

基础知识kalman方程

状态

1、Xk/k-1 = F Xk-1/k-1 + Gw

2、Pk/k-1 = F Pk-1/k-1 FT + Q

量测

3、ZK = H X+V

时间更新就是利用1、2方程中,k-1时刻的量得到k时刻的状态量

若要时间更新,需要知道状态转移矩阵A 以及系统噪声Q;

对应的INS代码

Fk = ++(Ft*tdts); // 获取状态转移矩阵 离散化后的结果

Xk = Fk*Xk; 对应方程1

Qk = Qt*tdts; // 获取系统噪声

**Pk = Fk*Pk*(~Fk); 对应方程2的前半部分
Pk += Qt*kfts;**添加系统噪声 对应方程2的后半部分

系统噪声Qk 中用到的是Qt与时间的乘积;QT的设置设计一个关键因素,后续再单独分析。

INS中未知数是各类误差,涉及到了误差方程(见下面的公式),Ft就是各个待估参数前面的系数。各个系数都有对应的计算方法,可参考相应的讲义,这里不在一一列举。

Fk = ++(Ft*tdts)中FK实际上是系数Ft离散化后的结果( f_k = I+ft*ts)

离散过程参考严老师的讲义:

姿态误差微分方程

速度误差微分方程

位置误差微分方程

相关推荐
dahaihua33312 小时前
用 SysML 表达航电系统架构(附建模示例)
设计模式·重构·系统架构·集成测试·需求分析·学习方法
杨逢昌工厂6S管理2 天前
150-杨逢昌一线现场诊断笔记:越管一线越抵触背后的熵增机理与基准化治理
经验分享·笔记·职场和发展·学习方法
Star(up up up)2 天前
Redis Windows 安装教程:使用Windows 的 Redis 压缩包
redis·笔记·学习·程序人生·云原生·学习方法·改行学it
2603_969694854 天前
【JavaWeb学习记录】MyBatis核心知识点与实战笔记:从入门到动态SQL
笔记·sql·学习·mysql·mybatis·javaweb·学习方法
2603_969694858 天前
JDBC 基础学习笔记:API 核心原理解析与 CRUD 代码实操
数据库·笔记·mysql·学习方法·database·sql注入
维克兜率天11 天前
【维克】复合型CTA:趋势+套利的双轮驱动
python·学习方法
Julien200412 天前
管理机密(一)
运维·服务器·开发语言·学习方法
AKA__Zas13 天前
接口自动化测试(1.0 初认识
python·ci/cd·学习方法
道尔柯南13 天前
C++ STL 入门详解:从认识标准模板库到掌握学习方法
java·c++·学习方法
axe_hu14 天前
AI产品经理的职业规划与学习路径
人工智能·职场和发展·产品经理·学习方法