Fixed the map_tools get_known_samples
Implemented the point_robot_at_target function
Merge pull request #9 from eschneider1992/feature/state_machine

Feature/state machine
Fixing master merges