Add commented velocity-kalman code. Performs worse.