added LED

This commit is contained in:
wildercayden 2025-10-21 18:54:32 -04:00
parent f466c54a1d
commit e6e16b891e
4 changed files with 143 additions and 10 deletions

View File

@ -2,5 +2,5 @@
"enableCppIntellisense": false, "enableCppIntellisense": false,
"currentLanguage": "java", "currentLanguage": "java",
"projectYear": "2025", "projectYear": "2025",
"teamNumber": 2648 "teamNumber": 9998
} }

92
simgui-ds.json Normal file
View File

@ -0,0 +1,92 @@
{
"keyboardJoysticks": [
{
"axisConfig": [
{
"decKey": 65,
"incKey": 68
},
{
"decKey": 87,
"incKey": 83
},
{
"decKey": 69,
"decayRate": 0.0,
"incKey": 82,
"keyRate": 0.009999999776482582
}
],
"axisCount": 3,
"buttonCount": 4,
"buttonKeys": [
90,
88,
67,
86
],
"povConfig": [
{
"key0": 328,
"key135": 323,
"key180": 322,
"key225": 321,
"key270": 324,
"key315": 327,
"key45": 329,
"key90": 326
}
],
"povCount": 1
},
{
"axisConfig": [
{
"decKey": 74,
"incKey": 76
},
{
"decKey": 73,
"incKey": 75
}
],
"axisCount": 2,
"buttonCount": 4,
"buttonKeys": [
77,
44,
46,
47
],
"povCount": 0
},
{
"axisConfig": [
{
"decKey": 263,
"incKey": 262
},
{
"decKey": 265,
"incKey": 264
}
],
"axisCount": 2,
"buttonCount": 6,
"buttonKeys": [
260,
268,
266,
261,
269,
267
],
"povCount": 0
},
{
"axisCount": 0,
"buttonCount": 0,
"povCount": 0
}
]
}

View File

@ -4,6 +4,8 @@
package frc.robot; package frc.robot;
import static edu.wpi.first.units.Units.Second;
import com.ctre.phoenix.motorcontrol.can.WPI_TalonSRX; import com.ctre.phoenix.motorcontrol.can.WPI_TalonSRX;
import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard; import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
@ -11,6 +13,7 @@ import edu.wpi.first.wpilibj.util.Color;
import edu.wpi.first.wpilibj2.command.Command; import edu.wpi.first.wpilibj2.command.Command;
import edu.wpi.first.wpilibj2.command.Commands; import edu.wpi.first.wpilibj2.command.Commands;
import edu.wpi.first.wpilibj2.command.RunCommand; import edu.wpi.first.wpilibj2.command.RunCommand;
import edu.wpi.first.wpilibj2.command.WaitCommand;
import edu.wpi.first.wpilibj2.command.button.CommandPS5Controller; import edu.wpi.first.wpilibj2.command.button.CommandPS5Controller;
import edu.wpi.first.wpilibj2.command.button.CommandXboxController; import edu.wpi.first.wpilibj2.command.button.CommandXboxController;
import edu.wpi.first.wpilibj2.command.button.Trigger; import edu.wpi.first.wpilibj2.command.button.Trigger;
@ -64,9 +67,15 @@ public class RobotContainer {
Trigger highFiveTrigger = new Trigger(highFive::SwitchDigitalInput); Trigger highFiveTrigger = new Trigger(highFive::SwitchDigitalInput);
highFiveTrigger.whileTrue( highFiveTrigger.onFalse(
new RunCommand(() -> leds.setAll(Color.kRed), leds) leds.blinkColorchange(Color.kGreen, Color.kRed, Color.kBlue, 0.5, 2)
.andThen(
//new WaitCommand(5),
leds.setAll(Color.kBlack)
)
); );
Shuffleboard.getTab("HighFive") Shuffleboard.getTab("HighFive")

View File

@ -37,15 +37,47 @@ public class LEDs extends SubsystemBase {
); );
} }
public Command blinkColor(Color color, double delayTime) {
return Commands.repeatingSequence(
setAll(color),
new WaitCommand(delayTime), public Command blinkColor(Color color, double delayTime, int times) {
setAll(Color.kBlack), Command sequence = Commands.none(); // start with an empty command
new WaitCommand(delayTime)
); for (int i = 0; i < times; i++) {
sequence = Commands.sequence(
sequence,
setAll(color),
new WaitCommand(delayTime),
setAll(Color.kBlack),
new WaitCommand(delayTime)
);
}
return sequence;
} }
public Command blinkColorchange(Color color, Color color2, Color color3, double delayTime, int times) {
Command sequence = Commands.none(); // start with an empty command
for (int i = 0; i < times; i++) {
sequence = Commands.sequence(
sequence,
setAll(color),
new WaitCommand(delayTime),
setAll(color2),
new WaitCommand(delayTime),
setAll(color3),
new WaitCommand(delayTime)
);
}
return sequence;
}
public Command setAll(Color color) { public Command setAll(Color color) {
return runOnce(() -> { return runOnce(() -> {
for(int i = 0; i < buffer.getLength(); i++) { for(int i = 0; i < buffer.getLength(); i++) {