#pragma config(Sensor, in1, lineFolower, sensorLineFollower)
#pragma config(Sensor, in2, potentiometer, sensorPotentiometer)
#pragma config(Sensor, in3, lightSensor, sensorReflection)
#pragma config(Sensor, dgtl1, limitSwitch, sensorDigitalIn)
#pragma config(Sensor, dgtl2, touchsensor, sensorTouch)
#pragma config(Sensor, dgtl3, lowerEncoder, sensorRotation)
#pragma config(Sensor, dgtl4, upperEncoder, sensorRotation)
#pragma config(Sensor, dgtl5, ultrasonicIn, sensorDigitalIn)
#pragma config(Sensor, dgtl6, ultrasonicOut, sensorDigitalOut)
#pragma config(Sensor, dgtl12, greenLed, sensorLEDtoVCC)
#pragma config(Motor, port1, flashlight, tmotorVexFlashlight, openLoop, reversed)
#pragma config(Motor, port2, rightMotor, tmotorVex393TurboSpeed_MC29, openLoop, driveRight)
#pragma config(Motor, port3, leftMotor, tmotorVex393TurboSpeed_MC29, openLoop, driveLeft)
#pragma config(Motor, port8, servoMotor, tmotorServoStandard, openLoop)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
//task servorun()
//{
// setServo(servoMotor, 95);
// sleep(1000);
// while(true)
// {
// setServo(servoMotor, 127);
// sleep(250);
// setServo(servoMotor, -127);
// }
//}
task main()
{
//while (SensorValue(sensorTouch) == 1)
robotType(none);
//startTask( servorun );
while(true)
{
turnFlashlightOff(flashlight);
turnLEDOff(greenLed);
stopMotor(leftMotor);
stopMotor(rightMotor);
untilTouch(touchsensor);
turnLEDOn(greenLed);
turnFlashlightOn(flashlight, 127);
startMotor(leftMotor, 127);
startMotor(rightMotor, 127);
setServo(servoMotor, 127);
sleep(20);
turnFlashlightOff(flashlight);
turnLEDOff(greenLed);
sleep(20);
setServo(servoMotor, -127);
}
}