updated Kalman to use differential eq

still getting bad fit