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
@@ -69,11 +69,15 @@ public class Lidar extends Subsystem {
@Override
public Status diagnosticStatus() {
Status s = new Status();
if(distance == -1){
s.addReport(ReportLevel.ERROR, "LIDAR DISCONNECTED");
s.addReport(ReportLevel.ERROR, "LiDAR DISCONNECTED");
}else{
s.addReport(ReportLevel.INFO, "LIDAR CONNECTED");
s.addReport(ReportLevel.INFO, "LiDAR Connected");
}
s.addReport(ReportLevel.INFO, "LiDAR Distance: " + distance);
return s;
}