Add hardware servo control API