s
This commit is contained in:
@@ -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,16 +206,13 @@ 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();
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user