[paparazzi-commits] [4061] handle fms datalink commands

[Gautier Hattenberger]

Revision: 4061
          http://svn.sv.gnu.org/viewvc/?view=rev&root=paparazzi&revision=4061
Author:   gautier
Date:     2009-09-03 11:20:20 +0000 (Thu, 03 Sep 2009)
Log Message:
-----------
handle fms datalink commands

Modified Paths:
--------------
    paparazzi3/trunk/sw/airborne/booz/fms/booz_fms_datalink.c
    paparazzi3/trunk/sw/airborne/booz/fms/booz_fms_datalink.h

Modified: paparazzi3/trunk/sw/airborne/booz/fms/booz_fms_datalink.c
===================================================================
--- paparazzi3/trunk/sw/airborne/booz/fms/booz_fms_datalink.c   2009-09-03 
11:18:02 UTC (rev 4060)
+++ paparazzi3/trunk/sw/airborne/booz/fms/booz_fms_datalink.c   2009-09-03 
11:20:20 UTC (rev 4061)
@@ -21,12 +21,13 @@
  * Boston, MA 02111-1307, USA. 
  */
 
-#include "booz2_fms.h"
+#include "booz_fms.h"
 
 void booz_fms_impl_init(void) {
-
 }
 
 void booz_fms_impl_periodic(void) {
+}
 
+void booz_fms_impl_set_enabled(bool_t enabled) {
 }

Modified: paparazzi3/trunk/sw/airborne/booz/fms/booz_fms_datalink.h
===================================================================
--- paparazzi3/trunk/sw/airborne/booz/fms/booz_fms_datalink.h   2009-09-03 
11:18:02 UTC (rev 4060)
+++ paparazzi3/trunk/sw/airborne/booz/fms/booz_fms_datalink.h   2009-09-03 
11:20:20 UTC (rev 4061)
@@ -22,10 +22,7 @@
 #ifndef BOOZ2_FMS_DATALINK_H
 #define BOOZ2_FMS_DATALINK_H
 
-extern void booz_fms_impl_init(void);
-extern void booz_fms_impl_periodic(void);
 
-
 #ifdef BOOZ_FMS_PHI_THETA_MAX
 #define BOOZ_FMS_LIMIT_ATTITUDE(_fms_att) { \
   BoundAbs(_fms_att.phi,BOOZ_FMS_PHI_THETA_MAX); \
@@ -48,6 +45,7 @@
          booz_fms_input.h_sp.attitude.phi   = 
DL_BOOZ2_FMS_COMMAND_h_sp_1(_dl_buffer);                 \
          booz_fms_input.h_sp.attitude.theta = 
DL_BOOZ2_FMS_COMMAND_h_sp_2(_dl_buffer);                 \
          booz_fms_input.h_sp.attitude.psi   = 
DL_BOOZ2_FMS_COMMAND_h_sp_3(_dl_buffer);                 \
+        ANGLE_REF_NORMALIZE(booz_fms_input.h_sp.attitude.psi); \
         BOOZ_FMS_LIMIT_ATTITUDE(booz_fms_input.h_sp.attitude); \
       }                                                                        
\
       break;  \