diff --git a/wpimath/src/main/java/edu/wpi/first/math/controller/LinearQuadraticRegulator.java b/wpimath/src/main/java/edu/wpi/first/math/controller/LinearQuadraticRegulator.java index 7f16576bcf..190cd2a678 100644 --- a/wpimath/src/main/java/edu/wpi/first/math/controller/LinearQuadraticRegulator.java +++ b/wpimath/src/main/java/edu/wpi/first/math/controller/LinearQuadraticRegulator.java @@ -7,7 +7,6 @@ package edu.wpi.first.math.controller; import edu.wpi.first.math.Drake; import edu.wpi.first.math.MathSharedStore; import edu.wpi.first.math.Matrix; -import edu.wpi.first.math.Nat; import edu.wpi.first.math.Num; import edu.wpi.first.math.StateSpaceUtil; import edu.wpi.first.math.Vector; @@ -175,24 +174,6 @@ public class LinearQuadraticRegulator states, Nat inputs, Matrix k) { - m_K = k; - - m_r = new Matrix<>(states, Nat.N1()); - m_u = new Matrix<>(inputs, Nat.N1()); - - reset(); - } - /** * Returns the control input vector u. *