 | Code: #pragma config(Hubs, S1, HTMotor, HTServo, HTMotor, none) #pragma config(Sensor, S1, , sensorI2CMuxController) #pragma config(Motor, motorA, , tmotorNXT, openLoop) #pragma config(Motor, motorB, , tmotorNXT, openLoop) #pragma config(Motor, motorC, , tmotorNXT, openLoop) #pragma config(Motor, mtr_S1_C1_1, leftm, tmotorTetrix, openLoop, reversed) #pragma config(Motor, mtr_S1_C1_2, rightm, tmotorTetrix, openLoop) #pragma config(Motor, mtr_S1_C3_1, liftm, tmotorTetrix, openLoop) #pragma config(Motor, mtr_S1_C3_2, motorG, tmotorTetrix, openLoop) #pragma config(Servo, srvo_S1_C2_1, gateS, tServoStandard) #pragma config(Servo, srvo_S1_C2_2, servo2, tServoNone) #pragma config(Servo, srvo_S1_C2_3, servo3, tServoNone) #pragma config(Servo, srvo_S1_C2_4, servo4, tServoNone) #pragma config(Servo, srvo_S1_C2_5, servo5, tServoNone) #pragma config(Servo, srvo_S1_C2_6, servo6, tServoNone) #include "JoystickDriver.c"
void ReverseSupportHecarim() //counteracts gravity and prevents sagging { motor[liftm]=30; } task main() { bool DariusOP=false; while(true) { getJoystickSettings(joystick); ////////////////////////////////////////////////////////////////////////// //Arm ////////////////////////////////////////////////////////////////////////// if(joy1Btn(4)) { motor[liftm]=30; } if(joy1Btn(2)) { motor[liftm]=-30; } if(!joy1Btn(4)&&!joy1Btn(2)) { motor[liftm]=0; } ///////////////////////////////////////////////////////////////////////// //Darius OP (monitors the toggle) ///////////////////////////////////////////////////////////////////////// if(joy1Btn(6)) { if(DariusOP==false) { DariusOP=true; } if(DariusOP==true) { DariusOP=false; } } while(DariusOP==true) { ReverseSupportHecarim(); } } } }
|  |