Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-30 04:06:33 +08:00
Code Issues Actions 9 Packages Projects Releases Wiki Activity

Quaternion multiply inline return

Browse Source
This commit is contained in:
Daniel Agar
2019-11-26 12:03:15 -05:00
parent dba84236cb
commit a8009a36a3
1 changed files with 5 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Quaternion.hpp
+5 -6
View File
@@ -255,12 +255,11 @@ public:
Quaternion operator*(const Quaternion &q) const Quaternion operator*(const Quaternion &q) const
{ {
const Quaternion &p = *this; const Quaternion &p = *this;
Quaternion r; return {
r(0) = p(0) * q(0) - p(1) * q(1) - p(2) * q(2) - p(3) * q(3); p(0) * q(0) - p(1) * q(1) - p(2) * q(2) - p(3) * q(3),
r(1) = p(0) * q(1) + p(1) * q(0) + p(2) * q(3) - p(3) * q(2); p(0) * q(1) + p(1) * q(0) + p(2) * q(3) - p(3) * q(2),
r(2) = p(0) * q(2) - p(1) * q(3) + p(2) * q(0) + p(3) * q(1); p(0) * q(2) - p(1) * q(3) + p(2) * q(0) + p(3) * q(1),
r(3) = p(0) * q(3) + p(1) * q(2) - p(2) * q(1) + p(3) * q(0); p(0) * q(3) + p(1) * q(2) - p(2) * q(1) + p(3) * q(0)};
return r;
} }
/** /**