Code: #pragma config(Sensor, dgtl1, rightencoder, sensorQuadEncoder) #pragma config(Sensor, dgtl3, leftencoder, sensorQuadEncoder) #pragma config(Motor, port2, rightMotor, tmotorNormal, openLoop) #pragma config(Motor, port3, leftMotor, tmotorNormal, openLoop, reversed) #pragma config(Motor, port4, rightarmMotor, tmotorNormal, openLoop) #pragma config(Motor, port5, leftarmMotor, tmotorNormal, openLoop, reversed) #pragma config(Motor, port6, rightclampMotor, tmotorNormal, openLoop, reversed) #pragma config(Motor, port7, leftclampMotor, tmotorNormal, openLoop) #pragma platform(VEX)
task main() { while (true) { //Wheel Motors motor[leftMotor] = (vexRT[Ch3] + vexRT[Ch1]); //y-axis value: forward/backward motion motor[rightMotor] = (vexRT[Ch3] - vexRT[Ch1]); //x-axis value: left/right steering //Arm Motors motor[leftarmMotor] = -vexRT[Ch3Xmtr2]; motor[rightarmMotor] = -vexRT[Ch3Xmtr2]; //Clamp Joystick motor[leftclampMotor] = -vexRT[Ch2Xmtr2]; motor[rightclampMotor] = -vexRT[Ch2Xmtr2]; //Clamp Joystick- } } |