Servo position variables should be global and only set once