/
plow DC motor.c
29 lines (28 loc) · 1.35 KB
/
plow DC motor.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
#pragma config(Hubs, S1, HTMotor, HTMotor, HTMotor, HTServo)
#pragma config(Sensor, S1, , sensorI2CMuxController)
#pragma config(Motor, mtr_S1_C1_1, driveRight, tmotorTetrix, openLoop, reversed)
#pragma config(Motor, mtr_S1_C1_2, driveLeft, tmotorTetrix, openLoop)
#pragma config(Motor, mtr_S1_C2_1, armRight, tmotorTetrix, openLoop, reversed)
#pragma config(Motor, mtr_S1_C2_2, armLeft, tmotorTetrix, openLoop)
#pragma config(Motor, mtr_S1_C3_1, plow, tmotorTetrix, openLoop)
#pragma config(Motor, mtr_S1_C3_2, twirler, tmotorTetrix, openLoop)
#pragma config(Servo, srvo_S1_C4_1, wrist, tServoStandard)
#pragma config(Servo, srvo_S1_C4_2, auto, tServoStandard)
#pragma config(Servo, srvo_S1_C4_3, servo3, tServoNone)
#pragma config(Servo, srvo_S1_C4_4, servo4, tServoNone)
#pragma config(Servo, srvo_S1_C4_5, servo5, tServoNone)
#pragma config(Servo, srvo_S1_C4_6, servo6, tServoNone)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
task main()
{
while(true)
{
nxtDisplayBigTextLine(3, "Plow Arm");
if(nNxtButtonPressed == 1)
motor[plow] = 75;
else if(nNxtButtonPressed == 2)
motor[plow] = -75;
else
motor[plow] = 0;
}
}