FIRST-Tech-Challenge#4

Logical05 · Dec 1, 2023 · 56bcef5 · 56bcef5
1 parent a8b89bf
commit 56bcef5
Show file tree

Hide file tree

Showing 2 changed files with 7 additions and 7 deletions.
diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Robot.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Robot.java
@@ -95,7 +95,7 @@ public static void Initialize(IMU imu, DcMotor.RunMode moveMode,
                 RevHubOrientationOnRobot.UsbFacingDirection.RIGHT)));
 
         // Reverse Servo
-        LLL.setDirection(Servo.Direction.REVERSE);
+        LRL.setDirection(Servo.Direction.REVERSE);
         LA .setDirection(Servo.Direction.REVERSE);
         LH .setDirection(Servo.Direction.REVERSE);
         // Set Servo Position

diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Teleop/Tele.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Teleop/Tele.java
@@ -31,7 +31,7 @@ public class Tele extends LinearOpMode {
     DcMotorEx FL, FR, BL, BR, LL, RL, PU, V;
 
     /** Variables */
-    public static double setpoint = Math.toDegrees(0), PUPow = 0, liftAng = 0.96, armAng = 0, hoistAng = 0;
+    double setpoint = Math.toDegrees(0), PUPow = 0, liftAng = 0, armAng = 0, hoistAng = 0;
     boolean VPressed = false, VisBusy = false;
 
     private void Init() {
@@ -144,11 +144,11 @@ public void runOpMode() {
                 }
                 Movement();
                 Vacuum();
-//                Lift();
-//                RaiseLift();
-//                Arm();ss
-//                Hoist();
-//                PullUp();
+                Lift();
+                RaiseLift();
+                Arm();
+                Hoist();
+                PullUp();
                 telemetry.addData("setpoint",Math.toDegrees(setpoint));
                 telemetry.addData("LL", LL.getCurrentPosition());
                 telemetry.addData("RL", RL.getCurrentPosition());