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
{
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());