X-Git-Url: http://challenge-bot.com/repos/?p=3501%2Fstronghold-2016;a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fauton%2FAlignToScore.java;h=6d0b9ede6cc1b0688cf466af57967bdd717cebe3;hp=f2c577ced14c79e9bd1888f9b32b173d26de1169;hb=600a1a1c0e90c03a198c6036de8e5157b7f96af3;hpb=9728080f491e9fb09795494349dba1297f447c0f diff --git a/src/org/usfirst/frc/team3501/robot/commands/auton/AlignToScore.java b/src/org/usfirst/frc/team3501/robot/commands/auton/AlignToScore.java index f2c577ce..6d0b9ede 100644 --- a/src/org/usfirst/frc/team3501/robot/commands/auton/AlignToScore.java +++ b/src/org/usfirst/frc/team3501/robot/commands/auton/AlignToScore.java @@ -39,7 +39,7 @@ public class AlignToScore extends CommandGroup { public double horizontalDistToGoal; public AlignToScore(int position) { - if (Constants.DeadReckoning.isUsingTimeToPassDefense) { + if (Constants.Auton.isUsingTimeToPassDefense) { if (position == 1) { addSequential(new DriveForTime(Constants.Auton.POS1_DIST1_TIME, Constants.Auton.POS1_DRIVE_MAXSPEED)); @@ -146,7 +146,7 @@ public class AlignToScore extends CommandGroup { * double horizontalDistToGoal) { * double leftDist = Robot.driveTrain.getLeftLidarDistance(); * double rightDist = Robot.driveTrain.getRightLidarDistance(); - * + * * double errorAngle = Math.atan(Math.abs(leftDist - rightDist) / 2); * double distToTower; * // TODO: figure out if we do want to shoot into the side goal if we are @@ -156,7 +156,7 @@ public class AlignToScore extends CommandGroup { * .cos(CENTER_OF_MASS_TO_ROBOT_FRONT + (leftDist - rightDist) / 2) * - DIST_CASTLE_WALL_TO_SIDE_GOAL; * } - * + * * // TODO: figure out if we do want to shoot into the font goal if we are * // in position 3, 4, 5, or if we want to change that * else { @@ -164,9 +164,9 @@ public class AlignToScore extends CommandGroup { * .cos(CENTER_OF_MASS_TO_ROBOT_FRONT + (leftDist - rightDist) / 2) * - DIST_CASTLE_WALL_TO_SIDE_GOAL; * } - * + * * double angleToTurn = Math.atan(distToTower / horizontalDistToGoal); - * + * * return angleToTurn; * } */