--- /dev/null
+package org.usfirst.frc.team3501.robot.commands;
+
+import edu.wpi.first.wpilibj.command.CommandGroup;
+
+/**
+ * This command group will be used in autonomous. Based on what position the
+ * robot is in, the robot will align with the goal
+ *
+ * pre-condition: robot is flush against a defense at the specified position in
+ * the opponent's courtyard
+ *
+ * post-condition: the robot is parallel to one of the three goals and the
+ * shooter is facing that goal
+ *
+ */
+public class AlignToScore extends CommandGroup {
+
+ public AlignToScore(int position) {
+
+ switch (position) {
+ case 1:
+
+ addSequential();
+
+ case 2:
+
+ addSequential();
+
+ case 3:
+
+ addSequential();
+
+ case 4:
+
+ addSequential();
+
+ case 5:
+
+ addSequential();
+ }
+ }
+}
private final double DEFAULT_SPEED = 0.5;
public PassLowBar() {
- // TODO: need to add sequential for retracting the arms and shooting hood
- // once those commands are made
+ // TODO: need to add sequential for retracting the arms and shooting hood once those commands are made
addSequential(new DriveForDistance(DISTANCE, DEFAULT_SPEED));
}