sollte #9 erledigen
- Zeilen für DEBUG eingefügt
- Fehler bei der Berechnung der Sensoren beseitigt