Text this: Trajectory Tracking and Docking Control Strategy for Unmanned Surface Vehicles in Water-Based Search and Rescue Missions