Der Code is eigentlich ok. Wie ist das mit den Schaltern ?
Pina.6 u. Pina.7 sollten immer eindeutig auf +5 oder GND liegen.
d.h. wenn du auf +5 schaltest, mußt du sie mit ~10k mit GND verbinden (Pulldown), damit sie bei offenem Schalter wissen, was läuft.