diff --git a/src/main/java/frc/robot/commands/ShootSafetyPose.java b/src/main/java/frc/robot/commands/ShootSafetyPose.java index d56859e..5e567bb 100644 --- a/src/main/java/frc/robot/commands/ShootSafetyPose.java +++ b/src/main/java/frc/robot/commands/ShootSafetyPose.java @@ -16,7 +16,8 @@ public ShootSafetyPose(ArmSubsystem arm, IndexSubsystem index, IntakeSubsystem i new SetArmPosition(arm, Constants.ArmConstants.ARM_SAFETY_POSE), // new ShooterIndex(shooter, index).withTimeout(1.0) new RevAndShootCommand(index, shooter).withTimeout(1.25).andThen(new InstantCommand(() -> shooter.Disable(), shooter)), - new SetIndex(index, 0).withTimeout(.2) + new SetIndex(index, 0).withTimeout(.2), + new SetArmPosition(arm, Constants.ArmConstants.ARM_HOME_POSE) ); } } \ No newline at end of file