basic climb stuff

not anything really

diff --git a/src/main/java/frc/robot/constants/IdConstants.java b/src/main/java/frc/robot/constants/IdConstants.java
index a3d0bba9efffd4eaee6a084379fcf77721cfec5d..c3e0c1fc85e73fc5d89ebf315eb9bdd51e87fadb 100644 (file)
--- a/src/main/java/frc/robot/constants/IdConstants.java
+++ b/src/main/java/frc/robot/constants/IdConstants.java
@@ -18,4 +18,8 @@ public class IdConstants {
 
     // LEDs
     public static final int CANDLE_ID = 1;
+
+    // Climb
+    public static final int LEFT_MOTOR_ID = 1; // change left and right  IDs later
+    public static final int RIGHT_MOTOR_ID = 2;
 }

diff --git a/src/main/java/frc/robot/subsystems/Climb/Climb.java b/src/main/java/frc/robot/subsystems/Climb/Climb.java
deleted file mode 100644 (file)
index e3dc992..0000000
--- a/src/main/java/frc/robot/subsystems/Climb/Climb.java
+++ /dev/null
@@ -1,5 +0,0 @@
-package frc.robot.subsystems.Climb;
-
-public class Climb {
-    
-}

diff --git a/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java b/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java
new file mode 100644 (file)
index 0000000..b641d6f
--- /dev/null
+++ b/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java
@@ -0,0 +1,28 @@
+package frc.robot.subsystems.Climb;
+
+import com.ctre.phoenix6.hardware.TalonFX;
+
+import edu.wpi.first.math.controller.PIDController;
+
+public class LinearClimb {
+    private TalonFX leftMotor;
+    private TalonFX rightMotor;
+
+    private PIDController pid = new PIDController(0.01, 0, 0);
+
+    public LinearClimb() {
+
+    }
+
+    public void periodic() {
+
+    }
+
+    public void setSetpoint(double setpoint) {
+
+    }
+
+    public void climb() {
+        
+    }
+}
\ No newline at end of file