Skip to content

Commit 4e4b0a6

Browse files
L4 teleop statemachine tweak
1 parent f1571e1 commit 4e4b0a6

File tree

1 file changed

+2
-2
lines changed

1 file changed

+2
-2
lines changed

src/main/java/team1403/robot/commands/StateMachine.java

Lines changed: 2 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -47,15 +47,15 @@ public void execute() {
4747
}
4848
break;
4949
case driving:
50-
if(Blackbox.reefLevel != Blackbox.reefLevel.drive)
50+
if(Blackbox.reefLevel != Blackbox.ReefScoreLevel.drive)
5151
m_wristSubsystem.moveToSetpoint(Constants.Wrist.Setpoints.Drive);
5252
if(Blackbox.isAligning() && Blackbox.reefLevel != Blackbox.ReefScoreLevel.drive)
5353
Blackbox.robotState = State.aligning;
5454
break;
5555
case aligning:
5656
if(Blackbox.isAligning() && Blackbox.getCloseAlign(m_swerve.getPose()) && Blackbox.reefLevel == Blackbox.ReefScoreLevel.L4)
5757
Blackbox.robotState = State.placing;
58-
if(!Blackbox.isAligning())
58+
if(!Blackbox.isAligning() && Blackbox.reefLevel != Blackbox.ReefScoreLevel.L4) //l4 goes really high, so let's wait until we are close
5959
Blackbox.robotState = State.placing;
6060
break;
6161
case placing:

0 commit comments

Comments
 (0)