TimeCrafters/FTC_2022
1
0
Fork 0
mirror of https://github.com/TimeCrafters/FTC_2022 synced 2025-12-16 04:12:34 +00:00
Code Issues Packages Projects Releases Wiki Activity

Debug and fail-safe

Browse Source
This commit is contained in:
Sodi
2023-01-10 20:35:58 -06:00
parent fb977cba3f
commit 0417af2488
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
TeamCode/src/main/java/org/timecrafters/TeleOp/states/PhoenixTeleOPState.java
View File

@@ -308,7 +308,7 @@ public class PhoenixTeleOPState extends CyberarmState {
if (engine.gamepad2.right_bumper) { if (engine.gamepad2.right_bumper) {
OCD = 0; 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) { if (System.currentTimeMillis() - lastStepTime >= 120) {
lastStepTime = System.currentTimeMillis(); lastStepTime = System.currentTimeMillis();
robot.HighRiserLeft.setPosition(robot.HighRiserLeft.getPosition() + 0.05); robot.HighRiserLeft.setPosition(robot.HighRiserLeft.getPosition() + 0.05);