Code: #pragma config(Hubs, S1, HTMotor, HTMotor, none, none) #pragma config(Sensor, S1, , sensorI2CMuxController) #pragma config(Sensor, S2, IRSeeker2, sensorHiTechnicIRSeeker1200) #pragma config(Sensor, S3, IRSeeker3, sensorHiTechnicIRSeeker1200) #pragma config(Motor, mtr_S1_C1_1, motorD, tmotorTetrix, openLoop) #pragma config(Motor, mtr_S1_C1_2, motorE, tmotorTetrix, openLoop, reversed) #pragma config(Motor, mtr_S1_C2_1, motorF, tmotorTetrix, openLoop) #pragma config(Motor, mtr_S1_C2_2, motorG, tmotorTetrix, openLoop) //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
task main() { while(1 == 1) {
if(SensorValue[IRSeeker2] == 5) { motor[motorD] = 25; motor[motorE] = 25; }
if(SensorValue[IRSeeker2] > 5 ) { motor[motorD] = 20; motor[motorE] = -20; }
if(SensorValue[IRSeeker2] < 5) { motor[motorD] = -20; motor[motorE] = 20; }
if(SensorValue[IRSeeker3] > 5) { motor[motorF] = 40; }
if(SensorValue[IRSeeker3] < 5) { motor[motorF] = -40; }
if(SensorValue[IRSeeker3] == 5) { motor[motorF] = 0; } } } |