add hella auton

[3501/3501-spark-go] / src / org / usfirst / frc / team3501 / robot / autons / PickUpContainer.java

diff --git a/src/org/usfirst/frc/team3501/robot/autons/PickUpContainer.java b/src/org/usfirst/frc/team3501/robot/autons/PickUpContainer.java
new file mode 100644 (file)
index 0000000..9b08d1f
--- /dev/null
+++ b/src/org/usfirst/frc/team3501/robot/autons/PickUpContainer.java
@@ -0,0 +1,20 @@
+package org.usfirst.frc.team3501.robot.autons;
+
+import org.usfirst.frc.team3501.robot.RobotMap;
+import org.usfirst.frc.team3501.robot.commands.*;
+
+import edu.wpi.first.wpilibj.command.CommandGroup;
+
+public class PickUpContainer extends CommandGroup {
+
+    public PickUpContainer() {
+        super("PickUpContainer");
+
+        queueCommands();
+    }
+
+    private void queueCommands() {
+        addSequential(new CloseClaw());
+        addSequential(new MoveArmFor(RobotMap.PICKUP_TIME, RobotMap.PICKUP_SPEED));
+    }
+}