Dein Problem wird aus deinem Post leider nicht unbedingt ersichtlich... Das einzige was mir spontan auffällt, aber kA. ob das was nutzt: Vielleicht könntest Du mal für ServoTimesA 16-bit Variablen nehmen, bzw. das Ergebnis Deiner Division+58 explicit in ein char umwandeln...