mirror of
https://github.com/Team4388/2025RidgeScape.git
synced 2026-06-09 00:38:02 -06:00
Make everything use our Subsystem class, improve LED controller
This commit is contained in:
@@ -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;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user