Regelungsystem für Shaker (Projektarbeit)

Danke für dein Programm. Hat mir weitergeholfen.
Ich steh jetzt vor einem neuen Problem.

Ich hab da ein Programm gemacht, aber es gibt mir einen Fehler zurück. Ich weiß aber nicht woran es liegt. Könnte es sich bitte jemand anschaun?
Es handelt sich da um eine Regelung. Kalibiriert ist es aber noch nicht. Es wird der eingelesene Wert mit einem Referenzwert verglichen und die Differenz zum eingelesen Wert dazu gezählt und ausgegeben. Die Formeln sollten nur eine richitge Umrechnen mit der Beschleunigung und Auslenkung sein. Sie kommen zur Not auch weggelassen werden

MfG Max