added ROS functionality to read map from SLAM topic and publish waypoint list
Merge branch 'master' of https://github.com/hmurraydavis/Path_Planning
waypoint_follow can find parse_map