[wpilibj] Fix incorrect robot name in reported error

Author: Gold856

wpilibj/src/main/java/edu/wpi/first/wpilibj/RobotBase.java

@@ -382,8 +382,15 @@ private static <T extends RobotBase> void runRobot(Supplier<T> robotSupplier) {
       }
       String robotName = "Unknown";
       StackTraceElement[] elements = throwable.getStackTrace();
-      if (elements.length > 0) {
-        robotName = elements[0].getClassName();
+      for (var element : elements) {
+        try {
+          if (RobotBase.class.isAssignableFrom(Class.forName(element.getClassName()))) {
+            robotName = element.getClassName();
+            break;
+          }
+        } catch (ClassNotFoundException e) {
+          // The class is in the stack trace, it better exist
+        }
       }
       DriverStation.reportError(
           "Unhandled exception instantiating robot " + robotName + " " + throwable, elements);