Fixed function call undefined in servoWrite.