[commands] CommandScheduler: Provide function to print watchdog epochs (#6582)

wpilibNewCommands/src/main/native/cpp/frc2/command/CommandScheduler.cpp

@@ -428,6 +428,10 @@ void CommandScheduler::Enable() {
   m_impl->disabled = false;
 }
 
+void CommandScheduler::PrintWatchdogEpochs() {
+  m_watchdog.PrintEpochs();
+}
+
 void CommandScheduler::OnCommandInitialize(Action action) {
   m_impl->initActions.emplace_back(std::move(action));
 }

wpilibNewCommands/src/main/native/include/frc2/command/CommandScheduler.h

@@ -333,6 +333,11 @@ class CommandScheduler final : public wpi::Sendable,
    */
   void Enable();
 
+  /**
+   * Prints list of epochs added so far and their times.
+   */
+  void PrintWatchdogEpochs();
+
   /**
    * Adds an action to perform on the initialization of any command by the
    * scheduler.