【python】卡尔曼滤波(笔记)

自用笔记谢谢
代码链接
更新finish版代码链接
密码:博士学号

1.首先运行KF_LQR_Sus.m,得到LQR优化后的G,H矩阵(已离散处理)

2.再在python内写入G,H(此时为A,B)与Q,注意python的时间间隔参数与m文件应一致

3.运行python代码

运行结果
对比图
【python】卡尔曼滤波(笔记)_第1张图片误差数据
【python】卡尔曼滤波(笔记)_第2张图片导出数据
【python】卡尔曼滤波(笔记)_第3张图片

你可能感兴趣的:(笔记)