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() {
if (currentGamepad2.dpad_up && !previousGamepad2.dpad_up) {
armParked = true;
armParked = false;
arm.toBucketPosition();
wrist.toBucketPosition();
wristPickup = false;
@ -175,15 +175,15 @@ public class CometBotTeleOpDevelopment {
if (gamepad1.x && claw.getState() == ClawSubsystem.ClawState.CLOSED) {
//now slap on bar, first wrist, then arm, then claw then driver must drive away
dualSlides.toFixedPosition(500);
dualSlides.toFixedPosition(200);
dualSlides.update();
}
if (gamepad1.y) {
arm.hangBlueberrySkyhook();
wrist.hangBlueberrySkyhook();
arm.hangBlueberrySkyhook();
try {
Thread.sleep(500);
Thread.sleep(1500);
} catch (InterruptedException 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 armPark = 0.33;
//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 wristGrabBlueberrySkyhook = 0.08;
public final static double armHangBlueberrySkyhook = 0.18;