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));
* 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
* .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 {
* .cos(CENTER_OF_MASS_TO_ROBOT_FRONT + (leftDist - rightDist) / 2)
* - DIST_CASTLE_WALL_TO_SIDE_GOAL;
* }
- *
+ *
* double angleToTurn = Math.atan(distToTower / horizontalDistToGoal);
- *
+ *
* return angleToTurn;
* }
*/