import frc.robot.controls.PS5ControllerDriverConfig;
import frc.robot.subsystems.Climb.LinearClimb;
import frc.robot.subsystems.Intake.Intake;
-import frc.robot.subsystems.LED.LED;
import frc.robot.subsystems.LED.LED2;
import frc.robot.subsystems.drivetrain.Drivetrain;
import frc.robot.subsystems.drivetrain.GyroIOPigeon2;
import frc.robot.constants.Constants;
import frc.robot.subsystems.Climb.LinearClimb;
import frc.robot.subsystems.Intake.Intake;
-import frc.robot.subsystems.LED.LED;
import frc.robot.subsystems.drivetrain.Drivetrain;
import frc.robot.subsystems.hood.Hood;
import frc.robot.subsystems.shooter.Shooter;
import com.ctre.phoenix6.controls.RgbFadeAnimation;
import com.ctre.phoenix6.controls.SolidColor;
import com.ctre.phoenix6.controls.StrobeAnimation;
+import com.ctre.phoenix6.controls.TorqueCurrentFOC;
import com.ctre.phoenix6.controls.TwinkleAnimation;
import com.ctre.phoenix6.hardware.CANdle;
import com.ctre.phoenix6.signals.Enable5VRailValue;
public void setTwinkle() {
candle.clearAllAnimations();
- candle.setControl(new TwinkleAnimation(8, 8 + stripLength));
+ candle.setControl(new TwinkleAnimation(8, 8 + stripLength).withColor(new RGBWColor(Color.kViolet)));
}
public void setStrobe() {
if (timeToActive.isEmpty() && timeToInactive.isEmpty()) {
return false;
- } else if (timeToActive.isPresent()) {
+ } else if (timeToActive.isPresent() && timeToActive.get() != 0) {
return (timeToActive.get() <= secs);
- } else if (timeToInactive.isPresent()) {
+ } else if (timeToInactive.isPresent() && timeToInactive.get() != 0) {
return (timeToInactive.get() <= secs);
} else {
return false;