-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathmain.c
54 lines (47 loc) · 2.15 KB
/
main.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
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
#pragma config(Sensor, in1, powerExpander, sensorAnalog)
#pragma config(Sensor, dgtl1, rDriveEncoder, sensorQuadEncoder)
#pragma config(Sensor, dgtl5, rLiftEncoder, sensorQuadEncoder)
#pragma config(Sensor, dgtl7, lLiftEncoder, sensorQuadEncoder)
#pragma config(Sensor, dgtl9, dumpSolenoid, sensorDigitalOut)
#pragma config(Sensor, dgtl10, skySolenoid, sensorDigitalOut)
#pragma config(Sensor, dgtl11, lDriveEncoder, sensorQuadEncoder)
#pragma config(Motor, port1, driveRF, tmotorVex393HighSpeed_HBridge, openLoop, encoderPort, dgtl1)
#pragma config(Motor, port2, driveRB, tmotorVex393HighSpeed_MC29, openLoop, reversed, encoderPort, dgtl1)
#pragma config(Motor, port3, liftRB, tmotorVex393_MC29, openLoop, encoderPort, dgtl7)
#pragma config(Motor, port4, liftLB, tmotorVex393_MC29, openLoop, reversed, encoderPort, dgtl7)
#pragma config(Motor, port5, liftLC, tmotorVex393_MC29, openLoop, reversed, encoderPort, dgtl7)
#pragma config(Motor, port6, liftRC, tmotorVex393_MC29, openLoop, encoderPort, dgtl5)
#pragma config(Motor, port7, liftRA, tmotorVex393_MC29, openLoop, reversed, encoderPort, dgtl5)
#pragma config(Motor, port8, liftLA, tmotorVex393_MC29, openLoop, encoderPort, dgtl5)
#pragma config(Motor, port9, driveLB, tmotorVex393HighSpeed_MC29, openLoop, encoderPort, dgtl11)
#pragma config(Motor, port10, driveLF, tmotorVex393HighSpeed_HBridge, openLoop, reversed, encoderPort, dgtl11)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
//Reversed: driveRB, liftRA, liftLB, liftLC
#pragma platform(VEX)
#pragma competitionControl(Competition)
#pragma autonomousDuration(20)
#pragma userControlDuration(120)
#include "Vex_Competition_Includes.c"
#include "SmartMotorLib.c"
#include "drive.c"
#include "arm.c"
#include "general.c"
#include "auton.c"
void pre_auton()
{
bStopTasksBetweenModes = false;
init();
}
task autonomous()
{
init();
auton();
}
task usercontrol()
{
init();
while (true)
{
userControl(false, false); //(isArcade, isPID)
}
}