Skip to content
This repository has been archived by the owner on Jan 13, 2025. It is now read-only.

Commit

Permalink
for consideration - don't move the shoulder at the end of the climb
Browse files Browse the repository at this point in the history
  • Loading branch information
dejabot committed Mar 23, 2024
1 parent 7414ea2 commit f2ab3fc
Showing 1 changed file with 10 additions and 5 deletions.
15 changes: 10 additions & 5 deletions src/main/java/com/team766/robot/reva/BoxOpOI.java
Original file line number Diff line number Diff line change
Expand Up @@ -103,7 +103,8 @@ protected void handleOI(Context context) {
} else if (gamepad.getPOV() == 180) {
shoulder.nudgeDown();
}
} else if (moveShoulder.isFinishedTriggering()) {
} else if (moveShoulder.isFinishedTriggering()
&& !enableClimberControls.isFinishedTriggering()) {
context.releaseOwnership(shoulder);
}
}
Expand Down Expand Up @@ -132,10 +133,14 @@ protected void handleOI(Context context) {
context.releaseOwnership(climber);
climber.stop();

// restore the shoulder
context.takeOwnership(shoulder);
shoulder.rotate(85);
context.releaseOwnership(shoulder);
// if a finger slips off of the enable climber controls, it may be disruptive to move
// the shoulder
// again suddenly, esp if they intend to continue climbing.
// it may be better for the boxop to move the shoulder again manually.
// // restore the shoulder
// context.takeOwnership(shoulder);
// shoulder.rotate(85);
// context.releaseOwnership(shoulder);
}

// check to see if we should also disable the climber's soft limits
Expand Down

0 comments on commit f2ab3fc

Please sign in to comment.