forked from Andover-Robotics/ARC-Code
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathArmTest
21 lines (20 loc) · 1.25 KB
/
ArmTest
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
#pragma config(Hubs, S2, HTMotor, HTServo, HTMotor, none)
#pragma config(Sensor, S2, , sensorI2CMuxController)
#pragma config(Sensor, S3, IRSensor, sensorHiTechnicIRSeeker1200)
#pragma config(Sensor, S4, ColorSensor, sensorI2CHiTechnicColor)
#pragma config(Motor, mtr_S2_C1_1, L, tmotorTetrix, openLoop, encoder)
#pragma config(Motor, mtr_S2_C1_2, R, tmotorTetrix, openLoop, reversed, encoder)
#pragma config(Motor, mtr_S2_C3_1, LinearSlide, tmotorTetrix, openLoop, encoder)
#pragma config(Motor, mtr_S2_C3_2, ArmMotor, tmotorTetrix, openLoop, encoder)
#pragma config(Servo, srvo_S2_C2_1, ArmExtend, tServoContinuousRotation)
#pragma config(Servo, srvo_S2_C2_2, ArmJoint, tServoStandard)
#pragma config(Servo, srvo_S2_C2_3, servo3, tServoNone)
#pragma config(Servo, srvo_S2_C2_4, servo4, tServoNone)
#pragma config(Servo, srvo_S2_C2_5, servo5, tServoNone)
#pragma config(Servo, srvo_S2_C2_6, servo6, tServoNone)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
task main(){
motor[ArmMotor] = 80;
motor[LinearSlide] = 80;
wait10Msec(100);
}