Skip to content
Open
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
2 changes: 2 additions & 0 deletions src/main/java/frc/robot/Constants.java
Original file line number Diff line number Diff line change
Expand Up @@ -895,6 +895,8 @@ public static class ElevatorConstants {
public static final double MOTIONMAGIC_MAX_ACCELERATION = 250;

public static double SENSOR_OFFSET = 0.11;
public static double minHeight;
public static double maxHeight;
// public static final double MOTIONMAGIC_KG = 0.28;
public static final double CRUISE_VELOCITY = 6.0; // To-do
public static final double ACCELERATION = 6.0; // To-do
Expand Down
52 changes: 52 additions & 0 deletions src/main/java/frc/robot/commandGroups/ApplicationMD4.java
Original file line number Diff line number Diff line change
@@ -0,0 +1,52 @@
package frc.robot.commandGroups;

import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;
import frc.robot.Constants.ElevatorConstants.ElevatorPositions;
import frc.robot.commands.ElevatorCommands.SetElevatorLevel;

/*
*
*
* Task Card:
* You will be creating a CommandGroup that does the following:
* 1. Intakes the Coral
* 2. Elevator goes to L4
* 3. Elevator goes to L2
* 4. Elevator goes to L3
* 5. Elevator goes to L2
* 6. Elevator Shoots AND Spins the Funnel at the same time.
* When the Shooting ENDS stop the Funnel
* 7. Elevator goes to L4
* 8. AS Elevator lowers down to L2 spin both the Funnel and Shooter
*
*
* NOTES:
* * Auto-intaking has been disabled
* * Auto-eject has been disabled
* --> This means you have to be careful with trying to feed a coral
* --> when there is already another coral in the robot
*
* * INVESTIGATE ALL OF THE RELEVANT COMMANDS AND THEIR END BEHAVIORS
* * BEFORE YOU BEGIN CREATING THE COMMAND GROUP
*
* Relevant Commands:
* SetElevatorLevel <-- takes care of Elevator raising to certain hegiht
* ShootTootsieSlide <-- Shoots the coral (spins the shooter)
* RunFunnelOutCommand <-- spins the funnel
*
*
* * STARTING HINT: This class must extend either SequentialCommandGroup or
* * ParallelCommandGroup
*
* Good luck and refer to the MD.4 Resources, me or your Software
* mentors if you have any questions or difficulties!
*
* After you make your CommandGroup, check RobotContainer.java
* Lines 359-360 and you will bind your CommandGroup to the
* custom controller board left L1 button and test that way
*
*/

public class ApplicationMD4 extends SequentialCommandGroup {
addCommands(new SetElevatorLevel(ElevatorPositions.L4, true), new SetElevatorLevel(ElevatorPositions.L3, true), f);
}
Loading
Loading