changed servoCode.c to be less bouncy- i.e a added slop to the control loop