diff --git a/wpimath/src/main/native/include/frc/StateSpaceUtil.h b/wpimath/src/main/native/include/frc/StateSpaceUtil.h index 8c2ac65481..3aa2e75330 100644 --- a/wpimath/src/main/native/include/frc/StateSpaceUtil.h +++ b/wpimath/src/main/native/include/frc/StateSpaceUtil.h @@ -59,9 +59,7 @@ bool IsStabilizableImpl(const Matrixd& A, Eigen::EigenSolver> es{A, false}; for (int i = 0; i < A.rows(); ++i) { - if (es.eigenvalues()[i].real() * es.eigenvalues()[i].real() + - es.eigenvalues()[i].imag() * es.eigenvalues()[i].imag() < - 1) { + if (std::norm(es.eigenvalues()[i]) < 1) { continue; }