From 172ae1cc2182b7b41e029dc8a861df124577b95c Mon Sep 17 00:00:00 2001 From: Titan Robotics Club Date: Sat, 24 Aug 2024 03:47:50 -0700 Subject: [PATCH] Sync'd with FRC. --- TeamCode/src/main/java/teamcode/Robot.java | 7 +++---- 1 file changed, 3 insertions(+), 4 deletions(-) diff --git a/TeamCode/src/main/java/teamcode/Robot.java b/TeamCode/src/main/java/teamcode/Robot.java index 95db4a1..b19c07e 100644 --- a/TeamCode/src/main/java/teamcode/Robot.java +++ b/TeamCode/src/main/java/teamcode/Robot.java @@ -46,7 +46,6 @@ import trclib.timer.TrcTimer; public class Robot { private static final String moduleName = Robot.class.getSimpleName(); - private static final double STATUS_UPDATE_INTERVAL = 0.1; // 100 msec // Global objects. public final FtcOpMode opMode; public final TrcDbgTrace globalTracer; @@ -255,11 +254,11 @@ public class Robot */ public void updateStatus() { - if (TrcTimer.getCurrentTime() > nextStatusUpdateTime) + double currTime = TrcTimer.getCurrentTime(); + if (currTime > nextStatusUpdateTime) { int lineNum = 2; - - nextStatusUpdateTime += STATUS_UPDATE_INTERVAL; + nextStatusUpdateTime = currTime + RobotParams.Robot.DASHBOARD_UPDATE_INTERVAL; if (robotDrive != null) { dashboard.displayPrintf(lineNum++, "DriveBase: Pose=%s", robotDrive.driveBase.getFieldPosition());