顺便附上几张仿真图

这是状态图

要注意的是：必须把系统状态和kalman滤波器内部预测的状态分开-Incidentally, several simulation map attached to this is the state diagram should be noted that: must be the system state and kalman filter to separate the state of internal forecasts