die Frage mit der Stromversorgung hast Du nicht beantwortet!
Ich kenne Dein Programm nicht, vielleicht solltest Du es mal hier reinstellen und bist Du dir sicher alles richtig angeschlossen zu haben und auch die Servos dafür geeignet sind ?
MfG TrainMen