Du musst ein schalterkonstrukt mit jeweiligen Zeiten und Bedingungen für rückwärts und vorwärts einbauen. Bei vorwärts zb solange bis charger wieder connected. Dafür kannst du direkt vor dem If Variablen defieren, die nur für dieses scope sind. In deiner jetzigen Fassung hast du auch vergessen, deinen Timer nach Durchführung zu aktualisieren. Es würde dann die ganze Zeit auslösen, weil millis schon lange viiiel höher läuft