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 56684ff41680..1f9a20614248 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 1eaaac27fb7d..43c47ed2f59f 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());