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