Cleaning up code
Some keyframes are used for creating new map points, others are not
Stopped tracker from adding extra frame after init. Cleaned up the tracker stages a bit
Cleaning code