angle-based servo control