#define SERVO_LOW_LIMIT    0
#define SERVO_HI_LIMIT     160

int servoPos = SERVO_LOW_LIMIT;
while (true)
{
    if (SensorValue[touchSensor] != 0)
    {
        servoPos += 20;
        if (servoPos > SERVO_HI_LIMIT)
        {
            servoPos = SERVO_HI_LIMIT;
        }
        servo[servoMotor] = servoPos;
    }
    wait1Msec(100);
}