first round of servo control stuff