Skip to content

Commit

Permalink
Move Arm Commands
Browse files Browse the repository at this point in the history
  • Loading branch information
MeowAzalea committed Mar 2, 2024
1 parent 4e68f77 commit 04bdb5d
Showing 1 changed file with 6 additions and 6 deletions.
12 changes: 6 additions & 6 deletions src/main/java/frc/robot/RobotContainer.java
Original file line number Diff line number Diff line change
Expand Up @@ -122,6 +122,10 @@ public class RobotContainer {

private final LightStrip lightStrip = new LightStrip(LightConstants.LED_CONTROLLER_PWM_SLOT);

public final Command armToIntake = new ArmRotateTo(arm, ArmConstants.ARM_INTAKE_DEGREES);
public final Command armToAmp = new ArmRotateTo(arm, ArmConstants.ARM_AMP_SHOOTING_DEGREES);
public final Command armToSpeaker = new ArmRotateTo(arm, ArmConstants.ARM_SPEAKER_SHOOTING_DEGREES);

/**
* The container for the robot. Contains subsystems, OI devices, and commands.
*/
Expand Down Expand Up @@ -210,10 +214,6 @@ public void setUpOperatorController() {
final GenericHID genericHID = new GenericHID(DriverConstants.OPERATOR_JOYSTICK_PORT);
final HIDType genericHIDType = genericHID.getType();

final Command armToIntake = new ArmRotateTo(arm, ArmConstants.ARM_INTAKE_DEGREES);
final Command armToAmp = new ArmRotateTo(arm, ArmConstants.ARM_AMP_SHOOTING_DEGREES);
final Command armToSpeaker = new ArmRotateTo(arm, ArmConstants.ARM_SPEAKER_SHOOTING_DEGREES);

final Command intake = Commands.runOnce(intakeShooter::intake, intakeShooter);
final Command startFlyWheel = Commands.runOnce(intakeShooter::startFlyWheels, intakeShooter);

Expand All @@ -223,7 +223,7 @@ public void setUpOperatorController() {
final Command coopLightSignal = new SetLightstripColor(lightStrip, LightConstants.LED_COLOR_ORANGE);

final Command cancelCommand = new CancelCommands(drivetrain, arm, intakeShooter);

final SetHangSpeed hangStop = new SetHangSpeed(hang, 0);
final SetHangSpeed hangForwarSpeed = new SetHangSpeed(hang, HangConstants.speed);
final SetHangSpeed hangBackwardSpeed = new SetHangSpeed(hang, -HangConstants.speed);
Expand All @@ -242,7 +242,7 @@ public void setUpOperatorController() {
joystick.button(7).or(joystick.button(8)).whileFalse(hangStop);
joystick.button(7).onTrue(hangForwarSpeed);
joystick.button(8).onTrue(hangBackwardSpeed);

joystick.button(9).onTrue(amplifyLightSignal);
joystick.button(10).onTrue(coopLightSignal);
} else {
Expand Down

0 comments on commit 04bdb5d

Please sign in to comment.