X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2FClampBar.java;h=90f9c7e6ed6d399e0df01533a7ad7eb40494f189;hb=a1989c116a0926b44d6f36067e84b7f5fb2d313f;hp=f571619cdeeedaf79b05fdde26d10d301db25604;hpb=5585bd3152a10ee382cf7d1fc6b75299f96689a7;p=3501%2Fstronghold-2016

diff --git a/src/org/usfirst/frc/team3501/robot/commands/ClampBar.java b/src/org/usfirst/frc/team3501/robot/commands/ClampBar.java
index f571619c..90f9c7e6 100755
--- a/src/org/usfirst/frc/team3501/robot/commands/ClampBar.java
+++ b/src/org/usfirst/frc/team3501/robot/commands/ClampBar.java
@@ -1,30 +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 ClampBar extends Command {
-
-	public ClampBar() {
-	}
-
-	@Override
-	protected void initialize() {
-	}
-
-	@Override
-	protected void execute() {
-	}
-
-	@Override
-	protected boolean isFinished() {
-		return false;
-	}
-
-	@Override
-	protected void end() {
-	}
-
-	@Override
-	protected void interrupted() {
-	}
+  private double secondsToClamp = 2.0; // seconds for the winch to run in order
+                                       // for it to clamp(requires testing)
+  private double winchSpeed = 0.5; // requires testing
+
+  public ClampBar() {
+  }
+
+  @Override
+  protected void initialize() {
+    setTimeout(secondsToClamp);
+    Robot.scaler.runWinch(winchSpeed);
+  }
+
+  @Override
+  protected void execute() {
+  }
+
+  @Override
+  protected boolean isFinished() {
+    return isTimedOut();
+  }
+
+  @Override
+  protected void end() {
+    Robot.scaler.runWinch(0);
+  }
+
+  @Override
+  protected void interrupted() {
+    end();
+  }
 }