This commit is contained in:
2025-01-23 16:28:44 -08:00
parent b14e91b094
commit 90355add55

View File

@ -107,6 +107,7 @@ public class CometBotAutoDevelopment {
claw.init(); claw.init();
} }
private void hangSkyhook (){ private void hangSkyhook (){
if(currentGamepad1.right_bumper && !previousGamepad1.right_bumper){
dualSlides.toHangHeight(); dualSlides.toHangHeight();
wrist.hangBlueberrySkyhook(); wrist.hangBlueberrySkyhook();
try { try {
@ -122,6 +123,7 @@ public class CometBotAutoDevelopment {
throw new RuntimeException(e); throw new RuntimeException(e);
}claw.closeClaw(); }claw.closeClaw();
} }
}
} }
@ -137,7 +139,6 @@ public class CometBotAutoDevelopment {
} }
private void armAndWristToFloor(){ private void armAndWristToFloor(){
if(currentGamepad2.a && !previousGamepad2.a){ if(currentGamepad2.a && !previousGamepad2.a){
double increment = 0.7 - arm.getPosition(); double increment = 0.7 - arm.getPosition();
for(int i = 0; i < 3; i ++){ for(int i = 0; i < 3; i ++){
arm.setPosition(arm.getPosition() + increment); arm.setPosition(arm.getPosition() + increment);