diff --git a/src/main/java/frc/robot/commands/states/None.java b/src/main/java/frc/robot/commands/states/None.java index bc51739..ae75e13 100644 --- a/src/main/java/frc/robot/commands/states/None.java +++ b/src/main/java/frc/robot/commands/states/None.java @@ -6,6 +6,8 @@ import edu.wpi.first.wpilibj2.command.Command; import frc.robot.RobotContainer; +import frc.robot.constants.ConstMotion; +import frc.robot.constants.ConstRotors; import frc.robot.subsystems.*; /* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */ @@ -22,6 +24,11 @@ public None() { @Override public void initialize() { RobotContainer.stateMachineInstance.setRobotState(StateMachine.RobotState.NONE); + RobotContainer.rotorsInstance.setFlywheelPercentOutput(ConstRotors.STOP); + RobotContainer.rotorsInstance.setSerializerRollersPercentOutput(ConstRotors.STOP); + RobotContainer.rotorsInstance.setTransferRollersPercentOutput(ConstRotors.STOP); + RobotContainer.rotorsInstance.setIntakeRollersPercentOutput(ConstRotors.STOP); + RobotContainer.motionInstance.setHoodPivotAngle(ConstMotion.HOOD_NONE_ANGLE); } // Called every time the scheduler runs while the command is scheduled. diff --git a/src/main/java/frc/robot/constants/ConstMotion.java b/src/main/java/frc/robot/constants/ConstMotion.java index 0e5a5a0..534bd6f 100644 --- a/src/main/java/frc/robot/constants/ConstMotion.java +++ b/src/main/java/frc/robot/constants/ConstMotion.java @@ -24,6 +24,7 @@ public class ConstMotion { public static final Angle INTAKE_PIVOT_RETRACT = Degrees.of(0); public static final Angle HOOD_PIVOT_ANGLE = Degrees.of(14); public static final double STOP = 0; + public static final Angle HOOD_NONE_ANGLE = Degrees.of(0); static {