Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #pragma config(Sensor, dgtl1, rightEncoder, sensorQuadEncoder)
- #pragma config(Sensor, dgtl3, leftEncoder, sensorQuadEncoder)
- #pragma config(Motor, port2, rightMotor, tmotorNormal, openLoop, reversed)
- #pragma config(Motor, port3, leftMotor, tmotorNormal, openLoop)
- //*!!Code automatically generated by ‘ROBOTC’ configuration wizard !!*//
- task main()
- {
- //set int
- int s1;
- int s2;
- s1 = 63;
- s2 = 63;
- //set sensors
- SensorValue[rightEncoder]= 0;
- SensorValue[leftEncoder]= 0;
- while(SensorValue[leftEncoder] < 1960)
- {
- if(SensorValue[leftEncoder] == SensorValue[rightEncoder])
- {
- motor[rightMotor] = s1;
- motor[leftMotor] = s2;
- }
- else(SensorValue[rightEncoder] > SensorValue[leftEncoder]);
- {
- s1 = s1-63;
- wait1Msec(5000);
- s1 = s1+63;
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement