From 4975e0f5ca53094ef9168983f5aae5baba0ab08a Mon Sep 17 00:00:00 2001
From: robotics3 <Chris@scds.org>
Date: Mon, 20 Jan 2025 08:51:42 -0800
Subject: [PATCH] Fixed States

---
 .../ftc/teamcode/configs/RobotConstants.java      | 15 ++++++++-------
 .../subsystem/DualMotorSliderSubsystem.java       |  4 ++--
 2 files changed, 10 insertions(+), 9 deletions(-)

diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/configs/RobotConstants.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/configs/RobotConstants.java
index 4b499f3..4f39023 100644
--- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/configs/RobotConstants.java
+++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/configs/RobotConstants.java
@@ -7,20 +7,21 @@ public class RobotConstants {
     public final static double clawClose = 0.85;
     public final static double clawOpen = 0.05;
 
-    public final static double armFloor = 0.5;
+    public final static double armFloor = 0.7;
     public final static double armSubmarine = 0.55;
-    public final static double armPark = 0.3;
+    public final static double armPark = 0.33;
     //value for grabbing the hook Specimen
     public final static double grabBlueberry = 0.3;
     public final static double armGrabBlueberrySkyhook = 0.15;
     public final static double wristGrabBlueberrySkyhook = 0.1;
     public final static double armHangBlueberrySkyhook = 0.6;
     public final static double wristHangBlueberrySkyhook = 0.3;
-    public final static double armBucket = 0.25;
-
-    public final static double wristPickup = 0.6;
-    public final static double wristBucket = 0.3;
-    public final static double wristFloor = 0.125;
+    public final static double armBucket = 0.45;
+    public final static double armInit = 0.125;
+    public final static double wristInit = 0.0;
+    public final static double wristPickup = 0.45;
+    public final static double wristBucket = 0.6;
+    public final static double wristFloor = 0.85;
 
     public final static double wristRung = 0.55;
 
diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/DualMotorSliderSubsystem.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/DualMotorSliderSubsystem.java
index e4d195f..950dbb5 100644
--- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/DualMotorSliderSubsystem.java
+++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/DualMotorSliderSubsystem.java
@@ -123,13 +123,13 @@ public class DualMotorSliderSubsystem {
     }
 
     public void toLowBucketPosition() {
-        setTargetPosition(3000);
+        setTargetPosition(2000);
     }
 
     public void toHighBucketPosition() {
         setTargetPosition(4000);
     }
 
-    public void toFloorPosotion(){setTargetPosition(5);}
+    public void toFloorPosotion(){setTargetPosition(0);}
 
 }