fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-22 01:00:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

test vector3 using matrix::isEqual

Browse Source
This commit is contained in:
Daniel Agar
2017-02-24 16:10:02 -05:00
parent d81ddb0f37
commit cf924956d7
3 changed files with 16 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/vector.cpp
+1 -1
View File
@@ -2,8 +2,8 @@
#include <matrix/math.hpp> #include <matrix/math.hpp>
using matrix::Vector;
using matrix::isEqualF; using matrix::isEqualF;
using matrix::Vector;
int main() int main()
{ {
test/vector2.cpp
+1 -1
View File
@@ -4,8 +4,8 @@
#include "test_macros.hpp" #include "test_macros.hpp"
using matrix::Vector2f;
using matrix::Matrix; using matrix::Matrix;
using matrix::Vector2f;
int main() int main()
{ {
test/vector3.cpp
+14 -12
View File
@@ -2,31 +2,33 @@
#include <matrix/math.hpp> #include <matrix/math.hpp>
using matrix::Vector3f; using matrix::isEqual;
using matrix::isEqualF;
using matrix::Matrix; using matrix::Matrix;
using matrix::Vector3f;
int main() int main()
{ {
Vector3f a(1, 0, 0); Vector3f a(1, 0, 0);
Vector3f b(0, 1, 0); Vector3f b(0, 1, 0);
Vector3f c = a.cross(b); Vector3f c = a.cross(b);
TEST(matrix::isEqual(c, Vector3f(0,0,1))); TEST(isEqual(c, Vector3f(0,0,1)));
c = a % b; c = a % b;
TEST(matrix::isEqual(c, Vector3f(0,0,1))); TEST(isEqual(c, Vector3f(0,0,1)));
Matrix<float, 3, 1> d(c); Matrix<float, 3, 1> d(c);
Vector3f e(d); Vector3f e(d);
TEST (matrix::isEqual(e, d)); TEST(isEqual(e, d));
float data[] = {4, 5, 6}; float data[] = {4, 5, 6};
Vector3f f(data); Vector3f f(data);
TEST(matrix::isEqual(f, Vector3f(4, 5, 6))); TEST(isEqual(f, Vector3f(4, 5, 6)));
TEST(matrix::isEqual(a + b, Vector3f(1, 1, 0))); TEST(isEqual(a + b, Vector3f(1, 1, 0)));
TEST(matrix::isEqual(a - b, Vector3f(1, -1, 0))); TEST(isEqual(a - b, Vector3f(1, -1, 0)));
TEST(matrix::isEqualF(a * b, 0.0f)); TEST(isEqualF(a * b, 0.0f));
TEST(matrix::isEqual(-a, Vector3f(-1, 0, 0))); TEST(isEqual(-a, Vector3f(-1, 0, 0)));
TEST(matrix::isEqual(a.unit(), a)); TEST(isEqual(a.unit(), a));
TEST(matrix::isEqual(a.unit(), a.normalized())); TEST(isEqual(a.unit(), a.normalized()));
TEST(matrix::isEqual(a*2.0, Vector3f(2, 0, 0))); TEST(isEqual(a*2.0, Vector3f(2, 0, 0)));
return 0; return 0;
} }