keyframe mapper now uses new graph detector
Merge branch 'develop' of https://github.com/ccny-ros-pkg/ccny_rgbd_tools
caching initial tf from TUM bag