Code: #pragma config(Hubs, S1, HTMotor, HTServo, none, none) #pragma config(Sensor, S2, touch, sensorTouch) #pragma config(Motor, mtr_S1_C1_1, motorD, tmotorNormal, openLoop) #pragma config(Motor, mtr_S1_C1_2, motorE, tmotorNormal, openLoop) #pragma config(Servo, srvo_S1_C2_1, servo1, tServoStandard) #pragma config(Servo, srvo_S1_C2_2, servo2, tServoStandard) #pragma config(Servo, srvo_S1_C2_3, servo3, tServoStandard) #pragma config(Servo, srvo_S1_C2_4, servo4, tServoStandard)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
task fronthoch() { int delta = 2; servoChangeRate[servo3] = delta; servoChangeRate[servo4] = delta; servo[servo3] = 255; servo[servo4] = 255; }
task frontherab() { int delta = 2; servoChangeRate[servo3] = delta; servoChangeRate[servo4] = delta; servo[servo3] = 0; servo[servo4] = 0; }
task main() { while(SensorValue (sensorTouch) == 1) // While the Touch Sensor is active (pressed): { StartTask(fronthoch); StartTask(frontherab); } }
|