From 0417af248814be342ecc8c8f9a4628ccb7546986 Mon Sep 17 00:00:00 2001 From: Sodi Date: Tue, 10 Jan 2023 20:35:58 -0600 Subject: [PATCH] Debug and fail-safe --- .../java/org/timecrafters/TeleOp/states/PhoenixTeleOPState.java | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/TeamCode/src/main/java/org/timecrafters/TeleOp/states/PhoenixTeleOPState.java b/TeamCode/src/main/java/org/timecrafters/TeleOp/states/PhoenixTeleOPState.java index 192c4c1..4864041 100644 --- a/TeamCode/src/main/java/org/timecrafters/TeleOp/states/PhoenixTeleOPState.java +++ b/TeamCode/src/main/java/org/timecrafters/TeleOp/states/PhoenixTeleOPState.java @@ -308,7 +308,7 @@ public class PhoenixTeleOPState extends CyberarmState { if (engine.gamepad2.right_bumper) { OCD = 0; - if (robot.HighRiserLeft.getPosition() < 1.0 - Math.abs(topServoOffset)) { + if (robot.HighRiserLeft.getPosition() < 0.9 - Math.abs(topServoOffset)) { if (System.currentTimeMillis() - lastStepTime >= 120) { lastStepTime = System.currentTimeMillis(); robot.HighRiserLeft.setPosition(robot.HighRiserLeft.getPosition() + 0.05);