mirror of
https://github.com/TimeCrafters/FTC_2022
synced 2025-12-15 21:22:33 +00:00
Debug and fail-safe
This commit is contained in:
@@ -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);
|
||||
|
||||
Reference in New Issue
Block a user