Code: #pragma config(Sensor, dgtl1, limitSwitch, sensorTouch) #pragma config(Sensor, dgtl2, limitSwitch2, sensorTouch) #pragma config(Motor, port2, motorOne, tmotorVex393_MC29, openLoop) #pragma config(Motor, port3, motorTwo, tmotorVex393_MC29, openLoop) #pragma config(Motor, port4, moterThree, tmotorVex393_MC29, openLoop) //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
task main() { int w = 0; motor[port2] = 0;
wait1Msec(2000);
while (1==1) { waitUntil(SensorValue(limitSwitch) == 1);
waitUntil (SensorValue(limitSwitch) == 0);
w = w + 1;
if (w == 5)
motor[port2] = 100;
wait1Msec(3000); motor[port2] = 0;
if (w == 10)
motor[port3] = 100;
wait1Msec(3000); motor[port3] = 0;
if (w == 15)
motor[port4] = 100;
wait1Msec(3000); motor[port4] = 0; } } |