hallo,
wie errechnest du Ta?
wie sind deine ganzen Variablen definiert?
wie sieht die komplette Schleife aus, incl aller delays, und samt Motor-Befehlen?