@@ -51,7 +51,8 @@ public abstract class Tail implements LoggedSubsystem {
5151 @ Log protected boolean pivotMotorOk = false ;
5252 @ Log protected boolean rollerMotorOk = false ;
5353
54- @ Log protected boolean beamTriggered = false ;
54+ @ Log
55+ public boolean beamTripped = true ;
5556
5657 @ Log protected double pivotSetpointRevs ;
5758 @ Log protected double pivotPoseRevs ;
@@ -80,6 +81,7 @@ public Command setRollerSpeedCmmd(double speed) {
8081 });
8182 }
8283
84+
8385 /** Zeroes tail pivot at current pose */
8486 public Command zeroPoseCmmd () {
8587 return this .run (
@@ -102,6 +104,12 @@ public Command runPoseZeroingCmmd() {
102104 });
103105 }
104106
107+ public Command setRollerPositionCommand (double revs ){
108+ return this .run (()-> {
109+ setRollerPosition (revs );
110+ });
111+ }
112+
105113 /** Stop all elevator motor input */
106114 public Command stopMotorInputCmmd () {
107115 return this .runOnce (() -> runPivotVolts (0.0 ));
@@ -129,7 +137,7 @@ public boolean inSetpointRange() {
129137
130138 /** Checks if both tail beambreaks are triggered */
131139 public boolean hasCoral () {
132- return beamTriggered ;
140+ return beamTripped ;
133141 }
134142
135143 /** HARDWARE METHODS */
@@ -142,6 +150,8 @@ public boolean hasCoral() {
142150 /** Run roller motor with speed request */
143151 protected abstract void runRollerSpeed (double speed );
144152
153+ protected abstract void setRollerPosition (double revs );
154+
145155 /** Reset encoder to specific pose in rads */
146156 protected abstract void setEncoderPose (double poseRevs );
147157
0 commit comments