     if (failsafe_on) {
         // If necessary, do anything to the hardware needed to exit failsafe mode.
 
-        reset_failsafe();
+        reset_failsafe_timer();
         failsafe_on = false;
         log(F("Exiting fail-safe mode."));
     }

    setup_servos();
    setup_serial();
    setup_bluetooth();
    reset_failsafe();

    log(F("Hardware initialized."));
    

}

// Reset the fail-safe timer 
void reset_failsafe_timer()
{
    failsafe_last_input = millis();
}
