Planning for Autonomous Operation of Unmanned Surface Vehicles