Changed so it cant do bad things
This commit is contained in:
@ -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);
|
||||
}
|
||||
|
@ -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;
|
||||
|
Reference in New Issue
Block a user