This commit is contained in:
2025-11-30 19:22:25 -06:00
parent 8686b79314
commit 0c3fd6fc83

View File

@@ -33,15 +33,13 @@ public class TeleopV2 extends LinearOpMode {
List<Boolean> s1 = new ArrayList<>(); List<Boolean> s1 = new ArrayList<>();
List<Boolean> s2 = new ArrayList<>(); List<Boolean> s2 = new ArrayList<>();
List<Boolean> s3 = new ArrayList<>(); List<Boolean> s3 = new ArrayList<>();
double desiredTurretAngle = 180;
MecanumDrive drive = new MecanumDrive(hardwareMap, teleStart);
private double lastEncoderRevolutions = 0.0; private double lastEncoderRevolutions = 0.0;
private double lastTimeStamp = 0.0; private double lastTimeStamp = 0.0;
private double velo1, velo; private double velo1, velo;
private double stamp1, stamp, initPos; private double stamp1, stamp, initPos;
private boolean shootAll = false; private boolean shootAll = false;
double desiredTurretAngle = 180;
MecanumDrive drive = new MecanumDrive(hardwareMap, teleStart);
@Override @Override
public void runOpMode() throws InterruptedException { public void runOpMode() throws InterruptedException {
@@ -208,17 +206,14 @@ public class TeleopV2 extends LinearOpMode {
//TODO: ADD CODE TO CHANGE VARIABLE HOOD ANGLE BASED ON POSITION //TODO: ADD CODE TO CHANGE VARIABLE HOOD ANGLE BASED ON POSITION
//SHOOT ALL: //SHOOT ALL:
if (gamepad2.rightBumperWasPressed()){ if (gamepad2.rightBumperWasPressed()) {
shootAll = true; shootAll = true;
} }
if (shootAll){ if (shootAll) {
intake = false; intake = false;
reject = false; reject = false;
} }
@@ -227,7 +222,6 @@ public class TeleopV2 extends LinearOpMode {
drive.updatePoseEstimate(); drive.updatePoseEstimate();
for (LynxModule hub : allHubs) { for (LynxModule hub : allHubs) {
hub.clearBulkCache(); hub.clearBulkCache();
} }