TorqueBot Code

#pragma config(Sensor, dgtl1,  up,             sensorTouch)
#pragma config(Sensor, dgtl2,  down,           sensorTouch)
#pragma config(Sensor, dgtl3,  upLimit,        sensorTouch)
#pragma config(Sensor, dgtl4,  downLimit,      sensorTouch)
#pragma config(Motor,  port6,           armMotor,      tmotorVex393_MC29, openLoop, encoderPort, None)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//

task main()
{
  //Loop Forever
	while(true)
  {
		if(SensorValue[up] == 1 && SensorValue[upLimit] == 0)
    {
    	motor[armMotor] = 40;
    }
    else if(SensorValue[down] == 1 && SensorValue[downLimit] == 0)
    {
    	motor[armMotor] = -40;
    }
    else
    {
    	motor[armMotor] = 0;
    }
  }
}