SaveText.Ru

#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;

   }

 }

}