Das sieht doch schon gut aus.
Wie befestigst du den Arm gegenüber vom Servokreuz? Hast du dort ein Lager gemacht?
Du könntest übrigens die Servos an die ADC 0 & 1 Anschlüsse anschliessen, dann brauchst du nichts zu schneiden.
MfG Filou