simplifying servo module, trying to find why it is jittering so much