New model and MATLAB script for Kalman Filter