adding eigen to ROS path conversion functions
tested graph solving
implemented interpolation-based trajectory recover from keyframe graph
added path saving in TUM format
Merge branch 'develop' of https://github.com/ccny-ros-pkg/ccny_rgbd_tools into freiburg
aded initial tf