Sync'd with FRC.

This commit is contained in:
Titan Robotics Club
2024-08-24 03:47:50 -07:00
parent 90afd02bab
commit 172ae1cc21

View File

@ -46,7 +46,6 @@ import trclib.timer.TrcTimer;
public class Robot public class Robot
{ {
private static final String moduleName = Robot.class.getSimpleName(); private static final String moduleName = Robot.class.getSimpleName();
private static final double STATUS_UPDATE_INTERVAL = 0.1; // 100 msec
// Global objects. // Global objects.
public final FtcOpMode opMode; public final FtcOpMode opMode;
public final TrcDbgTrace globalTracer; public final TrcDbgTrace globalTracer;
@ -255,11 +254,11 @@ public class Robot
*/ */
public void updateStatus() public void updateStatus()
{ {
if (TrcTimer.getCurrentTime() > nextStatusUpdateTime) double currTime = TrcTimer.getCurrentTime();
if (currTime > nextStatusUpdateTime)
{ {
int lineNum = 2; int lineNum = 2;
nextStatusUpdateTime = currTime + RobotParams.Robot.DASHBOARD_UPDATE_INTERVAL;
nextStatusUpdateTime += STATUS_UPDATE_INTERVAL;
if (robotDrive != null) if (robotDrive != null)
{ {
dashboard.displayPrintf(lineNum++, "DriveBase: Pose=%s", robotDrive.driveBase.getFieldPosition()); dashboard.displayPrintf(lineNum++, "DriveBase: Pose=%s", robotDrive.driveBase.getFieldPosition());