From 3627526862c4d8262f6b9b2d7e14483ee69b785a Mon Sep 17 00:00:00 2001
From: michael-lesirge <100492377+michael-lesirge@users.noreply.github.com>
Date: Thu, 28 Mar 2024 15:56:47 -0700
Subject: [PATCH] add rumble

---
 .../commands/IntakeControllerSignal.java      | 49 +++++++++++++++++++
 1 file changed, 49 insertions(+)
 create mode 100644 src/main/java/frc/robot/commands/IntakeControllerSignal.java

diff --git a/src/main/java/frc/robot/commands/IntakeControllerSignal.java b/src/main/java/frc/robot/commands/IntakeControllerSignal.java
new file mode 100644
index 0000000..ca86bc1
--- /dev/null
+++ b/src/main/java/frc/robot/commands/IntakeControllerSignal.java
@@ -0,0 +1,49 @@
+package frc.robot.commands;
+
+import java.util.function.BooleanSupplier;
+
+import edu.wpi.first.wpilibj.TimedRobot;
+import edu.wpi.first.wpilibj.XboxController;
+import edu.wpi.first.wpilibj.GenericHID.RumbleType;
+import edu.wpi.first.wpilibj2.command.Command;
+
+public class IntakeControllerSignal extends Command {
+	private final XboxController controller;
+	private final BooleanSupplier signal;
+	private final double rumbleValue;
+
+	private final double rumbleTimeMax = 0.2 / TimedRobot.kDefaultPeriod;
+	private double rumbleTime = 0;
+
+	public IntakeControllerSignal(XboxController controller, BooleanSupplier signal, double rumbleValue) {
+		this.controller = controller;
+		this.signal = signal;
+		this.rumbleValue = rumbleValue;
+	}
+
+	@Override
+	public void execute() {
+		boolean value = signal.getAsBoolean();
+
+		if (value) {
+			if (rumbleTime < rumbleTimeMax) {
+				rumbleTime++;
+				controller.setRumble(RumbleType.kBothRumble, rumbleValue);
+			}
+		}
+		else {
+			rumbleTime = 0;
+			controller.setRumble(RumbleType.kBothRumble, 0);
+		}
+	}
+
+	@Override
+	public boolean isFinished() {
+		return false;
+	}
+
+	@Override
+	public void end(boolean interrupted) {
+		controller.setRumble(RumbleType.kBothRumble, 0);
+	}
+}