diff --git a/wpilibNewCommands/src/main/java/edu/wpi/first/wpilibj2/command/sysid/SysIdRoutine.java b/wpilibNewCommands/src/main/java/edu/wpi/first/wpilibj2/command/sysid/SysIdRoutine.java index f0f81c861d..053a404c77 100644 --- a/wpilibNewCommands/src/main/java/edu/wpi/first/wpilibj2/command/sysid/SysIdRoutine.java +++ b/wpilibNewCommands/src/main/java/edu/wpi/first/wpilibj2/command/sysid/SysIdRoutine.java @@ -226,7 +226,7 @@ public class SysIdRoutine extends SysIdRoutineLog { Timer timer = new Timer(); return m_mechanism .m_subsystem - .runOnce(timer::start) + .runOnce(timer::restart) .andThen( m_mechanism.m_subsystem.run( () -> { diff --git a/wpilibNewCommands/src/main/native/cpp/frc2/command/sysid/SysIdRoutine.cpp b/wpilibNewCommands/src/main/native/cpp/frc2/command/sysid/SysIdRoutine.cpp index ea95db029a..359c8d824d 100644 --- a/wpilibNewCommands/src/main/native/cpp/frc2/command/sysid/SysIdRoutine.cpp +++ b/wpilibNewCommands/src/main/native/cpp/frc2/command/sysid/SysIdRoutine.cpp @@ -18,11 +18,7 @@ frc2::CommandPtr SysIdRoutine::Quasistatic(Direction direction) { double outputSign = direction == Direction::kForward ? 1.0 : -1.0; - return m_mechanism.m_subsystem - ->RunOnce([this] { - timer.Reset(); - timer.Start(); - }) + return m_mechanism.m_subsystem->RunOnce([this] { timer.Restart(); }) .AndThen( m_mechanism.m_subsystem ->Run([this, state, outputSign] {