Kalman filter code

code is resistant to noise and predicts rough trajectory assuming
negligible air resistance