Das Problem mit den Tastern wird durch die Motoren verstärkt.
Es sollte helfen je 2 10µF Kondensatoren anzuschließen wie folgt:
ersten mit + beim Motor mit Motorgehäuse
zweiten mit - beim Motor mit Gehäuse
Anschließend Gehäuse erden ( zB - bei Batterie )

Das sollte die Schwankungen beim Pollswitch verringern.
Oder du machst mehr Pollswitch abfragen rein. Es reicht eine Variable vollkommen aus:

Code:
s = PollSwitch();
s = s & PollSwitch();
s = s & PollSwitch();
s = s & PollSwitch();
if (s==0) {
...