adding eigen to ROS path conversion functions
tested graph solving
implemented interpolation-based trajectory recover from keyframe graph
added path saving in TUM format
keyframe mapper now uses new graph detector
Merge branch 'develop' of https://github.com/ccny-ros-pkg/ccny_rgbd_tools