说明：  Kalman filtering with state constraints: a survey of linear and nonlinear algorithms D. Simon. in this file introduced nem kalman filter and can be used for any application.