为什么我的卡尔曼滤波器中的预测步骤失败了?

信息处理 卡尔曼滤波器
2022-02-04 00:11:18

我正在尝试熟悉状态估计,特别是使用加速度计。

我正在模拟以下实验:一维弹簧质量系统(质量m=1, 弹簧常数k=1) 连接加速度计,测量水平加速度。我只是想让预测步骤起作用,所以我假设一个完美的加速度计。

我有以下状态空间方程:

[xkvk]=[1Δt01][xk1vk1]+[Δt2/2Δt]ak

在哪里Δt=0.01,[x1v1]=[10]. 加速度ak是这样一个系统的真实加速度,由下式给出a(t)=x¨=x(t)=cos(t)

但是,当在 for 循环中向前传播时,与事实相比,我得到以下图: 在此处输入图像描述

为什么质量的预测位置存在线性趋势?是某种集成错误,还是我在预测步骤中做错了什么?

0个回答
没有发现任何回复~