From 4347c80de453a878b5e54ce912c5111740ec1a2a Mon Sep 17 00:00:00 2001 From: Meryem Esa Date: Wed, 10 Feb 2016 19:00:40 -0800 Subject: [PATCH] add constants and sequentials for position 2 --- .../frc/team3501/robot/commands/AlignToScore.java | 14 ++++++++++---- 1 file changed, 10 insertions(+), 4 deletions(-) diff --git a/src/org/usfirst/frc/team3501/robot/commands/AlignToScore.java b/src/org/usfirst/frc/team3501/robot/commands/AlignToScore.java index 5a137ace..8285a95c 100755 --- a/src/org/usfirst/frc/team3501/robot/commands/AlignToScore.java +++ b/src/org/usfirst/frc/team3501/robot/commands/AlignToScore.java @@ -23,6 +23,10 @@ public class AlignToScore extends CommandGroup { // constants for position 2 + private final double POS2_DIST1 = 0; + private final double POS2_TURN1 = 0; + private final double POS2_DIST2 = 0; + // constants for position 3 // constants for position 4 @@ -36,13 +40,15 @@ public class AlignToScore extends CommandGroup { // position 1 is always the low bar case 1: - addSequential(new DriveForDistance(POS1_DIST1, DEFAULT_SPEED)); - addSequential(new TurnForAngle(POS1_TURN1)); - addSequential(new DriveForDistance(POS1_DIST2, DEFAULT_SPEED)); + addSequential(new DriveForDistance(POS2_DIST1, DEFAULT_SPEED)); + addSequential(new TurnForAngle(POS2_TURN1)); + addSequential(new DriveForDistance(POS2_DIST2, DEFAULT_SPEED)); case 2: - addSequential(); + addSequential(new DriveForDistance(POS1_DIST1, DEFAULT_SPEED)); + addSequential(new TurnForAngle(POS1_TURN1)); + addSequential(new DriveForDistance(POS1_DIST2, DEFAULT_SPEED)); case 3: -- 2.30.2