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

Type cast remaining integer

Browse Source
This commit is contained in:
kamilritz
2020-01-13 12:21:18 +01:00
committed by Julian Kent
parent 3b581fb599
commit a37b91c96a
2 changed files with 7 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Dcm.hpp
+6 -6
View File
@@ -104,13 +104,13 @@ public:
const Type cd = c * d; const Type cd = c * d;
const Type dd = d * d; const Type dd = d * d;
dcm(0, 0) = aa + bb - cc - dd; dcm(0, 0) = aa + bb - cc - dd;
dcm(0, 1) = 2 * (bc - ad); dcm(0, 1) = Type(2) * (bc - ad);
dcm(0, 2) = 2 * (ac + bd); dcm(0, 2) = Type(2) * (ac + bd);
dcm(1, 0) = 2 * (bc + ad); dcm(1, 0) = Type(2) * (bc + ad);
dcm(1, 1) = aa - bb + cc - dd; dcm(1, 1) = aa - bb + cc - dd;
dcm(1, 2) = 2 * (cd - ab); dcm(1, 2) = Type(2) * (cd - ab);
dcm(2, 0) = 2 * (bd - ac); dcm(2, 0) = Type(2) * (bd - ac);
dcm(2, 1) = 2 * (ab + cd); dcm(2, 1) = Type(2) * (ab + cd);
dcm(2, 2) = aa - bb - cc + dd; dcm(2, 2) = aa - bb - cc + dd;
} }
matrix/Quaternion.hpp
+1 -1
View File
@@ -436,7 +436,7 @@ public:
if (theta < Type(1e-10)) { if (theta < Type(1e-10)) {
q(0) = Type(1); q(0) = Type(1);
q(1) = q(2) = q(3) = 0; q(1) = q(2) = q(3) = Type(0);
return; return;
} }