a lot of improvements to the servo controller