diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2014-05-03 03:41:30 -0700 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-05-03 03:41:30 -0700 |
commit | 5199dea2b3580f42bb0c9ac02e2c3e7711cda2ff (patch) | |
tree | 558d22f69500b69a63a17375768e13eed5861b65 /Tools/tests-host/autodeclination_test.cpp | |
parent | 5e9639ad9bea4db26ee74e5f0c3c585a75c492a1 (diff) | |
parent | 0be1f36571e74b407e312866b6eb77547b9e4c2b (diff) | |
download | px4-firmware-5199dea2b3580f42bb0c9ac02e2c3e7711cda2ff.tar.gz px4-firmware-5199dea2b3580f42bb0c9ac02e2c3e7711cda2ff.tar.bz2 px4-firmware-5199dea2b3580f42bb0c9ac02e2c3e7711cda2ff.zip |
Merge pull request #876 from PX4/autodeclination
Added automatic declination lookup
Diffstat (limited to 'Tools/tests-host/autodeclination_test.cpp')
-rw-r--r-- | Tools/tests-host/autodeclination_test.cpp | 28 |
1 files changed, 28 insertions, 0 deletions
diff --git a/Tools/tests-host/autodeclination_test.cpp b/Tools/tests-host/autodeclination_test.cpp new file mode 100644 index 000000000..93bc340bb --- /dev/null +++ b/Tools/tests-host/autodeclination_test.cpp @@ -0,0 +1,28 @@ + +#include <stdio.h> +#include <stdlib.h> +#include <unistd.h> +#include <string.h> +#include <systemlib/mixer/mixer.h> +#include <systemlib/err.h> +#include <drivers/drv_hrt.h> +#include <px4iofirmware/px4io.h> +#include "../../src/systemcmds/tests/tests.h" +#include <geo/geo.h> + +int main(int argc, char *argv[]) { + warnx("autodeclination test started"); + + if (argc < 3) + errx(1, "Need lat/lon!"); + + char* p_end; + + float lat = strtod(argv[1], &p_end); + float lon = strtod(argv[2], &p_end); + + float declination = get_mag_declination(lat, lon); + + printf("lat: %f lon: %f, dec: %f\n", lat, lon, declination); + +} |