diff --git a/src/main/java/frc/robot/subsystems/CommandSwerveDrivetrain.java b/src/main/java/frc/robot/subsystems/CommandSwerveDrivetrain.java index 249042a..c901e1c 100644 --- a/src/main/java/frc/robot/subsystems/CommandSwerveDrivetrain.java +++ b/src/main/java/frc/robot/subsystems/CommandSwerveDrivetrain.java @@ -112,8 +112,10 @@ public void periodic() { new Translation3d(data[0], data[1], data[2]), new Rotation3d(data[4], data[5], data[6])); - if (reasonablePose(m_botpose)) { - addVisionMeasurement(m_botpose.toPose2d(), frc.robot.Utils.now()); + if ((int) data[7] < 2) { + if (reasonablePose(m_botpose)) { + addVisionMeasurement(m_botpose.toPose2d(), frc.robot.Utils.now()); + } } } }