#pragma config(Sensor, dgtl3, , sensorTouch)
#pragma config(Motor, port1, , tmotorVex393_HBridge, openLoop, encoderPort, None)
#pragma config(Motor, port6, clawmotor, tmotorVex393_MC29, openLoop, encoderPort, None)
#pragma config(Motor, port7, armmotor, tmotorVex393_MC29, openLoop, encoderPort, None)
#pragma config(Motor, port10, , tmotorVex393_HBridge, openLoop, encoderPort, None)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
task main()
{
while (true)
{
if (SensorValue[dgtl3]==0)
{
motor[port1]=vexRT(Ch3)/2;
motor[port10]=vexRT(Ch2)/2;
motor[armmotor]=vexRT(Ch1)/2;
motor[clawmotor]=vexRT(Ch4)/2;
}
else
{
motor[armmotor]=0;
wait1Msec(200);
motor[armmotor]=-50;
wait1Msec(300);
motor[armmotor]=0;
SensorValue[dgtl3]=0;
}
}
}