added plan only mode for pickup manually
added different modes for reachability test