Increasing Predictability and Performance in UAS Flight Contingencies using AIDL and MPC