Mach' die Umschalterei von Anfang an über einen Timer. Alles andere wirst du später bereuen.
Und denke daran, immer erst alles abzuschalten, bevor du neue Werte auf die Ports gibst. Sonst bekommst du die leidigen Geisterbilder.