forked from Archive/PX4-Autopilot
29 lines
603 B
C++
29 lines
603 B
C++
|
|
#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);
|
|
|
|
}
|