removed unnecessaey code

grt192 · Feb 2, 2024 · de020f6 · de020f6
1 parent 7588e91
commit de020f6
Showing 1 changed file with 5 additions and 19 deletions.
diff --git a/src/main/java/frc/robot/subsystems/elevator/ElevatorSubsystem.java b/src/main/java/frc/robot/subsystems/elevator/ElevatorSubsystem.java
@@ -22,11 +22,9 @@
 import edu.wpi.first.networktables.NetworkTableEntry;
 import edu.wpi.first.networktables.NetworkTableEvent.Kind;
 
-import edu.wpi.first.wpilibj.XboxController;
 import edu.wpi.first.wpilibj2.command.SubsystemBase;
 
 import frc.robot.Constants.ElevatorConstants;
-import frc.robot.Constants.ElevatorConstants.*;
 
 public class ElevatorSubsystem extends SubsystemBase{
     private NetworkTableInstance elevatorNetworkTableInstance;
@@ -72,8 +70,8 @@ public ElevatorSubsystem() {
                 this.setTargetState(ElevatorState.GROUND);
             }
             else if(message.equals("SPEAKER")){
-                System.out.println("Setting Target to SPEAKER");
-                this.setTargetState(ElevatorState.SPEAKER);
+                System.out.println("Setting Target to TRAP");
+                this.setTargetState(ElevatorState.TRAP);
             }
             else if(message.equals("AMP")){
                 System.out.println("Setting Target to AMP");
@@ -87,8 +85,8 @@ else if(message.equals("AMP")){
             else if(currentTargetState.equals(ElevatorState.GROUND)){
                 System.out.println("New target state is GROUND!");
             }
-            else if(currentTargetState.equals(ElevatorState.SPEAKER)){
-                System.out.println("New target state is SPEAKER!");
+            else if(currentTargetState.equals(ElevatorState.TRAP)){
+                System.out.println("New target state is TRAP!");
             }
         });
         //this entry is working!
@@ -135,13 +133,6 @@ public void periodic(){
 
         //extensionMotor.enableSoftLimit(SoftLimitDirection.kReverse, true);
         //this through overun when no motor connected.
-
-        //Start move to target posision
-        if (targetState != state){
-
-        }
-
-
     }
 
     public boolean atState(ElevatorState state){
@@ -188,9 +179,4 @@ public ElevatorState getTargetState(){
     public void setManualPower(double power){
         this.manualPower = power;
     } 
-
-    /* private void acceptNewPosition(NetworkTable table, String key, NetworkTableEvent event){
-        System.out.println("got networktablex");
-        System.out.println(event.valueData.toString());
-    } */
-}
+}