fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-02 05:04:08 +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:12:55 +01:00 committed by Julian Kent
parent 3b581fb599
commit a37b91c96a
2 changed files with 7 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
matrix/Dcm.hpp
View File

@ -104,13 +104,13 @@ public:
const Type cd = c * d;
const Type dd = d * d;
dcm(0, 0) = aa + bb - cc - dd;
dcm(0, 1) = 2 * (bc - ad);
dcm(0, 2) = 2 * (ac + bd);
dcm(1, 0) = 2 * (bc + ad);
dcm(0, 1) = Type(2) * (bc - ad);
dcm(0, 2) = Type(2) * (ac + bd);
dcm(1, 0) = Type(2) * (bc + ad);
dcm(1, 1) = aa - bb + cc - dd;
dcm(1, 2) = 2 * (cd - ab);
dcm(2, 0) = 2 * (bd - ac);
dcm(2, 1) = 2 * (ab + cd);
dcm(1, 2) = Type(2) * (cd - ab);
dcm(2, 0) = Type(2) * (bd - ac);
dcm(2, 1) = Type(2) * (ab + cd);
dcm(2, 2) = aa - bb - cc + dd;
}

2
matrix/Quaternion.hpp
View File

@ -436,7 +436,7 @@ public:
if (theta < Type(1e-10)) {
q(0) = Type(1);
q(1) = q(2) = q(3) = 0;
q(1) = q(2) = q(3) = Type(0);
return;
}