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

Implemented vector 3 cross product.

Browse Source
This commit is contained in:
jgoppert
2015-11-05 20:22:17 -05:00
parent 5b5cfcfeca
commit 32839006f3
2 changed files with 7 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Vector3.hpp
+5 -7
View File
@@ -50,14 +50,12 @@ public:
v(2) = z;
}
Vector3 cross(const Vector3 & b) {
// TODO
Vector3 &a(*this);
(void)a;
Vector3 cross(const Vector3 & b) const {
const Vector3 &a(*this);
Vector3 c;
c(0) = 0;
c(1) = 0;
c(2) = 0;
c(0) = a(1)*b(2) - a(2)*b(1);
c(1) = -a(0)*b(2) + a(2)*b(0);
c(2) = a(0)*b(1) - a(1)*b(0);
return c;
}
};