[utils] Add logStatusCode function for CTRE StatusCodes

src/main/java/frc/robot/Utils.java

@@ -4,7 +4,9 @@
 
 package frc.robot;
 
+import com.ctre.phoenix6.StatusCode;
 import edu.wpi.first.util.WPIUtilJNI;
+import edu.wpi.first.wpilibj.DataLogManager;
 
 /* Utilities used across the codebase */
 public final class Utils {
@@ -30,4 +32,19 @@ public static double now() {
   public static double deadzone(double value) {
     return (Math.abs(value) > 0.05) ? value : 0;
   }
+
+  /** A function to log CTRE {@link StatusCode}s to Datalog. */
+  public static void logStatusCode(StatusCode code) {
+    if (code.isOK()) {
+      return;
+    }
+
+    if (code.isWarning()) {
+      DataLogManager.log("Warning: " + code.getDescription());
+    }
+
+    if (code.isError()) {
+      DataLogManager.log("Error: " + code.getDescription());
+    }
+  }
 }