diff --git a/conf/flight_plans/AGGIEAIR/rotorcraft_opticlow_test.xml b/conf/flight_plans/AGGIEAIR/rotorcraft_opticlow_test.xml
index b518375825..51b0358ff4 100644
--- a/conf/flight_plans/AGGIEAIR/rotorcraft_opticlow_test.xml
+++ b/conf/flight_plans/AGGIEAIR/rotorcraft_opticlow_test.xml
@@ -37,7 +37,7 @@
-
+
diff --git a/conf/flight_plans/ENAC/crazyflie_multi_ranger_test.xml b/conf/flight_plans/ENAC/crazyflie_multi_ranger_test.xml
index 3de84b393f..48e9e27ddc 100644
--- a/conf/flight_plans/ENAC/crazyflie_multi_ranger_test.xml
+++ b/conf/flight_plans/ENAC/crazyflie_multi_ranger_test.xml
@@ -76,7 +76,7 @@ static inline void obstacle_detection_cb(uint8_t sender_id __attribute__((unused
-
+
@@ -101,7 +101,7 @@ static inline void obstacle_detection_cb(uint8_t sender_id __attribute__((unused
-
+
diff --git a/conf/flight_plans/ENAC/dw1000_basic.xml b/conf/flight_plans/ENAC/dw1000_basic.xml
index 87606cf96e..5afceaf759 100644
--- a/conf/flight_plans/ENAC/dw1000_basic.xml
+++ b/conf/flight_plans/ENAC/dw1000_basic.xml
@@ -37,7 +37,7 @@
-
+
@@ -50,8 +50,8 @@
-
-
+
+
@@ -70,11 +70,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/ENAC/fish_outdoor.xml b/conf/flight_plans/ENAC/fish_outdoor.xml
index 0d4744b3ea..0f3727f5cc 100644
--- a/conf/flight_plans/ENAC/fish_outdoor.xml
+++ b/conf/flight_plans/ENAC/fish_outdoor.xml
@@ -44,16 +44,16 @@
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land"/>
- = IndexOfBlock('Landed')) @AND
(autopilot_in_flight() == true) )" deroute="EmergencyLanding"/>
@@ -94,7 +94,7 @@
-
+
diff --git a/conf/flight_plans/ENAC/fish_voliere.xml b/conf/flight_plans/ENAC/fish_voliere.xml
index 86d1d9a347..be5b859ecc 100644
--- a/conf/flight_plans/ENAC/fish_voliere.xml
+++ b/conf/flight_plans/ENAC/fish_voliere.xml
@@ -78,7 +78,7 @@
-
+
diff --git a/conf/flight_plans/HOOPERFLY/hooperfly_gsa_one.xml b/conf/flight_plans/HOOPERFLY/hooperfly_gsa_one.xml
index 89ef753789..291f008256 100644
--- a/conf/flight_plans/HOOPERFLY/hooperfly_gsa_one.xml
+++ b/conf/flight_plans/HOOPERFLY/hooperfly_gsa_one.xml
@@ -36,7 +36,7 @@
-
+
diff --git a/conf/flight_plans/HOOPERFLY/hooperfly_rotorcraft_multiflight.xml b/conf/flight_plans/HOOPERFLY/hooperfly_rotorcraft_multiflight.xml
index 253eee5e73..7a5f3493bd 100644
--- a/conf/flight_plans/HOOPERFLY/hooperfly_rotorcraft_multiflight.xml
+++ b/conf/flight_plans/HOOPERFLY/hooperfly_rotorcraft_multiflight.xml
@@ -36,7 +36,7 @@
-
+
@@ -87,21 +87,21 @@
-
+
-
+
-
+
diff --git a/conf/flight_plans/HOOPERFLY/hooperfly_rotorcraft_nocturnal.xml b/conf/flight_plans/HOOPERFLY/hooperfly_rotorcraft_nocturnal.xml
index 9fa8a68519..bfe36c138a 100644
--- a/conf/flight_plans/HOOPERFLY/hooperfly_rotorcraft_nocturnal.xml
+++ b/conf/flight_plans/HOOPERFLY/hooperfly_rotorcraft_nocturnal.xml
@@ -36,7 +36,7 @@
-
+
@@ -87,21 +87,21 @@
-
+
-
+
-
+
diff --git a/conf/flight_plans/OPENUAS/include_obc2014_mission.xml b/conf/flight_plans/OPENUAS/include_obc2014_mission.xml
index 57560201aa..b0c1ea6c64 100644
--- a/conf/flight_plans/OPENUAS/include_obc2014_mission.xml
+++ b/conf/flight_plans/OPENUAS/include_obc2014_mission.xml
@@ -151,7 +151,7 @@ TST-3 = -26° 35' 23.2" * 151° 50' 45.9"
-
+
@@ -159,10 +159,10 @@ TST-3 = -26° 35' 23.2" * 151° 50' 45.9"
-
-
+
+
-
+
@@ -186,7 +186,7 @@ TST-3 = -26° 35' 23.2" * 151° 50' 45.9"
-
+
@@ -276,7 +276,7 @@ TST-3 = -26° 35' 23.2" * 151° 50' 45.9"
-
+
@@ -508,9 +508,9 @@ extern bool_t compute_alignment(uint8_t w1, uint8_t w2, uint8_t start, uint8_t e
-
+
-
+
@@ -555,13 +555,13 @@ mode must be activated. A controlled flight termination mode may be
termination mode (Section 5.6).
-->
-
+
-
+
@@ -574,7 +574,7 @@ termination mode (Section 5.6).
-
+
diff --git a/conf/flight_plans/OPENUAS/include_obc2014_safety.xml b/conf/flight_plans/OPENUAS/include_obc2014_safety.xml
index 59752053af..54f0ee3167 100644
--- a/conf/flight_plans/OPENUAS/include_obc2014_safety.xml
+++ b/conf/flight_plans/OPENUAS/include_obc2014_safety.xml
@@ -61,7 +61,7 @@
-
+
@@ -70,17 +70,17 @@
-
+
-
+
diff --git a/conf/flight_plans/OPENUAS/openuas_nav_modules_test.xml b/conf/flight_plans/OPENUAS/openuas_nav_modules_test.xml
index 8edaca7bc3..300fb12ff8 100644
--- a/conf/flight_plans/OPENUAS/openuas_nav_modules_test.xml
+++ b/conf/flight_plans/OPENUAS/openuas_nav_modules_test.xml
@@ -49,7 +49,7 @@
-
+
@@ -126,11 +126,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/OPENUAS/openuas_rotorcraft_simple.xml b/conf/flight_plans/OPENUAS/openuas_rotorcraft_simple.xml
index 61ccc10e2e..9c42734640 100644
--- a/conf/flight_plans/OPENUAS/openuas_rotorcraft_simple.xml
+++ b/conf/flight_plans/OPENUAS/openuas_rotorcraft_simple.xml
@@ -33,22 +33,22 @@ Your safe aircraft operation is *your* responsibility
-
-
+
+
-
+
-
+
-
+
-
+
-
-
+
+
@@ -91,16 +91,16 @@ Altough Switching the mode to auto2/NAV from any other mode will reset nav_headi
-
+
-
-
+
+
-
+
@@ -109,7 +109,7 @@ Altough Switching the mode to auto2/NAV from any other mode will reset nav_headi
-
+
@@ -129,7 +129,7 @@ Altough Switching the mode to auto2/NAV from any other mode will reset nav_headi
-
+
diff --git a/conf/flight_plans/OPENUAS/openuas_tuning_a_fresh_fixedwing.xml b/conf/flight_plans/OPENUAS/openuas_tuning_a_fresh_fixedwing.xml
index 24bb580056..1e46bd1d3f 100644
--- a/conf/flight_plans/OPENUAS/openuas_tuning_a_fresh_fixedwing.xml
+++ b/conf/flight_plans/OPENUAS/openuas_tuning_a_fresh_fixedwing.xml
@@ -154,7 +154,7 @@ perhaps a few global alt exceptions? But where do they deroute to assuming the a
-
+
@@ -173,7 +173,7 @@ perhaps a few global alt exceptions? But where do they deroute to assuming the a
-
+
@@ -215,7 +215,7 @@ perhaps a few global alt exceptions? But where do they deroute to assuming the a
-
+
@@ -244,7 +244,7 @@ perhaps a few global alt exceptions? But where do they deroute to assuming the a
-
+
diff --git a/conf/flight_plans/OPENUAS/openuas_versatile_unified.xml b/conf/flight_plans/OPENUAS/openuas_versatile_unified.xml
index 4a266c4bea..c8dd675fad 100644
--- a/conf/flight_plans/OPENUAS/openuas_versatile_unified.xml
+++ b/conf/flight_plans/OPENUAS/openuas_versatile_unified.xml
@@ -119,16 +119,16 @@ Should be unified for Hybrid, FW and rotorcraft
-
-
-
+
+
+
-
+
-
+
@@ -187,7 +187,7 @@ Should be unified for Hybrid, FW and rotorcraft
-
+
@@ -214,7 +214,7 @@ Should be unified for Hybrid, FW and rotorcraft
-
+
@@ -232,7 +232,7 @@ Should be unified for Hybrid, FW and rotorcraft
-
+
@@ -245,23 +245,23 @@ Should be unified for Hybrid, FW and rotorcraft
-
+
-
+
-
+
-
+
-
+
-
+
@@ -294,10 +294,10 @@ Should be unified for Hybrid, FW and rotorcraft
@@ -322,15 +322,15 @@ Should be unified for Hybrid, FW and rotorcraft
-
+
-
+
-
+
@@ -344,26 +344,26 @@ Should be unified for Hybrid, FW and rotorcraft
-
-
+
+
-
-
+
+
-
-
+
+
-
-
+
+
@@ -371,7 +371,7 @@ Should be unified for Hybrid, FW and rotorcraft
-
+
@@ -380,7 +380,7 @@ Should be unified for Hybrid, FW and rotorcraft
-
+
@@ -403,7 +403,7 @@ Should be unified for Hybrid, FW and rotorcraft
+
diff --git a/conf/flight_plans/basic.xml b/conf/flight_plans/basic.xml
index cb73ebf8bd..9b34ac7e54 100644
--- a/conf/flight_plans/basic.xml
+++ b/conf/flight_plans/basic.xml
@@ -18,7 +18,7 @@
-
+
@@ -35,7 +35,7 @@
-
+
@@ -72,11 +72,11 @@
-
+
-
+
diff --git a/conf/flight_plans/basic_sim.xml b/conf/flight_plans/basic_sim.xml
index 9a075d5163..bbef71daa6 100644
--- a/conf/flight_plans/basic_sim.xml
+++ b/conf/flight_plans/basic_sim.xml
@@ -19,7 +19,7 @@
-
+
@@ -33,10 +33,10 @@
-
+
-
+
@@ -46,19 +46,19 @@
-
+
-
+
-
+
-
+
@@ -69,7 +69,7 @@
-
+
@@ -77,11 +77,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/competitions/EMAV2006.xml b/conf/flight_plans/competitions/EMAV2006.xml
index b6b9cb83d0..12116ac93d 100644
--- a/conf/flight_plans/competitions/EMAV2006.xml
+++ b/conf/flight_plans/competitions/EMAV2006.xml
@@ -17,7 +17,7 @@
-
+
diff --git a/conf/flight_plans/competitions/EMAV2008.xml b/conf/flight_plans/competitions/EMAV2008.xml
index 751a41f5dd..cb29bb4c35 100644
--- a/conf/flight_plans/competitions/EMAV2008.xml
+++ b/conf/flight_plans/competitions/EMAV2008.xml
@@ -35,7 +35,7 @@
-
+
@@ -47,7 +47,7 @@
-
+
@@ -66,7 +66,7 @@
-
+
@@ -83,14 +83,14 @@
-
+
-
+
-
+
@@ -99,7 +99,7 @@
-
+
@@ -112,10 +112,10 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/competitions/EMAV2009.xml b/conf/flight_plans/competitions/EMAV2009.xml
index b21ad27533..d06cef9b1a 100644
--- a/conf/flight_plans/competitions/EMAV2009.xml
+++ b/conf/flight_plans/competitions/EMAV2009.xml
@@ -26,7 +26,7 @@
-
+
diff --git a/conf/flight_plans/competitions/EMAV2009_safety.xml b/conf/flight_plans/competitions/EMAV2009_safety.xml
index 12c7648b4e..302c78edc1 100644
--- a/conf/flight_plans/competitions/EMAV2009_safety.xml
+++ b/conf/flight_plans/competitions/EMAV2009_safety.xml
@@ -2,7 +2,7 @@
-
+
diff --git a/conf/flight_plans/competitions/IMAV2014_carto.xml b/conf/flight_plans/competitions/IMAV2014_carto.xml
index 1d94622433..1540933c96 100644
--- a/conf/flight_plans/competitions/IMAV2014_carto.xml
+++ b/conf/flight_plans/competitions/IMAV2014_carto.xml
@@ -42,7 +42,7 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
@@ -61,7 +61,7 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
@@ -75,7 +75,7 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
@@ -119,11 +119,11 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
-
+
+
-
+
diff --git a/conf/flight_plans/competitions/IMAV2014_digit.xml b/conf/flight_plans/competitions/IMAV2014_digit.xml
index ee7d61e6fd..6d98201b48 100644
--- a/conf/flight_plans/competitions/IMAV2014_digit.xml
+++ b/conf/flight_plans/competitions/IMAV2014_digit.xml
@@ -25,8 +25,8 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
-
+
+
@@ -45,10 +45,10 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
-
+
@@ -82,9 +82,9 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
-
-
+
+
+
@@ -105,7 +105,7 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
diff --git a/conf/flight_plans/competitions/IMAV2014_vision.xml b/conf/flight_plans/competitions/IMAV2014_vision.xml
index 74bfbf1c5a..cb26d07300 100644
--- a/conf/flight_plans/competitions/IMAV2014_vision.xml
+++ b/conf/flight_plans/competitions/IMAV2014_vision.xml
@@ -29,8 +29,8 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
-
+
+
@@ -49,10 +49,10 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
-
+
@@ -64,10 +64,10 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
+
@@ -76,10 +76,10 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
+
@@ -88,10 +88,10 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
+
@@ -100,10 +100,10 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
+
@@ -112,10 +112,10 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
+
@@ -124,17 +124,17 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
+
-
-
-
+
+
+
@@ -148,7 +148,7 @@ static inline float wp_dist(float wp1_x, float wp1_y, float wp2_x, float wp2_y)
-
+
diff --git a/conf/flight_plans/competitions/IMAV2018_carto.xml b/conf/flight_plans/competitions/IMAV2018_carto.xml
index 54be4bdfe4..56f97f4a2b 100644
--- a/conf/flight_plans/competitions/IMAV2018_carto.xml
+++ b/conf/flight_plans/competitions/IMAV2018_carto.xml
@@ -97,21 +97,21 @@ static inline void set_expo(float e) {
- = IndexOfBlock('Land Right AF-TD')) @AND
(autopilot.launch == true) )" deroute="EmergencyLanding"/>
- = IndexOfBlock('Land Right AF-TD')) @AND
(autopilot.launch == true) )" deroute="EmergencyLanding"/>
- = IndexOfBlock('Land Right AF-TD')) @AND
(autopilot.launch == true) )" deroute="EmergencyLanding"/>
@@ -128,7 +128,7 @@ static inline void set_expo(float e) {
-
+
@@ -151,11 +151,11 @@ static inline void set_expo(float e) {
-
-
+
+
-
+
diff --git a/conf/flight_plans/competitions/IMAV2019_carto.xml b/conf/flight_plans/competitions/IMAV2019_carto.xml
index a71ce1f283..71021a0e1b 100644
--- a/conf/flight_plans/competitions/IMAV2019_carto.xml
+++ b/conf/flight_plans/competitions/IMAV2019_carto.xml
@@ -95,17 +95,17 @@ static inline void set_expo(float e) {
@@ -121,7 +121,7 @@ static inline void set_expo(float e) {
-
+
@@ -149,11 +149,11 @@ static inline void set_expo(float e) {
-
-
+
+
-
+
diff --git a/conf/flight_plans/competitions/IMAV2019_drop.xml b/conf/flight_plans/competitions/IMAV2019_drop.xml
index 1b8cf20759..b82627432f 100644
--- a/conf/flight_plans/competitions/IMAV2019_drop.xml
+++ b/conf/flight_plans/competitions/IMAV2019_drop.xml
@@ -84,17 +84,17 @@ static inline bool delay_test_gf(bool test, int delay) {
@@ -114,7 +114,7 @@ static inline bool delay_test_gf(bool test, int delay) {
-
+
@@ -127,8 +127,8 @@ static inline bool delay_test_gf(bool test, int delay) {
-
-
+
+
@@ -143,11 +143,11 @@ static inline bool delay_test_gf(bool test, int delay) {
-
+
-
+
-
+
@@ -157,8 +157,8 @@ static inline bool delay_test_gf(bool test, int delay) {
-
-
+
+
@@ -189,8 +189,8 @@ static inline bool delay_test_gf(bool test, int delay) {
-
-
+
+
@@ -221,8 +221,8 @@ static inline bool delay_test_gf(bool test, int delay) {
-
-
+
+
@@ -253,8 +253,8 @@ static inline bool delay_test_gf(bool test, int delay) {
-
-
+
+
diff --git a/conf/flight_plans/competitions/mav06.xml b/conf/flight_plans/competitions/mav06.xml
index 69bf4e8212..c922eb5c2c 100644
--- a/conf/flight_plans/competitions/mav06.xml
+++ b/conf/flight_plans/competitions/mav06.xml
@@ -26,13 +26,13 @@
@@ -61,7 +61,7 @@
-
+
@@ -87,7 +87,7 @@
-
+
-->
diff --git a/conf/flight_plans/competitions/mav07.xml b/conf/flight_plans/competitions/mav07.xml
index 63b1ac7c5f..595f0289a3 100644
--- a/conf/flight_plans/competitions/mav07.xml
+++ b/conf/flight_plans/competitions/mav07.xml
@@ -57,7 +57,7 @@
-
+
@@ -72,7 +72,7 @@
-
+
@@ -128,11 +128,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/competitions/mav08.xml b/conf/flight_plans/competitions/mav08.xml
index db5db2c468..1e53897a67 100644
--- a/conf/flight_plans/competitions/mav08.xml
+++ b/conf/flight_plans/competitions/mav08.xml
@@ -32,8 +32,8 @@
-
-
+
+
@@ -41,7 +41,7 @@
-
+
@@ -96,11 +96,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/demo_gvf.xml b/conf/flight_plans/demo_gvf.xml
index be8a3a1233..46ea459886 100644
--- a/conf/flight_plans/demo_gvf.xml
+++ b/conf/flight_plans/demo_gvf.xml
@@ -51,7 +51,7 @@
-
+
@@ -102,11 +102,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/dynamic_sectors.xml b/conf/flight_plans/dynamic_sectors.xml
index e7e150d49f..2985169c08 100644
--- a/conf/flight_plans/dynamic_sectors.xml
+++ b/conf/flight_plans/dynamic_sectors.xml
@@ -41,7 +41,7 @@
-
+
@@ -67,12 +67,12 @@
-
+
-
+
-
+
diff --git a/conf/flight_plans/formation/form_follow.xml b/conf/flight_plans/formation/form_follow.xml
index 39d95e17ed..9388f85039 100644
--- a/conf/flight_plans/formation/form_follow.xml
+++ b/conf/flight_plans/formation/form_follow.xml
@@ -40,7 +40,7 @@
-
+
diff --git a/conf/flight_plans/formation/form_leader.xml b/conf/flight_plans/formation/form_leader.xml
index 92eb108d3f..ad7d993b06 100644
--- a/conf/flight_plans/formation/form_leader.xml
+++ b/conf/flight_plans/formation/form_leader.xml
@@ -50,7 +50,7 @@
-
+
diff --git a/conf/flight_plans/joystick.xml b/conf/flight_plans/joystick.xml
index 5e7dcdc3aa..fd62c40bd0 100644
--- a/conf/flight_plans/joystick.xml
+++ b/conf/flight_plans/joystick.xml
@@ -51,7 +51,7 @@ static inline void joystick_handler(uint8_t sender_id __attribute__((unused)), i
-
+
@@ -71,7 +71,7 @@ static inline void joystick_handler(uint8_t sender_id __attribute__((unused)), i
-
+
@@ -96,11 +96,11 @@ static inline void joystick_handler(uint8_t sender_id __attribute__((unused)), i
-
-
+
+
-
+
diff --git a/conf/flight_plans/lagonisi_beach_survey.xml b/conf/flight_plans/lagonisi_beach_survey.xml
index 5f9d10f39a..7c8a494af8 100644
--- a/conf/flight_plans/lagonisi_beach_survey.xml
+++ b/conf/flight_plans/lagonisi_beach_survey.xml
@@ -26,8 +26,8 @@
-
-
+
+
@@ -42,25 +42,25 @@
-
+
-
+
-
+
-
+
-
-
+
+
@@ -68,7 +68,7 @@
-
+
@@ -77,7 +77,7 @@
-
+
@@ -103,19 +103,19 @@
-
-
+
+
-
+
-
+
-
+
@@ -125,13 +125,13 @@
-
+
-
+
-
+
@@ -142,11 +142,11 @@
-
+
-
+
diff --git a/conf/flight_plans/landing.xml b/conf/flight_plans/landing.xml
index 63d82ad1f1..31e03a4625 100644
--- a/conf/flight_plans/landing.xml
+++ b/conf/flight_plans/landing.xml
@@ -17,11 +17,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/mission_fw.xml b/conf/flight_plans/mission_fw.xml
index a186011eae..7ce3928336 100644
--- a/conf/flight_plans/mission_fw.xml
+++ b/conf/flight_plans/mission_fw.xml
@@ -29,7 +29,7 @@
-
+
@@ -51,11 +51,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/nav_modules.xml b/conf/flight_plans/nav_modules.xml
index c7bf897187..d8f521d0a7 100644
--- a/conf/flight_plans/nav_modules.xml
+++ b/conf/flight_plans/nav_modules.xml
@@ -62,7 +62,7 @@
-
+
@@ -147,11 +147,11 @@
-
-
+
+
-
+
diff --git a/conf/flight_plans/quadshot_delft.xml b/conf/flight_plans/quadshot_delft.xml
index 402219d42b..cc947f235e 100644
--- a/conf/flight_plans/quadshot_delft.xml
+++ b/conf/flight_plans/quadshot_delft.xml
@@ -35,35 +35,35 @@
-
+
-
+
-
+
-
+
-
+
-
+
@@ -72,7 +72,7 @@
-
+
@@ -90,15 +90,15 @@
-
+
-
+
-
+
diff --git a/conf/flight_plans/rotorcraft_basic.xml b/conf/flight_plans/rotorcraft_basic.xml
index 31c0d43489..b5316f987b 100644
--- a/conf/flight_plans/rotorcraft_basic.xml
+++ b/conf/flight_plans/rotorcraft_basic.xml
@@ -67,7 +67,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_basic_geofence.xml b/conf/flight_plans/rotorcraft_basic_geofence.xml
index 230152a457..4235c2b986 100644
--- a/conf/flight_plans/rotorcraft_basic_geofence.xml
+++ b/conf/flight_plans/rotorcraft_basic_geofence.xml
@@ -58,7 +58,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_basic_safety.xml b/conf/flight_plans/rotorcraft_basic_safety.xml
index 1685109831..8102a080db 100644
--- a/conf/flight_plans/rotorcraft_basic_safety.xml
+++ b/conf/flight_plans/rotorcraft_basic_safety.xml
@@ -39,7 +39,7 @@
-
+
@@ -60,7 +60,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_basic_superbitrf.xml b/conf/flight_plans/rotorcraft_basic_superbitrf.xml
index 5f748f86c1..bc25136a04 100644
--- a/conf/flight_plans/rotorcraft_basic_superbitrf.xml
+++ b/conf/flight_plans/rotorcraft_basic_superbitrf.xml
@@ -39,16 +39,16 @@
-
+
-
+
-
+
-
+
@@ -65,7 +65,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_basic_superbitrf_from_hand.xml b/conf/flight_plans/rotorcraft_basic_superbitrf_from_hand.xml
index d60a351a8c..3effb9c820 100644
--- a/conf/flight_plans/rotorcraft_basic_superbitrf_from_hand.xml
+++ b/conf/flight_plans/rotorcraft_basic_superbitrf_from_hand.xml
@@ -46,17 +46,17 @@ The goal of this flightplan is to have a safe, simple no-brainer flightplan for
-
+
-
-
+
+
+ -->
-
+
@@ -69,23 +69,23 @@ The goal of this flightplan is to have a safe, simple no-brainer flightplan for
-
+
-
+
-
+
-
-
-
+
+
+
-
+
@@ -127,7 +127,7 @@ The goal of this flightplan is to have a safe, simple no-brainer flightplan for
-
+
diff --git a/conf/flight_plans/rotorcraft_cam.xml b/conf/flight_plans/rotorcraft_cam.xml
index 6c63833a26..98c9c6180e 100644
--- a/conf/flight_plans/rotorcraft_cam.xml
+++ b/conf/flight_plans/rotorcraft_cam.xml
@@ -33,7 +33,7 @@
-
+
@@ -67,7 +67,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_guided_flightplan.xml b/conf/flight_plans/rotorcraft_guided_flightplan.xml
index 9af756e075..0a169007a6 100644
--- a/conf/flight_plans/rotorcraft_guided_flightplan.xml
+++ b/conf/flight_plans/rotorcraft_guided_flightplan.xml
@@ -68,7 +68,7 @@ Remember to choose AP_MODE_GUIDED or else it won't work!!!
-
+
@@ -115,7 +115,7 @@ NOTE: A velocity forcefield in the horizontal plane applied here, so if an obsta
-
+
diff --git a/conf/flight_plans/rotorcraft_guido_optitrack.xml b/conf/flight_plans/rotorcraft_guido_optitrack.xml
index 57f3a51991..233a42d854 100644
--- a/conf/flight_plans/rotorcraft_guido_optitrack.xml
+++ b/conf/flight_plans/rotorcraft_guido_optitrack.xml
@@ -42,7 +42,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_joystick_enac.xml b/conf/flight_plans/rotorcraft_joystick_enac.xml
index dfc02ac3f4..b8b7b06973 100644
--- a/conf/flight_plans/rotorcraft_joystick_enac.xml
+++ b/conf/flight_plans/rotorcraft_joystick_enac.xml
@@ -65,7 +65,7 @@ static inline void joystick_handler(uint8_t sender_id __attribute__((unused)), i
-
+
diff --git a/conf/flight_plans/rotorcraft_optitrack.xml b/conf/flight_plans/rotorcraft_optitrack.xml
index 2b155c93be..29a2b47723 100644
--- a/conf/flight_plans/rotorcraft_optitrack.xml
+++ b/conf/flight_plans/rotorcraft_optitrack.xml
@@ -41,7 +41,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_optitrack_stereoavoid.xml b/conf/flight_plans/rotorcraft_optitrack_stereoavoid.xml
index 18488084ce..83a6ffc990 100644
--- a/conf/flight_plans/rotorcraft_optitrack_stereoavoid.xml
+++ b/conf/flight_plans/rotorcraft_optitrack_stereoavoid.xml
@@ -45,10 +45,10 @@
-
+
-
+
@@ -63,7 +63,7 @@
-
+
@@ -107,7 +107,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_survey.xml b/conf/flight_plans/rotorcraft_survey.xml
index 54b738f6ec..e658631928 100644
--- a/conf/flight_plans/rotorcraft_survey.xml
+++ b/conf/flight_plans/rotorcraft_survey.xml
@@ -40,7 +40,7 @@
-
+
@@ -80,7 +80,7 @@
-
+
diff --git a/conf/flight_plans/rotorcraft_vision.xml b/conf/flight_plans/rotorcraft_vision.xml
index fab83eb5f1..670dba11c5 100644
--- a/conf/flight_plans/rotorcraft_vision.xml
+++ b/conf/flight_plans/rotorcraft_vision.xml
@@ -10,7 +10,7 @@
-
+
diff --git a/conf/flight_plans/tcas.xml b/conf/flight_plans/tcas.xml
index adfeb10824..7325bb5363 100644
--- a/conf/flight_plans/tcas.xml
+++ b/conf/flight_plans/tcas.xml
@@ -33,7 +33,7 @@
-
+
@@ -53,7 +53,7 @@
-
+
@@ -70,11 +70,11 @@
-
-
+
+
-
+
@@ -83,7 +83,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/course_orangeavoid_cyberzoo.xml b/conf/flight_plans/tudelft/course_orangeavoid_cyberzoo.xml
index 2ea24e6b2e..5110fd89cc 100644
--- a/conf/flight_plans/tudelft/course_orangeavoid_cyberzoo.xml
+++ b/conf/flight_plans/tudelft/course_orangeavoid_cyberzoo.xml
@@ -41,38 +41,38 @@
-
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
-
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
@@ -94,7 +94,7 @@
-
+
@@ -122,7 +122,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/course_orangeavoid_cyberzoo_guided.xml b/conf/flight_plans/tudelft/course_orangeavoid_cyberzoo_guided.xml
index 0909b8212a..9b3cbc8ee3 100644
--- a/conf/flight_plans/tudelft/course_orangeavoid_cyberzoo_guided.xml
+++ b/conf/flight_plans/tudelft/course_orangeavoid_cyberzoo_guided.xml
@@ -49,38 +49,38 @@ inline void setGuided(void){
-
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
-
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
@@ -102,7 +102,7 @@ inline void setGuided(void){
-
+
@@ -133,7 +133,7 @@ inline void setGuided(void){
-
+
diff --git a/conf/flight_plans/tudelft/cyclone_valkenburg.xml b/conf/flight_plans/tudelft/cyclone_valkenburg.xml
index 8bba129774..e7a56fd568 100644
--- a/conf/flight_plans/tudelft/cyclone_valkenburg.xml
+++ b/conf/flight_plans/tudelft/cyclone_valkenburg.xml
@@ -32,7 +32,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/delfly_nimble_cyberzoo.xml b/conf/flight_plans/tudelft/delfly_nimble_cyberzoo.xml
index 4dcea07b95..ea7fae38f9 100644
--- a/conf/flight_plans/tudelft/delfly_nimble_cyberzoo.xml
+++ b/conf/flight_plans/tudelft/delfly_nimble_cyberzoo.xml
@@ -41,7 +41,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/delft_basic.xml b/conf/flight_plans/tudelft/delft_basic.xml
index 17ce8d07f3..54d78620cf 100644
--- a/conf/flight_plans/tudelft/delft_basic.xml
+++ b/conf/flight_plans/tudelft/delft_basic.xml
@@ -20,9 +20,9 @@
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="ComeBackAndLand"/>
@@ -32,20 +32,20 @@
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="DatalinkLoss"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="ComeBackAndLand"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
@@ -67,7 +67,7 @@
-
+
@@ -97,7 +97,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/delft_bebop.xml b/conf/flight_plans/tudelft/delft_bebop.xml
index 9c1b4181ed..4fb6a03207 100644
--- a/conf/flight_plans/tudelft/delft_bebop.xml
+++ b/conf/flight_plans/tudelft/delft_bebop.xml
@@ -32,22 +32,22 @@
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="descend att 0"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="ComeBackAndLand"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="ComeBackAndLand"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
@@ -68,7 +68,7 @@
-
+
@@ -98,7 +98,7 @@
-
+
@@ -125,7 +125,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/fan_demo.xml b/conf/flight_plans/tudelft/fan_demo.xml
index 7b7484fd1d..75b5e0be2a 100644
--- a/conf/flight_plans/tudelft/fan_demo.xml
+++ b/conf/flight_plans/tudelft/fan_demo.xml
@@ -39,7 +39,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/include_rotorcraft_survey_mission.xml b/conf/flight_plans/tudelft/include_rotorcraft_survey_mission.xml
index 183e13f8fe..71f7f887ca 100644
--- a/conf/flight_plans/tudelft/include_rotorcraft_survey_mission.xml
+++ b/conf/flight_plans/tudelft/include_rotorcraft_survey_mission.xml
@@ -25,9 +25,9 @@
-
-
-
+
+
+
@@ -52,22 +52,22 @@
-
+
-
+
-
+
-
+
@@ -82,24 +82,24 @@
-
+
-
+
-
+
-
+
@@ -107,7 +107,7 @@
-
+
@@ -138,37 +138,37 @@
-
+
-
+
-
+
-
+
-
+
-
+
-
+
-
+
-
+
-
+
diff --git a/conf/flight_plans/tudelft/mavtec_outdoor_demo.xml b/conf/flight_plans/tudelft/mavtec_outdoor_demo.xml
index afe6cc250d..1ab7b2841e 100644
--- a/conf/flight_plans/tudelft/mavtec_outdoor_demo.xml
+++ b/conf/flight_plans/tudelft/mavtec_outdoor_demo.xml
@@ -34,7 +34,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/nederdrone_valkenburg.xml b/conf/flight_plans/tudelft/nederdrone_valkenburg.xml
index 88791087b6..6f2a4cc812 100644
--- a/conf/flight_plans/tudelft/nederdrone_valkenburg.xml
+++ b/conf/flight_plans/tudelft/nederdrone_valkenburg.xml
@@ -47,8 +47,8 @@
-
-
+
+
@@ -70,12 +70,12 @@
-
+
-
+
@@ -142,7 +142,7 @@
-
+
@@ -160,7 +160,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/ralphthesis2020_stereo_cyberzoo.xml b/conf/flight_plans/tudelft/ralphthesis2020_stereo_cyberzoo.xml
index dd9d7f899e..750ddab055 100644
--- a/conf/flight_plans/tudelft/ralphthesis2020_stereo_cyberzoo.xml
+++ b/conf/flight_plans/tudelft/ralphthesis2020_stereo_cyberzoo.xml
@@ -72,38 +72,38 @@ inline void setGuided(void){
-
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
-
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
- = IndexOfBlock('land here')) @AND
(autopilot_in_flight() == true) )" deroute="land here"/>
@@ -130,7 +130,7 @@ inline void setGuided(void){
-
+
@@ -185,7 +185,7 @@ inline void setGuided(void){
-
+
diff --git a/conf/flight_plans/tudelft/rotorcraft_autonomous_drone_race.xml b/conf/flight_plans/tudelft/rotorcraft_autonomous_drone_race.xml
index e511eb37f3..b68c497b24 100644
--- a/conf/flight_plans/tudelft/rotorcraft_autonomous_drone_race.xml
+++ b/conf/flight_plans/tudelft/rotorcraft_autonomous_drone_race.xml
@@ -62,7 +62,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/rotorcraft_cyberzoo_no_gps.xml b/conf/flight_plans/tudelft/rotorcraft_cyberzoo_no_gps.xml
index 0981593c55..3ccfe46063 100644
--- a/conf/flight_plans/tudelft/rotorcraft_cyberzoo_no_gps.xml
+++ b/conf/flight_plans/tudelft/rotorcraft_cyberzoo_no_gps.xml
@@ -37,7 +37,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/rotorcraft_optitrack_path.xml b/conf/flight_plans/tudelft/rotorcraft_optitrack_path.xml
index 56c1622556..351be4873f 100644
--- a/conf/flight_plans/tudelft/rotorcraft_optitrack_path.xml
+++ b/conf/flight_plans/tudelft/rotorcraft_optitrack_path.xml
@@ -60,7 +60,7 @@
-
+
diff --git a/conf/flight_plans/tudelft/train_safe_zoo.xml b/conf/flight_plans/tudelft/train_safe_zoo.xml
index 942751d0ad..d6d6bd4564 100644
--- a/conf/flight_plans/tudelft/train_safe_zoo.xml
+++ b/conf/flight_plans/tudelft/train_safe_zoo.xml
@@ -36,7 +36,7 @@
-
+
@@ -57,7 +57,7 @@
-
+
@@ -83,13 +83,13 @@
-
+
-
+
diff --git a/conf/flight_plans/versatile.xml b/conf/flight_plans/versatile.xml
index 4cec503654..b616ede72a 100644
--- a/conf/flight_plans/versatile.xml
+++ b/conf/flight_plans/versatile.xml
@@ -48,7 +48,7 @@
-
+
@@ -73,25 +73,25 @@
-
+
-
+
-
+
-
+
-
+
-
+
@@ -125,12 +125,12 @@
-
+
-
+
-
+
@@ -139,26 +139,26 @@
-
-
+
+
-
-
+
+
-
-
+
+
-
-
+
+
@@ -166,12 +166,12 @@
-
+
-
+
diff --git a/conf/flight_plans/versatile_airspeed.xml b/conf/flight_plans/versatile_airspeed.xml
index 2966b053e8..e2fbe7856b 100644
--- a/conf/flight_plans/versatile_airspeed.xml
+++ b/conf/flight_plans/versatile_airspeed.xml
@@ -45,7 +45,7 @@
-
+
@@ -69,25 +69,25 @@
-
+
-
+
-
+
-
+
-
+
-
+
@@ -132,9 +132,9 @@
-
+
-
+
@@ -146,20 +146,20 @@
-
-
+
+
-
-
+
+
-
-
+
+
@@ -167,12 +167,12 @@
-
+
-
+
diff --git a/conf/flight_plans/zamboni_survey_test.xml b/conf/flight_plans/zamboni_survey_test.xml
index 4044fbe3a0..ff513e5cec 100644
--- a/conf/flight_plans/zamboni_survey_test.xml
+++ b/conf/flight_plans/zamboni_survey_test.xml
@@ -34,7 +34,7 @@
-
+
@@ -61,11 +61,11 @@
-
-
+
+
-
+
diff --git a/sw/airborne/firmwares/fixedwing/nav.h b/sw/airborne/firmwares/fixedwing/nav.h
index f5619cfdd7..fe72b9873b 100644
--- a/sw/airborne/firmwares/fixedwing/nav.h
+++ b/sw/airborne/firmwares/fixedwing/nav.h
@@ -226,6 +226,8 @@ bool nav_approaching_xy(float x, float y, float from_x, float from_y, float appr
#define GetPosY() (stateGetPositionEnu_f()->y)
/// Get current altitude above MSL
#define GetPosAlt() (stateGetPositionUtm_f()->alt)
+/// Get current height above reference
+#define GetPosHeight() (stateGetPositionEnu_f()->z)
/**
* Get current altitude reference for local coordinates.
* This is the ground_alt from the flight plan at first,
diff --git a/sw/airborne/firmwares/rotorcraft/navigation.h b/sw/airborne/firmwares/rotorcraft/navigation.h
index 425d43a094..24c3b094e2 100644
--- a/sw/airborne/firmwares/rotorcraft/navigation.h
+++ b/sw/airborne/firmwares/rotorcraft/navigation.h
@@ -93,6 +93,8 @@ extern bool exception_flag[10];
#define GetPosY() (stateGetPositionEnu_f()->y)
/// Get current altitude above MSL
#define GetPosAlt() (stateGetPositionEnu_f()->z+state.ned_origin_f.hmsl)
+/// Get current height above reference
+#define GetPosHeight() (stateGetPositionEnu_f()->z)
/**
* Get current altitude reference for local coordinates.
* This is the ground_alt from the flight plan at first,
diff --git a/sw/airborne/firmwares/rover/navigation.h b/sw/airborne/firmwares/rover/navigation.h
index bf4f58894b..c40a0b61bd 100644
--- a/sw/airborne/firmwares/rover/navigation.h
+++ b/sw/airborne/firmwares/rover/navigation.h
@@ -131,6 +131,8 @@ extern void nav_register_oval(nav_rover_oval_init nav_oval_init, nav_rover_oval
#define GetPosY() (stateGetPositionEnu_f()->y)
/// Get current altitude above MSL
#define GetPosAlt() (stateGetPositionEnu_f()->z+state.ned_origin_f.hmsl)
+/// Get current height above reference
+#define GetPosHeight() (stateGetPositionEnu_f()->z)
/**
* Get current altitude reference for local coordinates.
* This is the ground_alt from the flight plan at first,