卡尔曼滤波推导与代码实现

Working Goal / 目标

Use small examples and plotted signals to understand what the filter trusts, what it ignores, and how parameters change the result.

我会用尽量小的例子把状态估计过程跑通，再逐步接入真实传感器数据。