Added servo control