Kalman Filter Curve Model Matlab