fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-06-26 08:20:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

Reformat of math library with astyle.

Browse Source
This commit is contained in:
jgoppert
2013-01-06 15:33:55 -05:00
parent 4f3b17f53b
commit d9491b20cc
19 changed files with 1432 additions and 1453 deletions
Download Patch File Download Diff File Expand all files Collapse all files
apps/systemlib/math/Vector.cpp
+36 -35
View File
@@ -44,56 +44,57 @@
namespace math
{
static const float data_testA[] = {1,3};
static const float data_testB[] = {4,1};
static const float data_testA[] = {1, 3};
static const float data_testB[] = {4, 1};
static Vector testA(2,data_testA);
static Vector testB(2,data_testB);
static Vector testA(2, data_testA);
static Vector testB(2, data_testB);
int __EXPORT vectorTest()
{
vectorAddTest();
vectorSubTest();
return 0;
vectorAddTest();
vectorSubTest();
return 0;
}
int vectorAddTest()
{
printf("Test Vector Add\t\t: ");
Vector r = testA + testB;
float data_test[] = {5.0f, 4.0f};
ASSERT(vectorEqual(Vector(2,data_test),r));
printf("PASS\n");
return 0;
printf("Test Vector Add\t\t: ");
Vector r = testA + testB;
float data_test[] = {5.0f, 4.0f};
ASSERT(vectorEqual(Vector(2, data_test), r));
printf("PASS\n");
return 0;
}
int vectorSubTest()
{
printf("Test Vector Sub\t\t: ");
Vector r(2);
r = testA - testB;
float data_test[] = {-3.0f, 2.0f};
ASSERT(vectorEqual(Vector(2,data_test),r));
printf("PASS\n");
return 0;
printf("Test Vector Sub\t\t: ");
Vector r(2);
r = testA - testB;
float data_test[] = { -3.0f, 2.0f};
ASSERT(vectorEqual(Vector(2, data_test), r));
printf("PASS\n");
return 0;
}
bool vectorEqual(const Vector & a, const Vector & b, float eps)
bool vectorEqual(const Vector &a, const Vector &b, float eps)
{
if (a.getRows() != b.getRows()) {
printf("row number not equal a: %d, b:%d\n", a.getRows(), b.getRows());
return false;
}
bool ret = true;
for (size_t i=0;i<a.getRows();i++)
{
if (!equal(a(i),b(i),eps))
{
printf("element mismatch (%d)\n", i);
ret = false;
}
}
return ret;
if (a.getRows() != b.getRows()) {
printf("row number not equal a: %d, b:%d\n", a.getRows(), b.getRows());
return false;
}
bool ret = true;
for (size_t i = 0; i < a.getRows(); i++) {
if (!equal(a(i), b(i), eps)) {
printf("element mismatch (%d)\n", i);
ret = false;
}
}
return ret;
}
} // namespace math