diff --git a/conf/flight_plans/form_follow.xml b/conf/flight_plans/form_follow.xml
index e099ed0359..010cbc178d 100644
--- a/conf/flight_plans/form_follow.xml
+++ b/conf/flight_plans/form_follow.xml
@@ -1,9 +1,6 @@
 <!DOCTYPE flight_plan SYSTEM "flight_plan.dtd">
 
 <flight_plan alt="250" ground_alt="185" lat0="43.46223" lon0="1.27289" max_dist_from_home="400" name="test laas" qfu="270" security_height="25">
-  <header>
-#include "formation.h"
-  </header>
   <waypoints>
     <waypoint alt="250" name="HOME" x="0.0" y="0.0"/>
     <waypoint alt="215.0" name="IAF" x="239.7" y="92.9"/>
diff --git a/conf/flight_plans/form_leader.xml b/conf/flight_plans/form_leader.xml
index 40cea46b05..c22cbf6813 100644
--- a/conf/flight_plans/form_leader.xml
+++ b/conf/flight_plans/form_leader.xml
@@ -1,9 +1,6 @@
 <!DOCTYPE flight_plan SYSTEM "flight_plan.dtd">
 
 <flight_plan alt="250" ground_alt="185" lat0="43.46223" lon0="1.27289" max_dist_from_home="400" name="formation flight" qfu="270" security_height="25">
-  <header>
-#include "formation.h"
-  </header>
   <waypoints>
     <waypoint name="HOME" x="0.0" y="0.0"/>
     <waypoint name="mid" x="72.9" y="133.0"/>
diff --git a/sw/tools/gen_flight_plan.ml b/sw/tools/gen_flight_plan.ml
index a5fe2a77c3..ddd78ae5bd 100644
--- a/sw/tools/gen_flight_plan.ml
+++ b/sw/tools/gen_flight_plan.ml
@@ -713,6 +713,9 @@ let () =
       printf "\n";
       
       printf "#include \"std.h\"\n";
+      printf "#ifdef USE_MODULES\n";
+      printf "#include \"modules.h\"\n";
+      printf "#endif\n";
 
       begin
 	try