Added Kalman filter(including accuracy test and performance test).

Added Kalman filter(including accuracy test and performance test).