Servo programming

done