diff --git a/conf/flight_plans/versatile.xml b/conf/flight_plans/versatile.xml
index 42b948c1bd..c5d5e9becc 100644
--- a/conf/flight_plans/versatile.xml
+++ b/conf/flight_plans/versatile.xml
@@ -76,10 +76,18 @@
-
-
+
+
+
+
+
+
+
+
+
+
diff --git a/conf/settings/tuning.xml b/conf/settings/tuning.xml
index a2d34f53f1..9c45abcb3b 100644
--- a/conf/settings/tuning.xml
+++ b/conf/settings/tuning.xml
@@ -93,6 +93,7 @@
+
diff --git a/sw/airborne/nav.c b/sw/airborne/nav.c
index fab8b096f0..06b32c044f 100644
--- a/sw/airborne/nav.c
+++ b/sw/airborne/nav.c
@@ -272,7 +272,8 @@ static inline void nav_follow(uint8_t _ac_id, float _distance, float _height) {
float nav_altitude = GROUND_ALT + MIN_HEIGHT_CARROT;
float desired_x, desired_y;
pprz_t nav_throttle_setpoint;
-float nav_pitch;
+float nav_pitch; /* Rad */
+float fp_pitch; /* deg */
/** \brief Decide if the UAV is approaching the current waypoint.
diff --git a/sw/airborne/nav.h b/sw/airborne/nav.h
index dfc20a22ce..d5acdb1b00 100644
--- a/sw/airborne/nav.h
+++ b/sw/airborne/nav.h
@@ -50,7 +50,9 @@ extern float last_x, last_y;
extern float desired_x, desired_y, nav_altitude, flight_altitude, nav_glide_pitch_trim;
extern pprz_t nav_throttle_setpoint;
-extern float nav_pitch, rc_pitch;
+extern float nav_pitch; /* Rad */
+extern float rc_pitch;
+extern float fp_pitch; /* Degrees */
extern float carrot_x, carrot_y;