From 9c81ab113e73c8862cc3f4e81411cb69dbec14ee Mon Sep 17 00:00:00 2001
From: Lorenz Meier <lm@inf.ethz.ch>
Date: Mon, 28 Apr 2014 20:42:46 +0200
Subject: [PATCH] Updated outo-test

---
 Tools/tests-host/Makefile                 |  6 +++---
 Tools/tests-host/autodeclination_test.cpp | 11 ++++++++++-
 2 files changed, 13 insertions(+), 4 deletions(-)

diff --git a/Tools/tests-host/Makefile b/Tools/tests-host/Makefile
index fd001e4d7f..f0737ef88c 100644
--- a/Tools/tests-host/Makefile
+++ b/Tools/tests-host/Makefile
@@ -1,7 +1,7 @@
 
 CC=g++
 CFLAGS=-I. -I../../src/modules -I ../../src/include -I../../src/drivers \
-	-I../../src -D__EXPORT="" -Dnullptr="0" -lm
+	-I../../src -I../../src/lib -D__EXPORT="" -Dnullptr="0" -lm
 
 all: mixer_test sbus2_test autodeclination_test
 
@@ -20,7 +20,7 @@ SBUS2_FILES=../../src/modules/px4iofirmware/sbus.c \
 		hrt.cpp \
 		sbus2_test.cpp
 
-AUTODECLINATION_FILES=../../src/lib/geo/geo_mag_declination.c \
+AUTODECLINATION_FILES= ../../src/lib/geo/geo_mag_declination.c \
 		hrt.cpp \
 		autodeclination_test.cpp
 
@@ -31,7 +31,7 @@ sbus2_test: $(SBUS2_FILES)
 	$(CC) -o sbus2_test $(SBUS2_FILES) $(CFLAGS)
 
 autodeclination_test: $(SBUS2_FILES)
-	$(CC) -o autodeclination_test $(SBUS2_FILES) $(CFLAGS)
+	$(CC) -o autodeclination_test $(AUTODECLINATION_FILES) $(CFLAGS)
 
 .PHONY: clean
 
diff --git a/Tools/tests-host/autodeclination_test.cpp b/Tools/tests-host/autodeclination_test.cpp
index b1b30f5d97..6c751dc1e7 100644
--- a/Tools/tests-host/autodeclination_test.cpp
+++ b/Tools/tests-host/autodeclination_test.cpp
@@ -1,5 +1,6 @@
 
 #include <stdio.h>
+#include <stdlib.h> 
 #include <unistd.h>
 #include <string.h>
 #include <systemlib/mixer/mixer.h>
@@ -7,6 +8,7 @@
 #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");
@@ -14,6 +16,13 @@ int main(int argc, char *argv[]) {
 	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);
 
 }
\ No newline at end of file