correction code snippets in matlab

create a extended kalman filter without extendedkalmanfilter in matlab