Minor changes to pi3_main_vf, changed the goal point from being hard-coded to a ros-topic