Fault detection, diagnosis, and mitigation for LRAUV