Handle case where robot enables before SysId connects (wpilibsuite#493)

Team-6615-Bellevillains · Feb 24, 2023 · f39e598 · f39e598
1 parent 8a3027e
commit f39e598
Showing 1 changed file with 6 additions and 3 deletions.
diff --git a/sysid-library/src/main/cpp/logging/SysIdLogger.cpp b/sysid-library/src/main/cpp/logging/SysIdLogger.cpp
@@ -26,9 +26,12 @@ using namespace sysid;
 
 void SysIdLogger::InitLogging() {
   m_mechanism = frc::SmartDashboard::GetString("SysIdTest", "");
-
-  if (IsWrongMechanism()) {
-    frc::SmartDashboard::PutBoolean("SysIdWrongMech", true);
+  if (m_mechanism == "") {
+    fmt::print(
+        "WARNING: Robot enabled before connecting SysId. Connect SysId, then "
+        "reenable the robot.\n");
+  } else {
+    frc::SmartDashboard::PutBoolean("SysIdWrongMech", IsWrongMechanism());
   }
 
   m_testType = frc::SmartDashboard::GetString("SysIdTestType", "");