Added waypoint_command and set_waypoint services to asctec_msgs