扩展卡尔曼滤波(EKF)仿真演示 (西工大 严恭敏,2012-2-4)