From d45187466725ee47e6579f0ec64b67e3f8509684 Mon Sep 17 00:00:00 2001
From: MannyLev <94080012+MannyLev@users.noreply.github.com>
Date: Sat, 15 Jan 2022 13:55:44 -0500
Subject: [PATCH] The addition of a color sensor

---
 src/main/java/frc/robot/RobotContainer.java   |  1 +
 .../frc/robot/subsystems/ColorSensor.java     | 32 +++++++++++++++++++
 2 files changed, 33 insertions(+)
 create mode 100644 src/main/java/frc/robot/subsystems/ColorSensor.java

diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java
index 72e6f66..c504285 100644
--- a/src/main/java/frc/robot/RobotContainer.java
+++ b/src/main/java/frc/robot/RobotContainer.java
@@ -12,6 +12,7 @@
 import edu.wpi.first.wpilibj2.command.InstantCommand;
 import edu.wpi.first.wpilibj2.command.button.JoystickButton;
 import frc.robot.subsystems.MotorBoardSubsystem;
+import frc.robot.subsystems.ColorSensor;
 
 /**
  * This class is where the bulk of the robot should be declared. Since Command-based is a
diff --git a/src/main/java/frc/robot/subsystems/ColorSensor.java b/src/main/java/frc/robot/subsystems/ColorSensor.java
new file mode 100644
index 0000000..9fe5cdf
--- /dev/null
+++ b/src/main/java/frc/robot/subsystems/ColorSensor.java
@@ -0,0 +1,32 @@
+import com.revrobotics.ColorSensorV3;
+import edu.wpi.first.wpilibj.I2C;
+import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
+import edu.wpi.first.wpilibj.util.Color;
+
+public class sensorTest {
+  private ColorSensorV3 testSensor;
+
+  public ColorSensor {
+    colorSensor = new ColorSensorV3(I2C.Port.kOnboard);
+  }
+
+  public void colorOuput {
+    SmartDashboard.putNumber("Red", colorSensor.getRed());
+    SmartDashboard.putNumber("Green", colorSensor.getGreen());
+    SmartDashboard.putNumber("Blue", colorSensor.getBlue());
+    SmartDashboard.putNumber("Color", colorSensor.getColor());
+  }
+
+  public Color getColor() {
+    return colorSensor.getColor();
+  }
+
+  public double getIR(){
+    return colorSensor.getIR();
+  }
+
+  @Override
+    public void periodic(){
+      updateValues();
+    }
+}
\ No newline at end of file