diff --git a/src/main/java/frc/robot/constants/ElevatorConstants.java b/src/main/java/frc/robot/constants/ElevatorConstants.java
index ff08433..b805a3f 100644
--- a/src/main/java/frc/robot/constants/ElevatorConstants.java
+++ b/src/main/java/frc/robot/constants/ElevatorConstants.java
@@ -1,6 +1,32 @@
 package frc.robot.constants;
 
+import edu.wpi.first.math.trajectory.TrapezoidProfile;
+
 public class ElevatorConstants {
-    public static final int LEFT_MOTOR_PORT = 0;
-    public static final int RIGHT_MOTOR_PORT = 1;
+
+    public static final int LEFT_MOTOR_ID = 0;
+    public static final int RIGHT_MOTOR_ID = 0;
+
+    public static final double ELEVATOR_P = 0;
+    public static final double ELEVATOR_I = 0;
+    public static final double ELEVATOR_D = 0;
+    public static final double ELEVATOR_TOLERANCE = 0;
+
+    public static final double ELEVATOR_KS = 0;
+    public static final double ELEVATOR_KV = 0;
+    public static final double ELEVATOR_KG = 0;
+    public static final double ELEVATOR_KA = 0;
+
+    public static final TrapezoidProfile.Constraints CONSTRAINTS = new TrapezoidProfile.Constraints(1, 0.5);
+
+    public static final int TOP_LINEBREAK_ID = 0;
+    public static final int BOTTOM_LINEBREAK_ID = 0;
+
+    public static final double ELEVATOR_ZEROING_VOLTAGE = 0;
+
+    public static final double ROTATIONS_TO_METERS = 1;
+
+    public static final double CURRENT_MAX = 20;
+
+    public static final double HARD_STOP_LEVEL = -0.1;
 }
diff --git a/src/main/java/frc/robot/subsystems/ElevatorSubsystem.java b/src/main/java/frc/robot/subsystems/ElevatorSubsystem.java
new file mode 100644
index 0000000..1e5fa64
--- /dev/null
+++ b/src/main/java/frc/robot/subsystems/ElevatorSubsystem.java
@@ -0,0 +1,136 @@
+package frc.robot.subsystems;
+import com.revrobotics.RelativeEncoder;
+import com.revrobotics.spark.SparkBase;
+import com.revrobotics.spark.SparkFlex;
+import com.revrobotics.spark.SparkLowLevel;
+import com.revrobotics.spark.config.SparkFlexConfig;
+import edu.wpi.first.math.controller.ElevatorFeedforward;
+import edu.wpi.first.math.controller.ProfiledPIDController;
+import edu.wpi.first.wpilibj.DigitalInput;
+import edu.wpi.first.wpilibj2.command.SubsystemBase;
+import frc.robot.constants.ElevatorConstants;
+
+import java.util.function.BooleanSupplier;
+
+
+public class ElevatorSubsystem extends SubsystemBase {
+
+
+
+    //TODO Elevator move to position function
+
+    //Two neovortexes
+    private final SparkFlex leftElevatorMotor = new SparkFlex(ElevatorConstants.LEFT_MOTOR_ID, SparkLowLevel.MotorType.kBrushless);
+    private final SparkFlex rightElevatorMotor = new SparkFlex(ElevatorConstants.RIGHT_MOTOR_ID, SparkLowLevel.MotorType.kBrushless);
+
+    //Relative Encoders
+    private final RelativeEncoder leftEncoder = leftElevatorMotor.getEncoder();
+    private final RelativeEncoder rightEncoder = rightElevatorMotor.getEncoder();
+
+    //Linebreaks
+    private final DigitalInput topLineBreak = new DigitalInput(ElevatorConstants.TOP_LINEBREAK_ID);
+    private final DigitalInput bottomLineBreak = new DigitalInput(ElevatorConstants.BOTTOM_LINEBREAK_ID);
+
+    private boolean elevatorZeroed = false;
+    //Becomes true when we boot up robot and enable.
+
+    private final ProfiledPIDController elevatorPID = new ProfiledPIDController(
+            ElevatorConstants.ELEVATOR_P,
+            ElevatorConstants.ELEVATOR_I,
+            ElevatorConstants.ELEVATOR_D,
+            ElevatorConstants.CONSTRAINTS
+    );
+
+    private final ElevatorFeedforward elevatorFF = new ElevatorFeedforward(
+            ElevatorConstants.ELEVATOR_KS,
+            ElevatorConstants.ELEVATOR_KG,
+            ElevatorConstants.ELEVATOR_KV,
+            ElevatorConstants.ELEVATOR_KA
+    );
+
+    public ElevatorSubsystem() {
+        SparkFlexConfig rightElevatorMotorConfig = new SparkFlexConfig();
+        SparkFlexConfig leftElevatorMotorConfig = new SparkFlexConfig();
+
+        elevatorPID.setTolerance(ElevatorConstants.ELEVATOR_TOLERANCE);
+
+        rightElevatorMotorConfig.inverted(true);
+
+        rightElevatorMotor.configure(rightElevatorMotorConfig, SparkBase.ResetMode.kNoResetSafeParameters, SparkBase.PersistMode.kPersistParameters);
+        leftElevatorMotor.configure(leftElevatorMotorConfig, SparkBase.ResetMode.kResetSafeParameters, SparkBase.PersistMode.kPersistParameters);
+    }
+    public void moveElevator(double speed) {
+        leftElevatorMotor.set(speed);
+        rightElevatorMotor.set(speed);
+    }
+    //TODO We need to LEFT_ELEVATOR_ID do something for L1, L2, L3
+    //NO absolute encoders
+    public void setVoltage(double voltage) {
+        leftElevatorMotor.setVoltage(voltage);
+        rightElevatorMotor.setVoltage(voltage);
+        //Always set voltage for PID and FF
+    }
+
+    public void setPosition(double position) {
+        elevatorPID.setGoal(position);
+    }
+    public void resetPID() {
+        elevatorPID.reset(getElevatorPosition());
+    }
+
+    public double getElevatorPosition() {
+        double encoderAveragePos = (leftEncoder.getPosition() + rightEncoder.getPosition())/2;
+        //Calculates average pos
+        return encoderAveragePos * ElevatorConstants.ROTATIONS_TO_METERS;
+    }
+    public double getElevatorVelocity() {
+        double encoderAverageVel = (leftEncoder.getVelocity() + rightEncoder.getVelocity())/2;
+        //Calculates average pos
+        return encoderAverageVel * ElevatorConstants.ROTATIONS_TO_METERS;
+    }
+    public boolean atPosition() {
+        if (elevatorPID.atSetpoint()) {
+            return true;
+        }
+        return false;
+
+    }
+
+
+    @Override
+    public void periodic(){
+
+        if(!elevatorZeroed) {
+            if ((leftElevatorMotor.getOutputCurrent() + rightElevatorMotor.getOutputCurrent())/2 > ElevatorConstants.CURRENT_MAX){
+                elevatorZeroed = true;
+                leftEncoder.setPosition(ElevatorConstants.HARD_STOP_LEVEL);
+                rightEncoder.setPosition(ElevatorConstants.HARD_STOP_LEVEL);
+                setVoltage(0);
+            }
+            else{
+                setVoltage(ElevatorConstants.ELEVATOR_ZEROING_VOLTAGE);
+            }
+        }
+        if(bottomLineBreak.get()) {
+
+            if(!elevatorZeroed) {
+
+                leftEncoder.setPosition(0);
+                rightEncoder.setPosition(0);
+                elevatorZeroed = true;
+                setVoltage(0);
+            }
+        }
+        if(elevatorZeroed) {
+
+            double pidCalc = elevatorPID.calculate(getElevatorPosition());
+            double ffCalc = elevatorFF.calculate(getElevatorPosition());
+            setVoltage(pidCalc+ffCalc);
+
+        }
+        //Elevator zeroing
+    }
+
+
+}
+//TODO Add elevator timeout, add boolean position,