We added teleop methods
This commit is contained in:
@ -45,6 +45,10 @@ public class ArmSubsystem {
|
|||||||
arm.setPosition(armFloor);
|
arm.setPosition(armFloor);
|
||||||
setState(ArmState.FLOOR);
|
setState(ArmState.FLOOR);
|
||||||
}
|
}
|
||||||
|
public void toFloorPositionTeleOp() {
|
||||||
|
arm.setPosition(.68);
|
||||||
|
setState(ArmState.FLOOR);
|
||||||
|
}
|
||||||
|
|
||||||
public void toBucketPosition() {
|
public void toBucketPosition() {
|
||||||
arm.setPosition(armBucket);
|
arm.setPosition(armBucket);
|
||||||
|
@ -64,6 +64,11 @@ public class WristSubsystem {
|
|||||||
wrist.setPosition(wristFloor);
|
wrist.setPosition(wristFloor);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
public void toFloorPositionTeleop() {
|
||||||
|
setState(WristState.FLOOR);
|
||||||
|
wrist.setPosition(.425);
|
||||||
|
}
|
||||||
|
|
||||||
public void toBucketPosition() {
|
public void toBucketPosition() {
|
||||||
setState(WristState.BUCKET);
|
setState(WristState.BUCKET);
|
||||||
wrist.setPosition(wristBucket);
|
wrist.setPosition(wristBucket);
|
||||||
|
Reference in New Issue
Block a user