We added teleop methods

This commit is contained in:
robotics1
2025-01-28 17:09:43 -08:00
parent 90ff225bfa
commit 373dfd849a
2 changed files with 9 additions and 0 deletions

View File

@ -45,6 +45,10 @@ public class ArmSubsystem {
arm.setPosition(armFloor);
setState(ArmState.FLOOR);
}
public void toFloorPositionTeleOp() {
arm.setPosition(.68);
setState(ArmState.FLOOR);
}
public void toBucketPosition() {
arm.setPosition(armBucket);

View File

@ -64,6 +64,11 @@ public class WristSubsystem {
wrist.setPosition(wristFloor);
}
public void toFloorPositionTeleop() {
setState(WristState.FLOOR);
wrist.setPosition(.425);
}
public void toBucketPosition() {
setState(WristState.BUCKET);
wrist.setPosition(wristBucket);