Efficient 6-DOF SLAM with Treemap as a Generic Backend

This video shows an animation of a simulation run of the 6-DOF
treemap SLAM algorithm. In the end it closes a loop over 106657 features
in 209 ms.
