Coral elevator

src/main/java/frc/robot/RobotMap.java

@@ -2,8 +2,10 @@
 
 public class RobotMap {
 
-    private RobotMap() {}
+    public static final int UPPER_LIMIT_SWITCH = 1;
+    public static final int LOWER_LIMIT_SWITCH =2;
+    public static final int PISTON_FORWARD_CHANNEL = 1;
+    public static final int PISTON_REVERSE_CHANNEL = 1;
+
 
-    // add constants here
-    // public static final type NAME = value;
 }

src/main/java/frc/robot/commands/LowerCoralElevator.java

@@ -0,0 +1,35 @@
+package frc.robot.commands;
+
+import edu.wpi.first.wpilibj2.command.Command;
+import frc.robot.subsystems.CoralElevator;
+
+public class LowerCoralElevator extends Command {
+
+    private CoralElevator coralElevator;
+
+    public LowerCoralElevator(CoralElevator coralElevator) {
+        this.coralElevator = coralElevator;
+        addRequirements(coralElevator);
+    }
+
+    @Override
+    public void initialize() {
+        coralElevator.lower();
+    }
+
+    @Override
+    public void execute() {
+    }
+
+    @Override
+    public void end(boolean interrupted) {
+        super.end(interrupted);
+    }
+
+    @Override
+    public boolean isFinished() {
+        return coralElevator.isLowered();
+    }
+
+
+}

src/main/java/frc/robot/commands/RaiseCoralElevator.java

@@ -0,0 +1,35 @@
+package frc.robot.commands;
+
+import edu.wpi.first.wpilibj2.command.Command;
+import frc.robot.subsystems.CoralElevator;
+
+public class RaiseCoralElevator extends Command {
+
+    private CoralElevator coralElevator;
+
+    public RaiseCoralElevator(CoralElevator coralElevator) {
+        this.coralElevator = coralElevator;
+
+        addRequirements(coralElevator);
+    }
+
+    @Override
+    public void initialize() {
+        coralElevator.raise();
+    }
+
+    @Override
+    public void execute() {
+    }
+
+    @Override
+    public void end(boolean interrupted) {
+        super.end(interrupted);
+    }
+
+    @Override
+    public boolean isFinished() {
+        return coralElevator.isRaised();
+    }
+
+}

src/main/java/frc/robot/subsystems/CoralElevator.java

@@ -0,0 +1,53 @@
+package frc.robot.subsystems;
+
+import edu.wpi.first.wpilibj.DigitalInput;
+import edu.wpi.first.wpilibj.DoubleSolenoid;
+import edu.wpi.first.wpilibj.PneumaticsModuleType;
+import edu.wpi.first.wpilibj.Solenoid;
+import edu.wpi.first.wpilibj2.command.SubsystemBase;
+import frc.robot.RobotMap;
+
+public class CoralElevator extends SubsystemBase {
+
+    private DoubleSolenoid piston1;
+    private DoubleSolenoid piston2;
+    private DigitalInput UpperLimitSwitch;
+    private DigitalInput LowerLimitSwitch;
+
+    public CoralElevator() {
+        piston1 = new DoubleSolenoid(PneumaticsModuleType.REVPH, RobotMap.PISTON_FORWARD_CHANNEL, RobotMap.PISTON_REVERSE_CHANNEL);
+        piston2 = new DoubleSolenoid(PneumaticsModuleType.REVPH, RobotMap.PISTON_FORWARD_CHANNEL, RobotMap.PISTON_REVERSE_CHANNEL);
+        UpperLimitSwitch = new DigitalInput(1);
+        LowerLimitSwitch = new DigitalInput(2);
+    }
+
+    public boolean isRaised() {
+        return !UpperLimitSwitch.get();
+    }
+
+    public boolean isLowered() {
+        return !LowerLimitSwitch.get();
+    }
+
+    public void raise() {
+        piston1.set(DoubleSolenoid.Value.kForward);
+        piston2.set(DoubleSolenoid.Value.kForward);
+    }
+
+    public void lower() {
+        piston1.set(DoubleSolenoid.Value.kReverse);
+        piston2.set(DoubleSolenoid.Value.kReverse);
+    }
+
+    public void stop() {
+        piston1.set(DoubleSolenoid.Value.kOff);
+        piston2.set(DoubleSolenoid.Value.kOff);
+    }
+
+
+    @Override
+    public void periodic() {
+        System.out.println("Elevator Raised: " + isRaised());
+        System.out.println("Elevator Lowered: " + isLowered());
+    }
+}