Skip to content

Dont crash into trench#269

Open
tomer-hershman wants to merge 17 commits into
masterfrom
dont-do-GA
Open

Dont crash into trench#269
tomer-hershman wants to merge 17 commits into
masterfrom
dont-do-GA

Conversation

@tomer-hershman

Copy link
Copy Markdown

No description provided.

Comment thread src/main/java/frc/robot/statemachine/ShootingChecks.java
Comment thread src/main/java/frc/robot/statemachine/ShootingChecks.java
Comment on lines +95 to +98
new Translation2d(
currentTurretPosition.getX() + fieldRelativeTurretVelocities.getX() * ShooterConstants.TIME_TO_CLOSE_HOOD_WITH_BUFFER_SEC,
currentTurretPosition.getY() + fieldRelativeTurretVelocities.getY() * ShooterConstants.TIME_TO_CLOSE_HOOD_WITH_BUFFER_SEC
)

Copy link
Copy Markdown

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

SRP

Comment on lines +104 to +106
boolean isTurretUnderTrench = (MathUtil
.isNear(allianceRelativeTurretPosition.getX(), allianceRelativeDepotTrenchMiddle.getX(), Field.TRENCH_BAR_X_AXIS_LENGTH_METERS * 2)
&& isTurretPositionAlignedWithTrenchOnYAxis(allianceRelativeTurretPosition));

Copy link
Copy Markdown

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

SRP

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants