myservo.write(SPos); //positionner le servo
delay(30);
digitalWrite(TRIGGER_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIGGER_PIN, LOW);
Le délai de 30ms est peut-être un peu court et ne permet pas au servo d'arriver en position et de se stabiliser. Il faudrait sans doute jouer sur ce temps là pour commencer.