fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-03 01:51:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

Add cholesky decomp, Closes #30, and dynamic print buf

Browse Source
This commit is contained in:
James Goppert
2017-02-03 17:54:16 -05:00
parent a154e14439
commit 63aea23f9e
12 changed files with 165 additions and 64 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/helper_functions.hpp
+5 -5
View File
@@ -29,13 +29,13 @@ Type wrap_pi(Type x)
return x;
}
while (x >= (Type)M_PI) {
x -= (Type)(2.0 * M_PI);
while (x >= Type(M_PI)) {
x -= Type(2.0 * M_PI);
}
while (x < (Type)(-M_PI)) {
x += (Type)(2.0 * M_PI);
while (x < Type(-M_PI)) {
x += Type(2.0 * M_PI);
}
@@ -43,4 +43,4 @@ Type wrap_pi(Type x)
}
};
}