From 1a07294ed69ebe75aaa7a1cce5691bddb48c2af5 Mon Sep 17 00:00:00 2001
From: ryan C <147014849+luenix1@users.noreply.github.com>
Date: Sat, 23 Nov 2024 22:29:49 -0800
Subject: [PATCH] Added horizontal slide and front claw

---
 .../firstinspires/ftc/teamcode/Hardware.java  | 10 +++++
 .../ftc/teamcode/MecanumTeleOp.java           | 39 +++++++++++++++++++
 2 files changed, 49 insertions(+)

diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Hardware.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Hardware.java
index c4306bb29563..c772c14cbc72 100644
--- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Hardware.java
+++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Hardware.java
@@ -91,6 +91,16 @@ public static class Locks {
     @HardwareName("wrist")
     public Servo wrist;
 
+    @HardwareName("clawFront")
+    public Servo clawFront;
+
+    @HardwareName("clawFlip")
+    public Servo clawFlip;
+
+    @HardwareName("horizontalSlide")
+    public Servo horizontalSlide;
+
+
 
     @Override
     public Encoder getLeftEncoder() { return encoderLeft; }
diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/MecanumTeleOp.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/MecanumTeleOp.java
index 091f0b779b1a..38a11258c80d 100644
--- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/MecanumTeleOp.java
+++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/MecanumTeleOp.java
@@ -23,6 +23,9 @@ public class MecanumTeleOp extends LinearOpMode {
     double Wristpos = 0.28;
     double Twistpos = 0.17;
     double VerticalSlideSpeed = 0.75;
+    double fClawClose = 0.46;
+    double fClawPos = 0;
+    double horizontalSlide = 0;
 
     @Override
     public void runOpMode() {
@@ -34,6 +37,7 @@ public void runOpMode() {
         hardware.verticalSlide.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
         hardware.verticalSlide.setTargetPosition(0);
         hardware.arm.setTargetPosition(0);
+        hardware.clawFlip.setPosition(0);
         armTargetPosDeg = 0.0;
         hardware.arm.setMode(DcMotor.RunMode.RUN_TO_POSITION);
         hardware.arm.setPower(0.2);
@@ -106,6 +110,8 @@ public void runOpMode() {
             wrist();
             servoMoves();
             twist();
+            horizontalSLide(hardware);
+            fClawTest(hardware);
             lift(hardware);
             if (gamepad2.y) {
                 ScoreHighBasket(hardware);
@@ -354,5 +360,38 @@ public void PickUpYellow(Hardware hardware){
         hardware.arm.setTargetPosition(0);
         sleep(500);
 
+/////////////////////////////////////////////////////////////////////////////////////
+    }
+    public void horizontalSLide(Hardware hardware) {
+
+        if(gamepad1.x){
+            horizontalSlide += 0.01;
+            hardware.horizontalSlide.setPosition(horizontalSlide);
+        }
+        if (gamepad1.b){
+            horizontalSlide += -0.01;
+            hardware.horizontalSlide.setPosition(horizontalSlide);
+        }
+
+        if(gamepad1.y){
+            fClawPos += .01;
+            hardware.clawFlip.setPosition(fClawPos);
+        }
+        if(gamepad1.a){
+            fClawPos += -.01;
+            hardware.clawFlip.setPosition(fClawPos);
+        }
+        telemetry.addData("horizontal slide", horizontalSlide);
+    }
+    ///////////////////////////////////////////////
+    public void fClawTest (Hardware hardware) {
+        if (gamepad1.right_bumper){
+            hardware.clawFront.setPosition(fClawClose);
+        }
+        if (gamepad1.left_bumper){
+            hardware.clawFront.setPosition(0);
+        }
+
+
     }
 }