Du kannst dir ja testweise einfach mal die Werte ausgeben lassen, die er misst...
Dann kann man dann schauen wo der Fehler liegt.