From b5c09718a07a2fcc99f7fd9eadff0ea2702e3b99 Mon Sep 17 00:00:00 2001 From: Alvin Zhang <41vin2h4n9@gmail.com> Date: Tue, 9 Jan 2024 10:10:47 -0800 Subject: [PATCH] fix: actually check navx connection --- .../org/team1540/robot2024/subsystems/drive/GyroIONavx.java | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/src/main/java/org/team1540/robot2024/subsystems/drive/GyroIONavx.java b/src/main/java/org/team1540/robot2024/subsystems/drive/GyroIONavx.java index 44ac9d2e..43b8d6c8 100644 --- a/src/main/java/org/team1540/robot2024/subsystems/drive/GyroIONavx.java +++ b/src/main/java/org/team1540/robot2024/subsystems/drive/GyroIONavx.java @@ -19,7 +19,7 @@ public void updateInputs(GyroIOInputs inputs) { double lastTime = inputs.time; Rotation2d angle = navx.getRotation2d(); inputs.time = Timer.getFPGATimestamp(); - inputs.connected = true; + inputs.connected = navx.isConnected(); inputs.yawPosition = angle; inputs.yawVelocityRadPerSec = (angle.minus(lastAngle).getRadians())/(inputs.time - lastTime); lastAngle = angle;