Robust Fail-Safe Control For Small Unmanned Aerial Systems