顺便附上几张仿真图 这是状态图 要注意的是：必须把系统状态和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 in