diff --git a/wpimath/src/main/java/edu/wpi/first/wpilibj/system/LinearSystemLoop.java b/wpimath/src/main/java/edu/wpi/first/wpilibj/system/LinearSystemLoop.java index 92357b39e0..f972dec170 100644 --- a/wpimath/src/main/java/edu/wpi/first/wpilibj/system/LinearSystemLoop.java +++ b/wpimath/src/main/java/edu/wpi/first/wpilibj/system/LinearSystemLoop.java @@ -131,7 +131,7 @@ public class LinearSystemLoop(new SimpleMatrix(controller.getK().getNumCols(), 0)); + m_nextR = new Matrix<>(new SimpleMatrix(controller.getK().getNumCols(), 1)); reset(m_nextR); }