Added Kalman Filter.

1. Kalman Filter Algorithm.
2. Accuracy test
3. Performance test