Switching Based Supervisory Control of Underwater Vehicles