Adding Topic reader and Get current position
Robot get_current_robot_pose finished v1
(Chang) get_current_position v2
Merge pull request #5 from reem-utils/chang_branch

Chang branch