Intake

src/main/java/frc/robot/Constants.java

@@ -16,4 +16,7 @@
  * constants are needed, to reduce verbosity.
  */
 public final class Constants {
+    public static final class Intake {
+        public static final double POWER = 0.8; // [%]
+    }
 }

src/main/java/frc/robot/Intake.java

@@ -0,0 +1,63 @@
+package frc.robot;
+
+import com.ctre.phoenix.motorcontrol.ControlMode;
+import com.ctre.phoenix.motorcontrol.can.TalonSRX;
+import edu.wpi.first.wpilibj.Solenoid;
+import edu.wpi.first.wpilibj2.command.SubsystemBase;
+
+/**
+ * Add&named motors in Intake.
+ */
+public class Intake extends SubsystemBase {
+    private TalonSRX motor = new TalonSRX(Ports.Intake.MOTOR);
+    private Solenoid piston = new Solenoid(Ports.Intake.SOLENOID);
+
+    /**
+     * Add motor inverted.
+     * Add data of is Motor inverted
+     */
+    public Intake() {
+        motor.setInverted(Ports.Intake.IS_MOTOR_INVERTED);
+    }
+
+    /**
+     * Set percentage for motor.
+     * @param power the speed times the torque.
+     */
+    public void powerWheels(double power) {
+        motor.set(ControlMode.PercentOutput, power);
+    }
+
+    /**
+     * A check to see if piston is open or close, true= open, false= close.
+     * @return
+     */
+    public boolean isPistonEngaged() {
+        return piston.get();
+    }
+
+    /**
+     * Set piston position.
+     * @param engaged
+     */
+    public void setPistonMode(boolean engaged) {
+        piston.set(engaged);
+    }
+
+    /**
+     * Change piston position.
+     */
+    public void toggle() {
+        if (isPistonEngaged()) {
+            setPistonMode(false);
+        } else {
+            setPistonMode(true);
+        }
+
+    }
+
+}
+
+
+
+

src/main/java/frc/robot/Ports.java

@@ -0,0 +1,14 @@
+package frc.robot;
+
+
+/**
+ * Data of MOTOR & SOLENOID.
+ * Data of boolean MOTOR inverted.
+ */
+public class Ports {
+    public static class Intake {
+        public static final int MOTOR = 0;
+        public static final int SOLENOID = 0;
+        public static final boolean IS_MOTOR_INVERTED = true;
+    }
+}

src/main/java/frc/robot/RobotContainer.java

@@ -7,18 +7,26 @@
 
 package frc.robot;
 
-import com.revrobotics.ColorSensorV3;
 import edu.wpi.first.wpilibj.GenericHID;
 import edu.wpi.first.wpilibj.XboxController;
 import edu.wpi.first.wpilibj2.command.Command;
-import frc.robot.subsystems.ExampleSubsystem.ExampleSubsystem;
+import edu.wpi.first.wpilibj2.command.button.JoystickButton;
+import frc.robot.subsystems.intake.commands.Commandy;
+
+
 /**
  * This class is where the bulk of the robot should be declared.  Since Command-based is a
  * "declarative" paradigm, very little robot logic should actually be handled in the {@link Robot}
  * periodic methods (other than the scheduler calls).  Instead, the structure of the robot
  * (including subsystems, commands, and button mappings) should be declared here.
  */
 public class RobotContainer {
+  public XboxController Xbox = new XboxController(1);
+  public JoystickButton a = new JoystickButton(Xbox, XboxController.Button.kA.value);
+  public JoystickButton b = new JoystickButton(Xbox, XboxController.Button.kB.value);
+  private final Intake intake= new Intake();
+
+
   // The robot's subsystems and commands are defined here...
 
 
@@ -37,6 +45,7 @@ public RobotContainer() {
    * {@link edu.wpi.first.wpilibj2.command.button.JoystickButton}.
    */
   private void configureButtonBindings() {
+    a.whileHeld(new Commandy(intake, Constants.Intake.POWER));
   }
 
 

src/main/java/frc/robot/subsystems/intake/commands/Commandy.java

@@ -0,0 +1,50 @@
+package frc.robot.subsystems.intake.commands;
+
+import edu.wpi.first.wpilibj2.command.CommandBase;
+import frc.robot.Intake;
+
+/**
+ * Add Commandy function;
+ */
+public class Commandy extends CommandBase {
+    private final Intake intake;
+    private final double power;
+
+    /**
+     * Add Requirements
+     * @param intake name to Intake.
+     */
+    public Commandy(Intake intake, double power) {
+        this.intake = intake;
+        this.power = power;
+        addRequirements(intake);
+
+    }
+
+
+    @Override
+    public void initialize() {
+        super.initialize();
+        intake.setPistonMode(false);
+    }
+
+
+    @Override
+    public void execute() {
+        super.execute();
+        intake.powerWheels(power);
+    }
+
+    @Override
+    public boolean isFinished() {
+        return super.isFinished();
+    }
+
+
+    @Override
+    public void end(boolean interrupted) {
+        super.end(interrupted);
+        intake.powerWheels(0);
+//        intake.setPistonMode(true);
+    }
+}

src/main/java/frc/robot/subsystems/intake/commands/ToggleIntake.java

@@ -0,0 +1,22 @@
+package frc.robot.subsystems.intake.commands;
+
+import edu.wpi.first.wpilibj2.command.CommandBase;
+import edu.wpi.first.wpilibj2.command.InstantCommand;
+import frc.robot.Intake;
+
+public class ToggleIntake extends InstantCommand {
+
+    private Intake intake;
+
+    public ToggleIntake(Intake intake) {
+        this.intake = intake;
+        addRequirements(intake);
+    }
+
+    @Override
+    public void initialize() {
+        super.initialize();
+        intake.toggle();
+    }
+
+}