Real-Time Navigation for Autonomous Surface Vehicles In Ice-Covered Waters