#pragma config(Sensor, S1,     touchSensor,    sensorEV3_Touch)
#pragma config(Sensor, S2,     gyroSensor,     sensorEV3_Gyro)
#pragma config(Sensor, S3,     colorSensor,    sensorEV3_Color, modeEV3Color_Color)
#pragma config(Sensor, S4,     sonarSensor,    sensorEV3_Ultrasonic)
#pragma config(Motor,  motorA,          armMotor,      tmotorEV3_Large, PIDControl, encoder)
#pragma config(Motor,  motorB,          leftMotor,     tmotorEV3_Large, PIDControl, driveLeft, encoder)
#pragma config(Motor,  motorC,          rightMotor,    tmotorEV3_Large, PIDControl, driveRight, encoder)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//

/*
Create a program that drives the robot forward until the Color Sensor sees red.
The robot then stops.
*/

task main()
{

while (true) {

	//Set motor speed at 20% (Drive Forwards).
	setMotorSpeed(motorB, 20);
	setMotorSpeed(motorC, 20);

	//Loop while the Color Sensor does see red.
	while(getColorName(colorSensor) == colorRed)
	{
		//Keep driving while the Color Sensor does see red.
		sleep(10);
	}

	//Set motor speed to 0% (Stop).
	setMotorSpeed(motorB, 0);
	setMotorSpeed(motorC, 0);
	
	//Loop while the Color Sensor does  see green.
	while(getColorName(colorSensor) == colorGreen)
	{
		sleep(10);
	}

}
}