 | Code: #pragma config(Hubs, S1, HTMotor, none, none, none) #pragma config(Hubs, S2, HTMotor, none, none, none) #pragma config(Hubs, S3, HTMotor, none, none, none) #pragma config(Sensor, S1, , sensorI2CMuxController) #pragma config(Sensor, S2, , sensorI2CMuxController) #pragma config(Sensor, S3, , sensorI2CMuxController) #pragma config(Motor, mtr_S1_C1_1, motorF, tmotorTetrix, openLoop, reversed) #pragma config(Motor, mtr_S1_C1_2, motorG, tmotorTetrix, openLoop) #pragma config(Motor, mtr_S2_C1_1, motorD, tmotorTetrix, openLoop) #pragma config(Motor, mtr_S2_C1_2, motorE, tmotorTetrix, openLoop, reversed) #pragma config(Motor, mtr_S3_C1_1, motorH, tmotorTetrix, openLoop) #pragma config(Motor, mtr_S3_C1_2, motorI, tmotorTetrix, openLoop, reversed) //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
#include "JoystickDriver.c"
task main() {
while(true) { getJoystickSettings(joystick); motor[motorD] = joystick.joy1_y1; motor[motorE] = joystick.joy1_y2; //Motor E is Reversed
getJoystickSettings(joystick); {if(abs(joystick.joy2_y1) > 10){ { motor[motorF] = joystick.joy2_y1/2; motor[motorG] = joystick.joy2_y1/2; //Motor G is reversed else{ motor[motorF] = 0; motor[motorG] = 0; }}} { if(abs(joystick.joy2_y2) > 10){ motor[motorH] = joystick.joy2_y2/2; motor[motorI] = joystick.joy2_y2/2; //Motor I is reversed else{ motor[motorH] = 0; motor[motorI] = 0; }}}
}
|  |