Adding some initial code for Kalman Filter

Kalman Filter code should follow the formulas on learning suite