Enlarge encoder tolerance slightly in the hopes of improving stage response. Update comments for getServo() and setServo().
Update XML so that the stage and joystick move in the correct direction relative to the camera in the current configuration.
Reduce the frequency of move commands to the stage to a rate which it can actually keep up with.