Skip to content

Commit 1493d54

Browse files
Replace manual climb commands and with direct subystem control
Commands refuse to run. Unable to debug cause before next match. Use hack code to control the subsystem directly. This is dangerous for any active climb commands. - Nick Q and Justin C
1 parent 42283e6 commit 1493d54

File tree

1 file changed

+13
-7
lines changed

1 file changed

+13
-7
lines changed

src/main/cpp/Robot.cpp

Lines changed: 13 additions & 7 deletions
Original file line numberDiff line numberDiff line change
@@ -227,15 +227,21 @@ void Robot::TeleopPeriodic()
227227
double opY = operatorController->GetLeftY();
228228
opY = fabs(opY) < 0.3 ? 0.0 : opY;
229229
if (opY < 0.0) {
230-
mManualRetractOuterArms->Schedule();
230+
// mManualRetractOuterArms->Schedule();
231+
mClimber->runOuter1(0.2);
232+
mClimber->runOuter2(0.2);
231233
} else if (opY > 0.0) {
232-
mManualExtendOuterArms->Schedule();
234+
mClimber->runOuter1(-0.2);
235+
mClimber->runOuter2(-0.2);
236+
// mManualExtendOuterArms->Schedule();
233237
} else {
234-
if (mManualRetractOuterArms->IsScheduled()) {
235-
mManualRetractOuterArms->Cancel();
236-
} else if (mManualExtendOuterArms->IsScheduled()) {
237-
mManualExtendOuterArms->Cancel();
238-
}
238+
mClimber->stopOuter1();
239+
mClimber->stopOuter2();
240+
// if (mManualRetractOuterArms->IsScheduled()) {
241+
// mManualRetractOuterArms->Cancel();
242+
// } else if (mManualExtendOuterArms->IsScheduled()) {
243+
// mManualExtendOuterArms->Cancel();
244+
// }
239245
}
240246
}
241247

0 commit comments

Comments
 (0)