Sorry, dass ich solange nicht zurückgeschrieben habe ...

Auf die Schnelle ist mir nur aufgefallen, dass du im servo1 vermutlich x und i vertauscht hat.
Denn du gibtst dem Servoprogramm die Position 0 über.

Falls das nicht der Fall ist, schreib nochmal ...


Edit:

Außerdem solltest du zwischen servo1() und servo() eine Pause einbauen.
Damit kannst du sichergehen, dass das Servo den Bewegungen folgen kann und vorallem du auch etwas siehst.