diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/ArmSubsystem.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/ArmSubsystem.java index 5c4137f..8e0949a 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/ArmSubsystem.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/ArmSubsystem.java @@ -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); diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/WristSubsystem.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/WristSubsystem.java index 5ba32a0..73615d5 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/WristSubsystem.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystem/WristSubsystem.java @@ -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);