add commands to run winches continuously

diff --git a/src/org/usfirst/frc/team3501/robot/commands/WinchRobotDownContinuous.java b/src/org/usfirst/frc/team3501/robot/commands/WinchRobotDownContinuous.java
new file mode 100644 (file)
index 0000000..6993527
--- /dev/null
+++ b/src/org/usfirst/frc/team3501/robot/commands/WinchRobotDownContinuous.java
@@ -0,0 +1,39 @@
+package org.usfirst.frc.team3501.robot.commands;
+
+import org.usfirst.frc.team3501.robot.Robot;
+
+import edu.wpi.first.wpilibj.command.Command;
+
+public class WinchRobotDownContinuous extends Command {
+  double winchDownSpeed;
+
+  public WinchRobotDownContinuous(double speed) {
+    winchDownSpeed = speed;
+    if (winchDownSpeed > 1)
+      winchDownSpeed = 1;
+    if (winchDownSpeed < -1)
+      winchDownSpeed = -1;
+  }
+
+  @Override
+  protected void initialize() {
+    Robot.scaler.runWinch(winchDownSpeed);
+  }
+
+  @Override
+  protected void execute() {
+  }
+
+  @Override
+  protected boolean isFinished() {
+    return true;
+  }
+
+  @Override
+  protected void end() {
+  }
+
+  @Override
+  protected void interrupted() {
+  }
+}

diff --git a/src/org/usfirst/frc/team3501/robot/commands/WinchRobotUpContinuous.java b/src/org/usfirst/frc/team3501/robot/commands/WinchRobotUpContinuous.java
new file mode 100644 (file)
index 0000000..ea35f24
--- /dev/null
+++ b/src/org/usfirst/frc/team3501/robot/commands/WinchRobotUpContinuous.java
@@ -0,0 +1,39 @@
+package org.usfirst.frc.team3501.robot.commands;
+
+import org.usfirst.frc.team3501.robot.Robot;
+
+import edu.wpi.first.wpilibj.command.Command;
+
+public class WinchRobotUpContinuous extends Command {
+  double winchUpSpeed;
+
+  public WinchRobotUpContinuous(double speed) {
+    winchUpSpeed = speed;
+    if (winchUpSpeed > 1)
+      winchUpSpeed = 1;
+    if (winchUpSpeed < -1)
+      winchUpSpeed = -1;
+  }
+
+  @Override
+  protected void initialize() {
+    Robot.scaler.runWinch(winchUpSpeed);
+  }
+
+  @Override
+  protected void execute() {
+  }
+
+  @Override
+  protected boolean isFinished() {
+    return true;
+  }
+
+  @Override
+  protected void end() {
+  }
+
+  @Override
+  protected void interrupted() {
+  }
+}