From 56bcef5c2289570963f693a59c77e5c40b72d813 Mon Sep 17 00:00:00 2001 From: CKK Date: Fri, 1 Dec 2023 18:17:06 +0700 Subject: [PATCH] #4 --- .../java/org/firstinspires/ftc/teamcode/Robot.java | 2 +- .../org/firstinspires/ftc/teamcode/Teleop/Tele.java | 12 ++++++------ 2 files changed, 7 insertions(+), 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 index 56684ff4168..1f9a2061424 100644 --- 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 index 1eaaac27fb7..43c47ed2f59 100644 --- 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());