Skip to content
This repository was archived by the owner on Jun 20, 2025. It is now read-only.

Commit 0647ed1

Browse files
committed
fix: correctly check robot rotational velocity
1 parent 577b050 commit 0647ed1

File tree

1 file changed

+1
-1
lines changed

1 file changed

+1
-1
lines changed

src/main/java/org/team1540/robot2024/util/vision/VisionPoseAcceptor.java

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -31,7 +31,7 @@ public boolean shouldAcceptVision(TimestampedVisionPose visionPose) {
3131
if (visionPose.getAverageTagDistance() > MAX_ACCEPTED_AVG_TAG_DIST_METERS) return false;
3232

3333
// Do not accept poses taken when the robot has too much rotational or translational velocity
34-
boolean rotatingTooFast = robotVelocity.omegaRadiansPerSecond > MAX_ACCEPTED_ROT_SPEED_RAD_PER_SEC;
34+
boolean rotatingTooFast = Math.abs(robotVelocity.omegaRadiansPerSecond) > MAX_ACCEPTED_ROT_SPEED_RAD_PER_SEC;
3535
boolean translatingTooFast =
3636
Math.hypot(robotVelocity.vxMetersPerSecond, robotVelocity.vyMetersPerSecond)
3737
> MAX_ACCEPTED_LINEAR_SPEED_MPS;

0 commit comments

Comments
 (0)