Failsafe and Return-to-Home (RTH) safety modes