-
Notifications
You must be signed in to change notification settings - Fork 1
/
Competition.c
144 lines (121 loc) · 6.22 KB
/
Competition.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
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
#pragma config(Sensor, in1, , sensorPotentiometer)
#pragma config(Sensor, in2, , sensorPotentiometer)
#pragma config(Sensor, in3, , sensorPotentiometer)
#pragma config(Sensor, in4, , sensorPotentiometer)
#pragma config(Sensor, dgtl1, , sensorTouch)
#pragma config(Sensor, dgtl2, , sensorTouch)
#pragma config(Sensor, dgtl3, , sensorTouch)
#pragma config(Motor, port1, , tmotorVex393_HBridge, openLoop)
#pragma config(Motor, port2, , tmotorVex393_MC29, openLoop)
#pragma config(Motor, port3, , tmotorVex393_MC29, openLoop, driveLeft)
#pragma config(Motor, port4, , tmotorVex393_MC29, openLoop, driveLeft)
#pragma config(Motor, port5, , tmotorVex393_MC29, openLoop)
#pragma config(Motor, port6, , tmotorVex393_MC29, openLoop)
#pragma config(Motor, port7, , tmotorVex393_MC29, openLoop, driveRight)
#pragma config(Motor, port8, , tmotorVex393_MC29, openLoop, driveRight)
#pragma config(Motor, port9, , tmotorVex393_MC29, openLoop)
#pragma config(Motor, port10, , tmotorVex393_HBridge, openLoop)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
/*---------------------------------------------------------------------------*/
/* */
/* Description: Competition template for VEX EDR */
/* */
/*---------------------------------------------------------------------------*/
// This code is for the VEX cortex platform
#pragma platform(VEX2)
// Select Download method as "competition"
#pragma competitionControl(Competition)
// Launch Debugger windows
#pragma DebuggerWindows("vexCompetitionControl")
#pragma DebuggerWindows("debugStream")
#pragma DebuggerWindows("vexLCD")
//Set debug variable - CHANGE BEFORE COMPETITION
//const bool DEBUG = false;
#define DEBUG 0
#if DEBUG
#warn "Don't forget to turn off DEBUG"
#endif
///////////////////////////////////////////////////
//ZERO OUT ALL AUTONOMOUS AND PROGRAMMING SKILLS://
//USE WITH GREAT CAUTION!! WILL USE _ZERO FILES..//
///////////////////////////////////////////////////
#define ZERO_OUT_AUTON 0
#if ZERO_OUT_AUTON
#warn "TURN OFF ZERO_OUT_AUTON"
#endif
//Main competition background code...do not modify!
#include "Vex_Competition_Includes.c"
//Pin reading
#include "PinReading.h"
//Remote/Replay reading
#include "ReplayReader.h"
//Controller
#include "CombinedReplay.h";
//Recording
#include "Recording.h";
/*---------------------------------------------------------------------------*/
/* Pre-Autonomous Functions */
/* */
/* You may want to perform some actions before the competition starts. */
/* Do them in the following function. You must return from this function */
/* or the autonomous and usercontrol tasks will not be started. This */
/* function is only called once after the cortex has been powered on and */
/* not every time that the robot is disabled. */
/*---------------------------------------------------------------------------*/
void pre_auton()
{
clearDebugStream();
writeDebugStreamLine("(%s,%d): Battery level at %1.2fV ",__FILE__,__LINE__,nImmediateBatteryLevel/1000.0);
// Set bStopTasksBetweenModes to false if you want to keep user created tasks
// running between Autonomous and Driver controlled modes. You will need to
// manage all user created tasks if set to false.
bStopTasksBetweenModes = true;
// Set bDisplayCompetitionStatusOnLcd to false if you don't want the LCD
// used by the competition include file, for example, you might want
// to display your team name on the LCD in this function.
bDisplayCompetitionStatusOnLcd = true;
// All activities that occur before the competition starts
// Example: clearing encoders, setting servo positions, ...
}
/*---------------------------------------------------------------------------*/
/* */
/* Autonomous Task */
/* */
/* This task is used to control your robot during the autonomous phase of */
/* a VEX Competition. */
/* */
/* You must modify the code to add your own robot specific commands here. */
/*---------------------------------------------------------------------------*/
task autonomous()
{
writeDebugStreamLine("(%s,%d): Entering autonomous task",__FILE__,__LINE__);
if(!pinNoReplay()){
startTask(ReplayReader);
startTask(combinedReplay);
while(true){
sleep(1000);
}
}
}
/*---------------------------------------------------------------------------*/
/* */
/* User Control Task */
/* */
/* This task is used to control your robot during the user control phase of */
/* a VEX Competition. */
/* */
/* You must modify the code to add your own robot specific commands here. */
/*---------------------------------------------------------------------------*/
task usercontrol()
{
writeDebugStreamLine("(%s,%d): Entering usercontrol task ",__FILE__,__LINE__);
if(pinRecording()){
doRecording();
}else{
startTask(ReplayReader);
startTask(combinedReplay);
while(true){
sleep(1000);
}
}
}