Improve Test Mode to check for robot faults

[allengregoryiv]

Setup automated checks of the system to see if motors are drawing too much current or no current, etc.

We could have seen that the launcher motor was licensed at Remix if we had an automated test for motors and sensors all be connected and within normal limits.

[allengregoryiv]

My guess is we add some values to the mechanism configs for the standard current draw. Then create a Test Command that runs the motor and outputs something (maybe motor beeps + prints, etc, or a Dashboard light) if the current is good. We could also flash LEDs, etc.

It would also have buttons/commands for testing the sensors, etc.

[allengregoryiv]

254 Motor Checker and TalonFXChecker classes from 1678 code - https://github.com/frc1678/C2024-Public/blob/main/src/main/java/com/team254/lib/drivers/MotorChecker.java

https://github.com/frc1678/C2024-Public/blob/main/src/main/java/com/team254/lib/drivers/TalonFXChecker.java

we should be able to use these to test motor functionality

[allengregoryiv]

TalonFX-Checker branch has this started, still needs more work