Hooks up path planning to ROS topics