TimeCrafters/FTC_2022
1
0
Fork 0
mirror of https://github.com/TimeCrafters/FTC_2022 synced 2025-12-13 06:22:33 +00:00
Code Issues Packages Projects Releases Wiki Activity

Fixed Move unlikely to correctly handle backward destinations, add driver feedback for co-pilot toggle.

Browse Source
This commit is contained in:
Cyberarm
2023-01-29 19:51:59 -06:00
parent 513733965a
commit 236c291275
2 changed files with 8 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/chiron/states/autonomous/Move.java
View File

@@ -79,8 +79,8 @@ public class Move extends CyberarmState {
if (Math.abs(travelledDistance) < easeInDistance) {
ratio = travelledDistance / easeInDistance;
} else if (Math.abs(travelledDistance) > targetDistance - easeOutDistance) {
ratio = (targetDistance - Math.abs(travelledDistance)) / easeOutDistance;
} else if (Math.abs(travelledDistance) > Math.abs(targetDistance) - easeOutDistance) {
ratio = (Math.abs(targetDistance) - Math.abs(travelledDistance)) / easeOutDistance;
}
ratio = Range.clip(ratio, 0.0, 1.0);

6
TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/chiron/states/teleop/ArmDriverControl.java
View File

@@ -164,6 +164,12 @@ public class ArmDriverControl extends CyberarmState {
// Swap controlling gamepad
if (gamepad == engine.gamepad2 && button.equals("guide")) {
controller = controller == engine.gamepad1 ? engine.gamepad2 : engine.gamepad1;
if (controller == engine.gamepad1) {
engine.telemetry.speak("Pilot Only");
} else {
engine.telemetry.speak("Co-Pilot Enabled");
}
}
if (gamepad != controller) {