#pragma config(I2C_Usage, I2C1, i2cSensors)
#pragma config(Sensor, dgtl1,  SensorUp,       sensorTouch)
#pragma config(Sensor, dgtl2,  SensorDown,     sensorTouch)
#pragma config(Motor,  port2,           rightMotor,    tmotorVex393_MC29, openLoop, reversed, driveRight, encoderPort, I2C_1)
#pragma config(Motor,  port3,           leftMotor,     tmotorVex393_MC29, openLoop, driveLeft, encoderPort, I2C_2)
#pragma config(Motor,  port6,           armMotor,      tmotorVex393_MC29, openLoop, encoderPort, I2C_3)

/*+++++++++++++++++++++++++++++++++++++++++++++| Notes |++++++++++++++++++++++++++++++++++++++++++++++

Robot Model(s): GridBot

[I/O Port]          [Name]              [Type]                [Description]
Motor Port 2        rightMotor          VEX Motor             Right side motor
Motor Port 3        leftMotor           VEX Motor             Left side motor
Motor Port 6        armMotor           VEX Motor             Arm motor
Digital Sensor Port 1        SensorUp           Touch Sensor
Digital Sensor Port 2        SensorDown           Touch Sensor
----------------------------------------------------------------------------------------------------*/
task main()
{
  while(1 == 1)
{
  if(SensorValue(SensorDown)==1)
{
    	motor[armMotor] = -40;
}
  else if(SensorValue(SensorUp)==1)
{
    	motor[armMotor] = 40;
}
  else
{
  	  motor[armMotor] = 0;
}
}
}