Node for initial version of pose graph

CMakeLists.txt and package.xml has to be updated accordingly. The node is subscibed to topics published by Turtlebot gazebo simulator.