TESTED WORKING SERVO