Visual SLAM starts to work.
This merge incorporates many improvements in the code made to make visual SLAM work. The master branch should benefit from many of them.
The WIP is waiting for additional work needed on the trackers side, which will be boarded soon.