Busy cleaning up tracker
Adding keyframes after a number of pose iterations