Add lights color to smartdashboard

Author: dfang314

Robot2019/src/main/java/frc/robot/subsystems/Lights.java

@@ -9,6 +9,7 @@
 
 import edu.wpi.first.wpilibj.VictorSP;
 import edu.wpi.first.wpilibj.command.Subsystem;
+import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
 import frc.robot.commands.SetLight;
 
 /**
@@ -30,6 +31,15 @@ public Lights(VictorSP lights) {
 
   public void setLights() {
     lights.set(lightsValue);
+    String color;
+    if (lightsValue == 0) {
+      color = "None";
+    } else if (lightsValue == 0.5) {
+      color = "Yellow";
+    } else {
+      color = "Orange";
+    }
+    SmartDashboard.putString("Lights Current Color", color);
   }
 
   public void toggleLights() {