big refactor of command/commandbase/commandgroup. also add auton read from file.
[3501/3501-spark-go] / src / org / usfirst / frc / team3501 / robot / autons / PickUpContainer.java
1 package org.usfirst.frc.team3501.robot.autons;
2
3 import org.usfirst.frc.team3501.robot.Robot;
4 import org.usfirst.frc.team3501.robot.commands.*;
5
6 public class PickUpContainer extends CommandGroup {
7
8 public PickUpContainer() {
9 super("PickUpContainer");
10
11 requires(Robot.arm);
12 requires(Robot.claw);
13
14 queueCommands();
15 }
16
17 private void queueCommands() {
18 addSequential(new CloseClaw());
19 addSequential(new MoveArmFor(
20 Robot.autonData.getTime("pickup_container"),
21 Robot.autonData.getSpeed("pickup_container")));
22 }
23 }