Changed so it cant do bad things

This commit is contained in:
2025-02-04 10:42:39 -08:00
parent 15c561cd69
commit 9618bb7b29
2 changed files with 5 additions and 5 deletions

View File

@ -122,7 +122,7 @@ public class CometBotTeleOpDevelopment {
private void armToBucketPosition() { private void armToBucketPosition() {
if (currentGamepad2.dpad_up && !previousGamepad2.dpad_up) { if (currentGamepad2.dpad_up && !previousGamepad2.dpad_up) {
armParked = true; armParked = false;
arm.toBucketPosition(); arm.toBucketPosition();
wrist.toBucketPosition(); wrist.toBucketPosition();
wristPickup = false; wristPickup = false;
@ -175,15 +175,15 @@ public class CometBotTeleOpDevelopment {
if (gamepad1.x && claw.getState() == ClawSubsystem.ClawState.CLOSED) { if (gamepad1.x && claw.getState() == ClawSubsystem.ClawState.CLOSED) {
//now slap on bar, first wrist, then arm, then claw then driver must drive away //now slap on bar, first wrist, then arm, then claw then driver must drive away
dualSlides.toFixedPosition(500); dualSlides.toFixedPosition(200);
dualSlides.update(); dualSlides.update();
} }
if (gamepad1.y) { if (gamepad1.y) {
arm.hangBlueberrySkyhook();
wrist.hangBlueberrySkyhook(); wrist.hangBlueberrySkyhook();
arm.hangBlueberrySkyhook();
try { try {
Thread.sleep(500); Thread.sleep(1500);
} catch (InterruptedException e) { } catch (InterruptedException e) {
throw new RuntimeException(e); throw new RuntimeException(e);
} }

View File

@ -14,7 +14,7 @@ public class RobotConstants {
public final static double armReverseBucket = 0.08; public final static double armReverseBucket = 0.08;
public final static double armPark = 0.33; public final static double armPark = 0.33;
//value for grabbing the hook Specimen //value for grabbing the hook Specimen
public final static double grabBlueberry = 0.69; public final static double grabBlueberry = 0.56;
public final static double armGrabBlueberrySkyhook = 0.045; public final static double armGrabBlueberrySkyhook = 0.045;
public final static double wristGrabBlueberrySkyhook = 0.08; public final static double wristGrabBlueberrySkyhook = 0.08;
public final static double armHangBlueberrySkyhook = 0.18; public final static double armHangBlueberrySkyhook = 0.18;