added drafts of Kalman filtering
added drafts of Kalman filtering step2