[paparazzi-commits] [5220] add parsing of NAV_STICK message

[Gautier Hattenberger]

Revision: 5220
          http://svn.sv.gnu.org/viewvc/?view=rev&root=paparazzi&revision=5220
Author:   gautier
Date:     2010-08-04 17:33:58 +0000 (Wed, 04 Aug 2010)
Log Message:
-----------
add parsing of NAV_STICK message
fix datalink parsing for modules

Modified Paths:
--------------
    paparazzi3/trunk/sw/airborne/booz/booz2_datalink.c

Modified: paparazzi3/trunk/sw/airborne/booz/booz2_datalink.c
===================================================================
--- paparazzi3/trunk/sw/airborne/booz/booz2_datalink.c  2010-08-04 17:32:07 UTC 
(rev 5219)
+++ paparazzi3/trunk/sw/airborne/booz/booz2_datalink.c  2010-08-04 17:33:58 UTC 
(rev 5220)
@@ -25,6 +25,7 @@
 #define MODULES_DATALINK_C
 
 #include "datalink.h"
+
 #ifdef USE_MODULES
 #include "modules.h"
 #endif
@@ -85,6 +86,12 @@
       BOOZ_FMS_PARSE_DATALINK(dl_buffer);
     }
     break;
+  case DL_BOOZ_NAV_STICK :
+    {
+      if (DL_BOOZ_NAV_STICK_ac_id(dl_buffer) != AC_ID) break;
+      BOOZ_FMS_NAV_STICK_PARSE_DL(dl_buffer);
+    }
+    break;
 #endif
 #if defined USE_NAVIGATION
   case DL_BLOCK :
@@ -113,11 +120,11 @@
     }
     break;
 #endif /* USE_NAVIGATION */
-#ifdef USE_MODULES
-    /* Parse modules datalink */
-    modules_parse_datalink(msg_id);
-#endif
   default:
     break;
   }
+#ifdef USE_MODULES
+  /* Parse modules datalink */
+  modules_parse_datalink(msg_id);
+#endif
 }