diff --git a/conf/flight_plans/EMAV2008.xml b/conf/flight_plans/EMAV2008.xml
index 1d81947daf..57fa34c38a 100644
--- a/conf/flight_plans/EMAV2008.xml
+++ b/conf/flight_plans/EMAV2008.xml
@@ -47,7 +47,7 @@
-
+
@@ -86,11 +86,11 @@
-
+
-
+
diff --git a/conf/flight_plans/EMAV2009.xml b/conf/flight_plans/EMAV2009.xml
index 28c86bd6f1..e9f4de4d36 100644
--- a/conf/flight_plans/EMAV2009.xml
+++ b/conf/flight_plans/EMAV2009.xml
@@ -26,7 +26,7 @@
-
+
diff --git a/conf/flight_plans/EMAV2009_safety.xml b/conf/flight_plans/EMAV2009_safety.xml
index 9982b628ca..5e2dca0b32 100644
--- a/conf/flight_plans/EMAV2009_safety.xml
+++ b/conf/flight_plans/EMAV2009_safety.xml
@@ -2,7 +2,7 @@
-
+
diff --git a/conf/flight_plans/IS.xml b/conf/flight_plans/IS.xml
index 6d636cb7b1..598371aed5 100644
--- a/conf/flight_plans/IS.xml
+++ b/conf/flight_plans/IS.xml
@@ -101,15 +101,15 @@
-
+
-
+
-
+
@@ -147,7 +147,7 @@
-
+
diff --git a/conf/flight_plans/basic.xml b/conf/flight_plans/basic.xml
index e404260c69..e690348416 100644
--- a/conf/flight_plans/basic.xml
+++ b/conf/flight_plans/basic.xml
@@ -35,7 +35,7 @@
-
+
@@ -76,7 +76,7 @@
-
+
diff --git a/conf/flight_plans/ccc_gl.xml b/conf/flight_plans/ccc_gl.xml
index cfec2305c6..a8e3ef5838 100644
--- a/conf/flight_plans/ccc_gl.xml
+++ b/conf/flight_plans/ccc_gl.xml
@@ -45,7 +45,7 @@
-
+
@@ -66,19 +66,19 @@
-
+
-
+
-
+
-
+
@@ -115,7 +115,7 @@
-
+
@@ -141,7 +141,7 @@
-
+
@@ -156,7 +156,7 @@
-
+
diff --git a/conf/flight_plans/corsica.xml b/conf/flight_plans/corsica.xml
index 02db9b1e70..7b96b5ad8f 100644
--- a/conf/flight_plans/corsica.xml
+++ b/conf/flight_plans/corsica.xml
@@ -21,7 +21,7 @@
-
+
@@ -33,7 +33,7 @@
-
+
@@ -66,7 +66,7 @@
-
+
@@ -74,7 +74,7 @@
-
+
diff --git a/conf/flight_plans/creidlitz.xml b/conf/flight_plans/creidlitz.xml
index d4b34b0250..58bfa754c3 100644
--- a/conf/flight_plans/creidlitz.xml
+++ b/conf/flight_plans/creidlitz.xml
@@ -33,7 +33,7 @@
-
+
@@ -45,7 +45,7 @@
-
+
diff --git a/conf/flight_plans/fp_tp_auto.xml b/conf/flight_plans/fp_tp_auto.xml
index 444a7fc7c3..1c91224cc7 100644
--- a/conf/flight_plans/fp_tp_auto.xml
+++ b/conf/flight_plans/fp_tp_auto.xml
@@ -44,7 +44,7 @@
-
+
@@ -65,19 +65,19 @@
-
+
-
+
-
+
-
+
@@ -114,7 +114,7 @@
-
+
@@ -140,7 +140,7 @@
-
+
diff --git a/conf/flight_plans/generic.xml b/conf/flight_plans/generic.xml
index b1fc8ab8ea..5cdf61eefc 100644
--- a/conf/flight_plans/generic.xml
+++ b/conf/flight_plans/generic.xml
@@ -24,7 +24,7 @@
-
+
diff --git a/conf/flight_plans/grosslobke_demo.xml b/conf/flight_plans/grosslobke_demo.xml
index 6cdcaa5866..80343d88f0 100644
--- a/conf/flight_plans/grosslobke_demo.xml
+++ b/conf/flight_plans/grosslobke_demo.xml
@@ -53,7 +53,7 @@
-
+
@@ -78,7 +78,7 @@
-
+
diff --git a/conf/flight_plans/hsif.xml b/conf/flight_plans/hsif.xml
index 19eb10dfb3..39808c6349 100644
--- a/conf/flight_plans/hsif.xml
+++ b/conf/flight_plans/hsif.xml
@@ -18,7 +18,7 @@
-
+
diff --git a/conf/flight_plans/ingolfsskali.xml b/conf/flight_plans/ingolfsskali.xml
index f980b7a2cb..8cb378e8f1 100644
--- a/conf/flight_plans/ingolfsskali.xml
+++ b/conf/flight_plans/ingolfsskali.xml
@@ -58,22 +58,22 @@
-
+
-
+
-
+
-
+
diff --git a/conf/flight_plans/joystick.xml b/conf/flight_plans/joystick.xml
index 6969aeb403..5e979f785e 100644
--- a/conf/flight_plans/joystick.xml
+++ b/conf/flight_plans/joystick.xml
@@ -33,7 +33,7 @@
-
+
@@ -82,7 +82,7 @@
-
+
diff --git a/conf/flight_plans/kalscott.xml b/conf/flight_plans/kalscott.xml
index 49d59220b2..c9540c1192 100644
--- a/conf/flight_plans/kalscott.xml
+++ b/conf/flight_plans/kalscott.xml
@@ -26,48 +26,48 @@
-
+
-
-
-
-
-
-
-
-
-
-
+
+
+
+
+
+
+
+
+
+
-
-
-
-
-
-
-
-
-
-
+
+
+
+
+
+
+
+
+
+
-
-
-
-
-
-
-
-
-
-
+
+
+
+
+
+
+
+
+
+
diff --git a/conf/flight_plans/kv_svalbard.xml b/conf/flight_plans/kv_svalbard.xml
index 2831ac9162..7dcfa2ba9b 100644
--- a/conf/flight_plans/kv_svalbard.xml
+++ b/conf/flight_plans/kv_svalbard.xml
@@ -35,7 +35,7 @@
-
+
@@ -47,7 +47,7 @@
-
+
diff --git a/conf/flight_plans/landing.xml b/conf/flight_plans/landing.xml
index f1f2aed593..b38a4de861 100644
--- a/conf/flight_plans/landing.xml
+++ b/conf/flight_plans/landing.xml
@@ -21,8 +21,8 @@
-
-
+
+
diff --git a/conf/flight_plans/mav06.xml b/conf/flight_plans/mav06.xml
index 746dd37c1f..69bf4e8212 100644
--- a/conf/flight_plans/mav06.xml
+++ b/conf/flight_plans/mav06.xml
@@ -32,7 +32,7 @@
-
+
@@ -48,7 +48,7 @@
-
+
-->
diff --git a/conf/flight_plans/mav07.xml b/conf/flight_plans/mav07.xml
index 83c5ce09bb..7433aac8f2 100644
--- a/conf/flight_plans/mav07.xml
+++ b/conf/flight_plans/mav07.xml
@@ -72,7 +72,7 @@
-
+
@@ -132,7 +132,7 @@
-
+
diff --git a/conf/flight_plans/mav08.xml b/conf/flight_plans/mav08.xml
index 700b08d8a7..5ce3f7ae2c 100644
--- a/conf/flight_plans/mav08.xml
+++ b/conf/flight_plans/mav08.xml
@@ -41,7 +41,7 @@
-
+
@@ -100,7 +100,7 @@
-
+
diff --git a/conf/flight_plans/mission_fw.xml b/conf/flight_plans/mission_fw.xml
index 8359db5d26..5c53485f74 100644
--- a/conf/flight_plans/mission_fw.xml
+++ b/conf/flight_plans/mission_fw.xml
@@ -26,7 +26,7 @@
-
+
@@ -52,7 +52,7 @@
-
+
diff --git a/conf/flight_plans/muret_demo_1.xml b/conf/flight_plans/muret_demo_1.xml
index 439ed05688..d0271dafe1 100644
--- a/conf/flight_plans/muret_demo_1.xml
+++ b/conf/flight_plans/muret_demo_1.xml
@@ -19,7 +19,7 @@
-
+
diff --git a/conf/flight_plans/muret_for.xml b/conf/flight_plans/muret_for.xml
index 961a2816c4..1837fd6b7f 100644
--- a/conf/flight_plans/muret_for.xml
+++ b/conf/flight_plans/muret_for.xml
@@ -14,7 +14,7 @@
-
+
diff --git a/conf/flight_plans/nav_modules.xml b/conf/flight_plans/nav_modules.xml
index 3f142d3d55..b527228872 100644
--- a/conf/flight_plans/nav_modules.xml
+++ b/conf/flight_plans/nav_modules.xml
@@ -50,7 +50,7 @@
-
+
@@ -82,7 +82,7 @@
-
+
@@ -130,7 +130,7 @@
-
+
diff --git a/conf/flight_plans/nordlys.xml b/conf/flight_plans/nordlys.xml
index f7778a7820..e526b31724 100644
--- a/conf/flight_plans/nordlys.xml
+++ b/conf/flight_plans/nordlys.xml
@@ -37,7 +37,7 @@
-
+
@@ -70,7 +70,7 @@
-
+
@@ -87,7 +87,7 @@
-
+
diff --git a/conf/flight_plans/poles.xml b/conf/flight_plans/poles.xml
index 7241254523..ccf1487b8c 100644
--- a/conf/flight_plans/poles.xml
+++ b/conf/flight_plans/poles.xml
@@ -32,7 +32,7 @@
-
+
@@ -73,7 +73,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_basic_superbitrf.xml b/conf/flight_plans/rotorcraft_basic_superbitrf.xml
index 635610b6ae..aae3d4b9ce 100644
--- a/conf/flight_plans/rotorcraft_basic_superbitrf.xml
+++ b/conf/flight_plans/rotorcraft_basic_superbitrf.xml
@@ -39,7 +39,7 @@
-
+
diff --git a/conf/flight_plans/slayer_training.xml b/conf/flight_plans/slayer_training.xml
index 794ec94e96..ab416079d4 100644
--- a/conf/flight_plans/slayer_training.xml
+++ b/conf/flight_plans/slayer_training.xml
@@ -35,7 +35,7 @@
-
+
@@ -77,7 +77,7 @@
-
+
diff --git a/conf/flight_plans/tcas.xml b/conf/flight_plans/tcas.xml
index c5eeda466c..e3612c132d 100644
--- a/conf/flight_plans/tcas.xml
+++ b/conf/flight_plans/tcas.xml
@@ -33,7 +33,7 @@
-
+
@@ -74,7 +74,7 @@
-
+
diff --git a/conf/flight_plans/versatile.xml b/conf/flight_plans/versatile.xml
index 5e4023afba..0887a889cf 100644
--- a/conf/flight_plans/versatile.xml
+++ b/conf/flight_plans/versatile.xml
@@ -45,7 +45,7 @@
-
+
@@ -70,25 +70,25 @@
-
+
-
+
-
+
-
+
-
+
@@ -127,7 +127,7 @@
-
+
@@ -153,7 +153,7 @@
-
+
@@ -168,7 +168,7 @@
-
+
diff --git a/conf/flight_plans/versatile_airspeed.xml b/conf/flight_plans/versatile_airspeed.xml
index 3b9525bd00..ec1b0d3fdc 100644
--- a/conf/flight_plans/versatile_airspeed.xml
+++ b/conf/flight_plans/versatile_airspeed.xml
@@ -45,7 +45,7 @@
-
+
@@ -69,25 +69,25 @@
-
+
-
+
-
+
-
+
-
+
@@ -163,7 +163,7 @@
-
+
@@ -178,7 +178,7 @@
-
+
diff --git a/conf/flight_plans/versatile_carto_fixe_muret.xml b/conf/flight_plans/versatile_carto_fixe_muret.xml
index dfd522ded7..fe9a0eb356 100644
--- a/conf/flight_plans/versatile_carto_fixe_muret.xml
+++ b/conf/flight_plans/versatile_carto_fixe_muret.xml
@@ -61,7 +61,7 @@ float varsweepsize=110;
-
+
@@ -111,8 +111,8 @@ float varsweepsize=110;
-
-
+
+
@@ -139,8 +139,8 @@ float varsweepsize=110;
-
-
+
+
diff --git a/conf/flight_plans/xsens_cachejunction.xml b/conf/flight_plans/xsens_cachejunction.xml
index 3d2fd30938..fca2f69c32 100644
--- a/conf/flight_plans/xsens_cachejunction.xml
+++ b/conf/flight_plans/xsens_cachejunction.xml
@@ -23,7 +23,7 @@
-
+
@@ -91,7 +91,7 @@
-
+
diff --git a/conf/flight_plans/zamboni_survey_test.xml b/conf/flight_plans/zamboni_survey_test.xml
index 810c6a779d..9e43f0bb35 100644
--- a/conf/flight_plans/zamboni_survey_test.xml
+++ b/conf/flight_plans/zamboni_survey_test.xml
@@ -34,7 +34,7 @@
-
+
@@ -66,7 +66,7 @@
-
+
diff --git a/sw/airborne/subsystems/nav.h b/sw/airborne/subsystems/nav.h
index 74ce373275..e10999510b 100644
--- a/sw/airborne/subsystems/nav.h
+++ b/sw/airborne/subsystems/nav.h
@@ -199,6 +199,7 @@ bool_t nav_approaching_xy(float x, float y, float from_x, float from_y, float ap
#define GetPosX() (stateGetPositionEnu_f()->x)
#define GetPosY() (stateGetPositionEnu_f()->y)
#define GetPosAlt() (stateGetPositionUtm_f()->alt)
+#define GetAltRef() (ground_alt)
#define SEND_NAVIGATION(_trans, _dev) { \
uint8_t _circle_count = NavCircleCount(); \