diff --git a/src/main/java/frc/robot/Constants.java b/src/main/java/frc/robot/Constants.java index 4133372..286b5c3 100644 --- a/src/main/java/frc/robot/Constants.java +++ b/src/main/java/frc/robot/Constants.java @@ -33,6 +33,8 @@ import edu.wpi.first.wpilibj.RobotBase; import frc.lib.W8.mechanisms.linear.LinearMechanism.LinearMechCharacteristics; import frc.lib.W8.mechanisms.rotary.RotaryMechanism.RotaryMechCharacteristics; +import com.ctre.phoenix6.signals.RGBWColor; +import com.ctre.phoenix6.controls.*; import frc.lib.W8.util.Device; import frc.lib.W8.util.Device.CAN; import frc.lib.W8.util.MechanismUtil.DistanceAngleConverter; @@ -61,6 +63,12 @@ public static enum Mode { REPLAY } + public class LEDConstants { + public static final RainbowAnimation rainbowAnim = new RainbowAnimation(0, 2); + public static final RGBWColor colorPaleBlue = new RGBWColor(165, 180, 208, 0); + public static final RGBWColor colorWheezerBlue = new RGBWColor(24, 155, 204, 0); + } + public class FieldConstants { /** *     Contains various field dimensions and useful reference points. All units are in meters diff --git a/src/main/java/frc/robot/subsystems/LEDs/LEDs.java b/src/main/java/frc/robot/subsystems/LEDs/LEDs.java index aba0e14..62fe690 100644 --- a/src/main/java/frc/robot/subsystems/LEDs/LEDs.java +++ b/src/main/java/frc/robot/subsystems/LEDs/LEDs.java @@ -1,15 +1,31 @@ package frc.robot.subsystems.LEDs; import edu.wpi.first.wpilibj2.command.SubsystemBase; +import frc.lib.W8.devices.Lights; import frc.lib.W8.io.lights.LightsIO; +import edu.wpi.first.wpilibj2.command.Command; + +import com.ctre.phoenix6.controls.ControlRequest; +import com.ctre.phoenix6.controls.SolidColor; +import com.ctre.phoenix6.hardware.CANdle; +import frc.robot.Constants.LEDConstants; public class LEDs extends SubsystemBase { - private final LightsIO _io; + private final LightsIO _io; + private final Lights _lights; + + public LEDs(LightsIO io, Lights lights) { + _io = io; + _lights = lights; + } - public LEDs(LightsIO io) { - _io = io; - } + public Command runAnimation() { + return this.startEnd( + () -> _lights.setAnimation(new SolidColor(0, 3).withColor(LEDConstants.colorPaleBlue)), + () -> _lights.setAnimation(new SolidColor(0, 3).withColor(LEDConstants.colorWheezerBlue)) + ); + } @Override public void periodic() {} -} +} \ No newline at end of file