|
1 | 1 | package frc.robot.subsystems.superstructure; |
2 | 2 |
|
3 | | -import static edu.wpi.first.units.Units.Percent; |
4 | | -import static edu.wpi.first.units.Units.Second; |
5 | | - |
6 | 3 | import edu.wpi.first.math.util.Units; |
7 | | -import edu.wpi.first.wpilibj.LEDPattern; |
8 | | -import edu.wpi.first.wpilibj.LEDPattern.GradientType; |
9 | 4 | import edu.wpi.first.wpilibj.util.Color; |
10 | 5 | import edu.wpi.first.wpilibj2.command.Command; |
11 | 6 | import edu.wpi.first.wpilibj2.command.Commands; |
12 | 7 | import edu.wpi.first.wpilibj2.command.SubsystemBase; |
13 | | -import frc.robot.commands.SetAddressableLEDPattern; |
14 | | -import frc.robot.subsystems.addressableled.AddressableLEDSubsystem; |
15 | 8 | import frc.robot.subsystems.superstructure.elevator.Elevator; |
16 | 9 | import frc.robot.subsystems.superstructure.elevator.ElevatorConstants; |
17 | 10 | import frc.robot.subsystems.superstructure.intake.Intake; |
@@ -145,11 +138,6 @@ public Command prepareL3() { |
145 | 138 |
|
146 | 139 | public Command prepareL4() { |
147 | 140 | return Commands.parallel( |
148 | | - new SetAddressableLEDPattern( |
149 | | - led, |
150 | | - LEDPattern.gradient( |
151 | | - GradientType.kContinuous, Color.kBlack, SuperstructureConstants.L4_COLOR) |
152 | | - .scrollAtRelativeSpeed(Percent.per(Second).of(35))), |
153 | 141 | elevator.runOnce(() -> elevator.setGoalHeightMeters(ElevatorConstants.carriageMaxHeight)), |
154 | 142 | algaeWrist.runPrepare(algaeHighStow), |
155 | 143 | coralWrist.runPrepare(Units.degreesToRotations(90))); |
@@ -183,34 +171,6 @@ public Command prepareAlgaeL4() { |
183 | 171 | coralWrist.runPrepare(Units.degreesToRotations(90))); |
184 | 172 | } |
185 | 173 |
|
186 | | - public Command prepareAlgaeL1() { |
187 | | - return Commands.parallel( |
188 | | - elevator.runPrepare(ElevatorConstants.carriageMaxHeight / 4.0), |
189 | | - coralWrist.runPrepare(coralHighStow), |
190 | | - algaeWrist.runPrepare(Units.degreesToRotations(90))); |
191 | | - } |
192 | | - |
193 | | - public Command prepareAlgaeL2() { |
194 | | - return Commands.parallel( |
195 | | - elevator.runPrepare(ElevatorConstants.carriageMaxHeight / 2.0), |
196 | | - coralWrist.runPrepare(coralHighStow), |
197 | | - algaeWrist.runPrepare(Units.degreesToRotations(90))); |
198 | | - } |
199 | | - |
200 | | - public Command prepareAlgaeL3() { |
201 | | - return Commands.parallel( |
202 | | - elevator.runPrepare(ElevatorConstants.carriageMaxHeight * (3.0 / 4.0)), |
203 | | - coralWrist.runPrepare(coralHighStow), |
204 | | - algaeWrist.runPrepare(Units.degreesToRotations(90))); |
205 | | - } |
206 | | - |
207 | | - public Command prepareAlgaeL4() { |
208 | | - return Commands.parallel( |
209 | | - elevator.runOnce(() -> elevator.setGoalHeightMeters(ElevatorConstants.carriageMaxHeight)), |
210 | | - coralWrist.runPrepare(coralHighStow), |
211 | | - algaeWrist.runPrepare(Units.degreesToRotations(90))); |
212 | | - } |
213 | | - |
214 | 174 | public Command prepareIntake() { |
215 | 175 | return Commands.parallel( |
216 | 176 | elevator.runPrepare(ElevatorConstants.carriageMaxHeight / 4.0), |
|
0 commit comments