[commands] Reset timer in quasistatic SysIdRoutine test (wpilibsuite#…

…6322)
KangarooKoala · Jan 28, 2024 · ee15cc1 · ee15cc1
1 parent 1016e95
commit ee15cc1
Show file tree

Hide file tree

Showing 2 changed files with 2 additions and 6 deletions.
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
@@ -226,7 +226,7 @@ public Command quasistatic(Direction direction) {
     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
@@ -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] {