Pyramid_Servo program