fix: actually check navx connection

flamingchickens1540 · Jan 9, 2024 · b5c0971 · b5c0971
1 parent dfa6ce2
commit b5c0971
Showing 1 changed file with 1 addition and 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
@@ -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;