Na wenn du den Servo auch mit diesem setPWM (die richtige Frequenz vorrausgesetzt) und 0 - 255 steuerst (daraus den Winkel ermitteln) und die Entfernung kennst, dann kannst du mit einer Winkelfunktionen die Position des Objekts errechnen.