Added fuctionality to Servo