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