Team2890/allwpilib
4
0
Fork 0
mirror of https://github.com/wpilibsuite/allwpilib synced 2026-06-23 01:21:42 +00:00
Code Issues Packages Projects Releases Wiki Activity

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

Browse Source
This commit is contained in:
Tyler Veness
2023-08-31 22:52:18 -07:00
committed by GitHub
parent 8e2465f8a0
commit a750bee54d
1 changed files with 1 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
wpimath/src/main/native/include/frc/StateSpaceUtil.h
View File

@@ -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;
}