diff --git a/src/main/java/org/trigon/hardware/phoenix6/Phoenix6Inputs.java b/src/main/java/org/trigon/hardware/phoenix6/Phoenix6Inputs.java index 5d358f13..4db0b965 100644 --- a/src/main/java/org/trigon/hardware/phoenix6/Phoenix6Inputs.java +++ b/src/main/java/org/trigon/hardware/phoenix6/Phoenix6Inputs.java @@ -35,12 +35,15 @@ public void registerThreadedSignal(BaseStatusSignal statusSignal, double updateF return; registerSignal(statusSignal, updateFrequencyHertz); + statusSignal.setUpdateFrequency(50); signalToThreadedQueue.put(statusSignal.getName() + "_Threaded", signalThread.registerSignal(statusSignal)); } public void registerSignal(BaseStatusSignal statusSignal, double updateFrequencyHertz) { if (statusSignal == null || RobotHardwareStats.isReplay()) return; + if (RobotHardwareStats.isSimulation()) + updateFrequencyHertz = 100; // For some reason, simulation sometimes malfunctions if a status signal isn't updated frequently enough. statusSignal.setUpdateFrequency(updateFrequencyHertz); addSignalToSignalsArray(statusSignal);