Make everything use our Subsystem class, improve LED controller

This commit is contained in:
Michael Mikovsky
2025-02-28 14:21:32 -07:00
parent dc8a80fc46
commit 870dfa2e67
9 changed files with 90 additions and 19 deletions
@@ -36,6 +36,7 @@ import frc4388.robot.Constants.FieldConstants;
import frc4388.robot.Constants.VisionConstants;
import frc4388.utility.Status;
import frc4388.utility.Subsystem;
import frc4388.utility.Status.ReportLevel;
public class Vision extends Subsystem {
@@ -311,6 +312,17 @@ public class Vision extends Subsystem {
public Status diagnosticStatus() {
Status status = new Status();
if(cameras[0].isConnected())
status.addReport(ReportLevel.INFO, "Left Camera Connected");
else
status.addReport(ReportLevel.ERROR, "Left Camera DISCONNECTED");
if(cameras[1].isConnected())
status.addReport(ReportLevel.INFO, "Right Camera Connected");
else
status.addReport(ReportLevel.ERROR, "Right Camera DISCONNECTED");
return status;
}