Danke für den Hinweis mit dem Delay. Das hat ein Teil des Problems gelöst. Der Servo dreht sich nun von nach links, dann kommt der "ping", dann dreht er sich nach rechts "ping". Aber die Werte werden nicht in den Variable a und b gespeichert. Ich habe die Bedingungen angepasst auf if (a<b), dann drehe dich in die eine Richtung oder (a>b), dann in die andere Richtung. Wenn ich mir die Werte für a und b ausgeben lasse, steht immer 0 da, damit ist keine Bedingung erfüllt und der Kopf geht hin und her und hin und her.