@@ -39,7 +39,7 @@ public class Robot extends IterativeRobot {
39
39
private DriveTrain driveTrain ;
40
40
private PneumaticControl pneumaticControl ;
41
41
private SensorTrack sensorTrack ;
42
- private VisionTrack visionTrack ;
42
+ // private VisionTrack visionTrack;
43
43
44
44
private RobotFunction autonomousCommand ;
45
45
private SendableChooser autoChooser ;
@@ -56,7 +56,7 @@ public void robotInit() {
56
56
driveTrain = new DriveTrain ("DriveTrain" );
57
57
pneumaticControl = new PneumaticControl ("PneumaticControl" );
58
58
sensorTrack = new SensorTrack ("SensorTrack" );
59
- visionTrack = new VisionTrack ("VisionTrack" );
59
+ // visionTrack = new VisionTrack("VisionTrack");
60
60
61
61
autoChooser = new SendableChooser ();
62
62
autoChooser .addDefault ("Autonomous 1: Push" ,
@@ -67,15 +67,15 @@ public void robotInit() {
67
67
new AutonomousChooser (3 ));
68
68
autoChooser .addObject ("Autonomous 4: Pull w/ Hill" ,
69
69
new AutonomousChooser (4 ));
70
- autoChooser .addObject ("Autonomous 0 : Do Nothing" ,
71
- new AutonomousChooser (0 ));
70
+ autoChooser .addObject ("Autonomous 5 : Do Nothing" ,
71
+ new AutonomousChooser (5 ));
72
72
SmartDashboard .putData ("Autonomous Chooser" , autoChooser );
73
73
74
74
armElevator .initialize ();
75
75
driveTrain .initialize ();
76
76
pneumaticControl .initialize ();
77
77
sensorTrack .initialize ();
78
- visionTrack .initialize ();
78
+ // visionTrack.initialize();
79
79
80
80
driveTrain .setMaxPower (0.8 );
81
81
driveTrain .setSensitivity (driveTrain .kDefaultSensitivity );
@@ -84,7 +84,7 @@ public void robotInit() {
84
84
SmartDashboard .putData (driveTrain );
85
85
SmartDashboard .putData (pneumaticControl );
86
86
SmartDashboard .putData (sensorTrack );
87
- SmartDashboard .putData (visionTrack );
87
+ // SmartDashboard.putData(visionTrack);
88
88
SmartDashboard .putData ("Autonomous Mode" , autoChooser );
89
89
SmartDashboard .putData (Scheduler .getInstance ());
90
90
@@ -95,7 +95,7 @@ public void robotInit() {
95
95
* You can use it to reset subsystems before shutting down.
96
96
*/
97
97
public void disabledInit (){
98
- visionTrack .disabledInit ();
98
+ // visionTrack.disabledInit();
99
99
}
100
100
101
101
public void disabledPeriodic () {
@@ -108,15 +108,9 @@ public void autonomousInit() {
108
108
autonomous_number = ((AutonomousChooser ) autoChooser .getSelected ()).getNumber ();
109
109
110
110
switch (autonomous_number ) {
111
- case 0 :
112
- break ;
113
- case 1 :
114
- case 3 :
115
- autonomousSetup (false );
116
- break ;
117
111
case 2 :
118
112
case 4 :
119
- autonomousSetup (true );
113
+ autonomousSetup ();
120
114
break ;
121
115
}
122
116
@@ -130,8 +124,6 @@ public void autonomousPeriodic() {
130
124
double seconds = Timer .getFPGATimestamp ();
131
125
132
126
switch (autonomous_number ) {
133
- case 0 :
134
- break ;
135
127
case 1 :
136
128
autonomousPush (seconds , 2.0 );
137
129
break ;
@@ -158,7 +150,7 @@ public void teleopInit() {
158
150
// this line or comment it out.
159
151
160
152
armElevator .resetEncoder ();
161
- visionTrack .telopInit ();
153
+ // visionTrack.telopInit();
162
154
163
155
}
164
156
@@ -175,7 +167,7 @@ public void teleopPeriodic() {
175
167
driveTrain .start ();
176
168
pneumaticControl .start ();
177
169
sensorTrack .start ();
178
- visionTrack .start ();
170
+ // visionTrack.start();
179
171
output ();
180
172
181
173
}
@@ -199,13 +191,11 @@ private void output() {
199
191
200
192
}
201
193
202
- private void autonomousSetup (boolean extra ) {
194
+ private void autonomousSetup () {
203
195
204
- if (extra ) {
205
196
armElevator .autoStart ();
206
197
pneumaticControl .autonomous ();
207
198
Timer .delay (1.0 );
208
- }
209
199
210
200
}
211
201
0 commit comments