[wpimath] Use std::norm() in IsStabilizable() (wpilibsuite#5599)

rzblue · Sep 1, 2023 · a750bee · a750bee
1 parent 8e2465f
commit a750bee
Showing 1 changed file with 1 addition and 3 deletions.
diff --git 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<States, States>& A,
   Eigen::EigenSolver<Matrixd<States, States>> 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;
     }