Added code for servos