Added servo interface and code.