Code: #pragma config(Hubs, S1, HTMotor, HTServo, none, none) #pragma config(Motor, mtr_S1_C1_1, right, tmotorNormal, openLoop) #pragma config(Motor, mtr_S1_C1_2, left, tmotorNormal, openLoop) #pragma config(Servo, servo1, lower_arm_right, tServoNormal) #pragma config(Servo, servo2, lower_arm_left, tServoNormal) #pragma config(Servo, servo3, middle_arm, tServoNormal) #pragma config(Servo, servo4, bucket, tServoNormal) //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
#include "JoystickDriver.c"
task main() { while (true) { getJoystickSettings(joystick); motor[left] = joystick.joy1_y1; motor[right] = joystick.joy1_y2; } while (true) { getJoystickSettings(joystick);
if(joy2Btn(4) !=0); { servoTarget[lower_arm_right] = 150; } if(joy2Btn(2) !=0) { servoTarget[lower_arm_right] = 0; } if(joy2Btn(4) !=0); { servoTarget[lower_arm_left] = 150; } if(joy2Btn(2) !=0); { servoTarget[lower_arm_left] = 0; } if(joy2Btn(5) !=0); { servoTarget[middle_arm] = 150; } if(joy2Btn(7) !=0) { servoTarget[middle_arm] = 0; } if(joy2Btn(6) !=0) { servoTarget[bucket] = 150; } if(joy2Btn(8) !=0) { servoTarget[bucket] = 0; } } } //Admin Edit for readability
|