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