|
1 | 1 | package frc.team5115.commands; |
2 | 2 |
|
3 | | -import edu.wpi.first.wpilibj2.command.Command; |
4 | | -import edu.wpi.first.wpilibj2.command.Commands; |
5 | | -import frc.team5115.Constants.AutoConstants.Side; |
6 | | -import frc.team5115.subsystems.drive.Drivetrain; |
7 | | - |
8 | 3 | public class AutoCommands { |
9 | 4 | private AutoCommands() {} |
10 | 5 |
|
11 | | - // command for raising while aligning |
12 | | - // public static Command getReefAlignCommand(Drivetrain drivetrain, Side side) { |
13 | | - // return Commands.sequence(drivetrain.autoAlignToScoringSpot(side).withTimeout(2.0)); |
14 | | - // } |
15 | | - |
16 | | - // /** Aligns left side, removes algae, and scores. */ |
17 | | - // public static Command cleanAndScoreLeft(Drivetrain drivetrain) { |
18 | | - // return Commands.sequence(drivetrain.autoAlignToScoringSpot(Side.LEFT).withTimeout(3.0)); |
19 | | - // } |
20 | | - |
21 | | - // public static Command dealgify(Drivetrain drivetrain) { |
22 | | - // return Commands.sequence( |
23 | | - // Commands.print("Align"), drivetrain.autoAlignToScoringSpot(Side.CENTER).withTimeout(3.0)); |
24 | | - // } |
25 | | - |
26 | | - // public static Command scoreSequence(Drivetrain drivetrain, Side side) { |
27 | | - // return Commands.sequence( |
28 | | - // Commands.print("ScoreSequence!"), drivetrain.autoAlignToScoringSpot(side)); |
29 | | - // } |
30 | | - |
31 | | - // public static Command testingGetReefAlignCommand(Drivetrain drivetrain) { |
32 | | - // return Commands.sequence( |
33 | | - // // drivetrain.autoAlignToScoringSpot(side) |
34 | | - // ); |
35 | | - // } |
| 6 | + /* |
| 7 | + * Commands required for auto: |
| 8 | + * |
| 9 | + * intake |
| 10 | + * lower arm & start intake |
| 11 | + * wait for lunite detection |
| 12 | + * stow arm & stop intake |
| 13 | + * xfer lunite (reverse intake) |
| 14 | + * wait X seconds |
| 15 | + * stop intake |
| 16 | + * |
| 17 | + * score |
| 18 | + * raise outtake |
| 19 | + * wait X seconds |
| 20 | + * lower outtake |
| 21 | + */ |
36 | 22 | } |
0 commit comments