Algorithm runs by reseting the kalman filter every twenty frames.