Servo update

Update angle