updated kalman in C
basic kalman is now working