Robust Perception and Navigation of Autonomous Surface Vehicles in Challenging Environments