From 5e1e9b1e608732cc9260a323af51f4d1d69a17ee Mon Sep 17 00:00:00 2001 From: Meryem Esa Date: Wed, 10 Feb 2016 18:57:48 -0800 Subject: [PATCH] add constants and sequentials for position 1: low bar --- .../team3501/robot/commands/AlignToScore.java | 20 ++++++++++++++++++- 1 file changed, 19 insertions(+), 1 deletion(-) diff --git a/src/org/usfirst/frc/team3501/robot/commands/AlignToScore.java b/src/org/usfirst/frc/team3501/robot/commands/AlignToScore.java index 0c27e908..5a137ace 100755 --- a/src/org/usfirst/frc/team3501/robot/commands/AlignToScore.java +++ b/src/org/usfirst/frc/team3501/robot/commands/AlignToScore.java @@ -14,13 +14,31 @@ import edu.wpi.first.wpilibj.command.CommandGroup; * */ public class AlignToScore extends CommandGroup { + private final double DEFAULT_SPEED = 0.5; + // constants for position 1: low bar + + private final double POS1_DIST1 = 0; + private final double POS1_TURN1 = 0; + private final double POS1_DIST2 = 0; + + // constants for position 2 + + // constants for position 3 + + // constants for position 4 + + // constants for position 5 public AlignToScore(int position) { switch (position) { + + // position 1 is always the low bar case 1: - addSequential(); + addSequential(new DriveForDistance(POS1_DIST1, DEFAULT_SPEED)); + addSequential(new TurnForAngle(POS1_TURN1)); + addSequential(new DriveForDistance(POS1_DIST2, DEFAULT_SPEED)); case 2: -- 2.30.2