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

move autodeclination unittest to gtest and delete the sample

Browse Source
This commit is contained in:
Daniel Agar
2015-01-02 23:05:43 -05:00
parent 61d57539fb
commit 859185ac72
6 changed files with 38 additions and 333 deletions
Download Patch File Download Diff File Expand all files Collapse all files
unittests/autodeclination_test.cpp
+9 -44
View File
@@ -1,52 +1,17 @@
#include <math.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <math.h>
#include <systemlib/mixer/mixer.h>
#include <systemlib/err.h>
#include <unistd.h>
#include <drivers/drv_hrt.h>
#include <px4iofirmware/px4io.h>
// #include "../../src/systemcmds/tests/tests.h"
#include <geo/geo.h>
#include <px4iofirmware/px4io.h>
#include <systemlib/err.h>
#include <systemlib/mixer/mixer.h>
int main(int argc, char *argv[]) {
warnx("autodeclination test started");
#include "gtest/gtest.h"
char* latstr = 0;
char* lonstr = 0;
char* declstr = 0;
if (argc < 4) {
warnx("Too few arguments. Using default lat / lon and declination");
latstr = "47.0";
lonstr = "8.0";
declstr = "0.6";
} else {
latstr = argv[1];
lonstr = argv[2];
declstr = argv[3];
}
char* p_end;
float lat = strtod(latstr, &p_end);
float lon = strtod(lonstr, &p_end);
float decl_truth = strtod(declstr, &p_end);
float declination = get_mag_declination(lat, lon);
printf("lat: %f lon: %f, expected dec: %f, estimated dec: %f\n", lat, lon, declination, decl_truth);
int ret = 0;
// Fail if the declination differs by more than one degree
float decldiff = fabs(decl_truth - declination);
if (decldiff > 0.5f) {
warnx("declination differs more than 1 degree: difference: %12.8f", decldiff);
ret = 1;
}
return ret;
TEST(AutoDeclinationTest, AutoDeclination) {
ASSERT_NEAR(get_mag_declination(47.0, 8.0), 0.6, 0.5) << "declination differs more than 1 degree";
}