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