Testing new commit stattion
This commit is contained in:
@@ -142,12 +142,7 @@ public class TeleopV3 extends LinearOpMode {
|
||||
|
||||
//DRIVETRAIN:
|
||||
|
||||
drivetrain.drive(
|
||||
-gamepad1.right_stick_y,
|
||||
gamepad1.right_stick_x,
|
||||
gamepad1.left_stick_x,
|
||||
gamepad1.left_trigger
|
||||
);
|
||||
drivetrain.drive(-gamepad1.right_stick_y, gamepad1.right_stick_x, gamepad1.left_stick_x, gamepad1.left_trigger);
|
||||
|
||||
if (gamepad1.right_bumper) {
|
||||
|
||||
@@ -182,8 +177,7 @@ public class TeleopV3 extends LinearOpMode {
|
||||
|
||||
// double distanceToGoal = Math.sqrt(dx * dx + dy * dy);
|
||||
|
||||
targetingSettings = targeting.calculateSettings
|
||||
(robotX, robotY, robotHeading, 0.0, turretInterpolate);
|
||||
targetingSettings = targeting.calculateSettings(robotX, robotY, robotHeading, 0.0, turretInterpolate);
|
||||
|
||||
//RELOCALIZATION
|
||||
|
||||
@@ -231,6 +225,7 @@ public class TeleopV3 extends LinearOpMode {
|
||||
|
||||
//HOOD:
|
||||
|
||||
|
||||
if (targetingHood) {
|
||||
servo.setHoodPos(targetingSettings.hoodAngle + autoHoodOffset);
|
||||
} else {
|
||||
@@ -267,7 +262,6 @@ public class TeleopV3 extends LinearOpMode {
|
||||
}
|
||||
|
||||
|
||||
|
||||
if (enableSpindexerManager) {
|
||||
//if (!shootAll) {
|
||||
spindexer.processIntake();
|
||||
@@ -299,7 +293,7 @@ public class TeleopV3 extends LinearOpMode {
|
||||
if (shooterTicker == 0) {
|
||||
spindexer.prepareShootAllContinous();
|
||||
//TELE.addLine("preparing to shoot");
|
||||
// } else if (shooterTicker == 2) {
|
||||
// else if (shooterTicker == 2) {
|
||||
// //servo.setTransferPos(transferServo_in);
|
||||
// spindexer.shootAll();
|
||||
// TELE.addLine("starting to shoot");
|
||||
|
||||
Reference in New Issue
Block a user