made a few changes to servoCode.c
changed a few things