add hella auton

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

diff --git a/src/org/usfirst/frc/team3501/robot/autons/ContainerOverStep.java b/src/org/usfirst/frc/team3501/robot/autons/ContainerOverStep.java
new file mode 100644 (file)
index 0000000..75e592b
--- /dev/null
+++ b/src/org/usfirst/frc/team3501/robot/autons/ContainerOverStep.java
@@ -0,0 +1,23 @@
+package org.usfirst.frc.team3501.robot.autons;
+
+import org.usfirst.frc.team3501.robot.Robot;
+
+import edu.wpi.first.wpilibj.command.CommandGroup;
+
+public class ContainerOverStep extends CommandGroup {
+
+    public ContainerOverStep() {
+        super("ContainerOverStep");
+
+        requires(Robot.drivetrain);
+        requires(Robot.arm);
+        requires(Robot.claw);
+
+        queueCommands();
+    }
+
+    private void queueCommands() {
+        addSequential(new PickUpContainer());
+        addSequential(new DriveOverStep(-1));
+    }
+}