Hallo xyphrox,
ja, das Programm wäre so richtig. Aber halb so schlimm, das kriegen wir schon hin.
Die Probleme mit den Tastsensoren wurden hier im Forum ja des öfteren schon besprochen.

Auf meiner Homepage habe ich dazu auch einiges gesammelt.
http://asuro.pytalhost.de
Unter Programmierung | Beispielprogramme in C zu finden.

Probier mal:

- Mehrmaliges aufrufen der PollSwitch() Funktion
...
PollSwitch();
PollSwitch();
PollSwitch();
PollSwitch();
PollSwitch();
PollSwitch();
PollSwitch();
if (PollSwitch())
...
- oder Vergleich der zurückgegeben Werte

unsigned char t1, t2;
...
t1=PollSwitch();
t2=PollSwitch();
if (t1 && t2 && t1 == t2)
...
- oder Ausgabe der Werte im TerminalProgramm

unsigned char t;
...
t=PollSwitch();
if (t)
{
PrintInt(t)
SerWrite("\r\n");
}
Gruß Peter