Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-31 02:16:53 +08:00
Code Issues Actions 3 Packages Projects Releases Wiki Activity

quaternion: reuse existing dot product

Browse Source
This commit is contained in:
Matthias Grob
2018-12-16 17:59:44 +00:00
parent 9c0acfba36
commit a4f39c0f89
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Quaternion.hpp
+2 -2
View File
@@ -194,7 +194,7 @@ public:
{
Quaternion &q = *this;
Vector3<Type> cr = src.cross(dst);
float dt = src.dot(dst);
const float dt = src.dot(dst);
/* If the two vectors are parallel, cross product is zero
* If they point opposite, the dot product is negative */
if (cr.norm() < eps && dt < 0) {
@@ -216,7 +216,7 @@ public:
cr = src.cross(cr);
} else {
/* Half-Way Quaternion Solution */
q(0) = src.dot(dst) + sqrt(src.norm_squared() * dst.norm_squared());
q(0) = dt + sqrt(src.norm_squared() * dst.norm_squared());
}
q(1) = cr(0);
q(2) = cr(1);