Implement servo control. Untested