paparazzi-commits
[Top][All Lists]
Advanced

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

[paparazzi-commits] [5376] fixed headers


From: antoine drouin
Subject: [paparazzi-commits] [5376] fixed headers
Date: Sun, 15 Aug 2010 16:25:12 +0000

Revision: 5376
          http://svn.sv.gnu.org/viewvc/?view=rev&root=paparazzi&revision=5376
Author:   poine
Date:     2010-08-15 16:25:12 +0000 (Sun, 15 Aug 2010)
Log Message:
-----------
fixed headers

Modified Paths:
--------------
    paparazzi3/trunk/sw/airborne/lisa/lisa_stm_passthrough_main.c

Modified: paparazzi3/trunk/sw/airborne/lisa/lisa_stm_passthrough_main.c
===================================================================
--- paparazzi3/trunk/sw/airborne/lisa/lisa_stm_passthrough_main.c       
2010-08-15 16:00:25 UTC (rev 5375)
+++ paparazzi3/trunk/sw/airborne/lisa/lisa_stm_passthrough_main.c       
2010-08-15 16:25:12 UTC (rev 5376)
@@ -1,7 +1,7 @@
 /*
  * $Id$
  *
- * Copyright (C) 2010 Piotr Esden-Tempski <address@hidden>
+ * Copyright (C) 2010 The Paparazzi Team
  *
  * This file is part of paparazzi.
  *
@@ -27,8 +27,8 @@
 #include "booz/booz2_commands.h"
 #include "booz/booz_actuators.h"
 #include "booz/booz_imu.h"
-#include "booz_radio_control.h"
-#include "actuators/booz_actuators_pwm.h"
+#include "booz/booz_radio_control.h"
+#include "booz/actuators/booz_actuators_pwm.h"
 #include "lisa/lisa_overo_link.h"
 
 static inline void main_init(void);
@@ -61,17 +61,18 @@
 
 static inline void main_init(void) {
 
-       hw_init();
-       sys_time_init();
-       booz_imu_init();
-       radio_control_init();
-       booz_actuators_pwm_hw_init();
-       overo_link_init();
-       new_radio_msg = FALSE;
+  hw_init();
+  sys_time_init();
+  booz_imu_init();
+  radio_control_init();
+  booz_actuators_pwm_hw_init();
+  overo_link_init();
+  new_radio_msg = FALSE;
+
 }
 
 static inline void main_periodic(void) {
-
+  
   booz_imu_periodic();
   OveroLinkPeriodic(on_overo_link_lost);
   RunOnceEvery(10, {
@@ -83,11 +84,11 @@
 }
 
 static inline void main_event(void) {
+  
+  BoozImuEvent(on_gyro_accel_event, on_mag_event);
+  OveroLinkEvent(on_overo_link_msg_received, on_overo_link_crc_failed);
+  RadioControlEvent(on_rc_message);
 
-       BoozImuEvent(on_gyro_accel_event, on_mag_event);
-       OveroLinkEvent(on_overo_link_msg_received, on_overo_link_crc_failed);
-       RadioControlEvent(on_rc_message);
-
 }
 
 static inline void on_rc_message(void) {
@@ -96,35 +97,38 @@
 
 static inline void on_overo_link_msg_received(void) {
 
-       if (new_radio_msg) overo_link.up.msg.valid.rc = 1;
-       else overo_link.up.msg.valid.rc = 0;
-        new_radio_msg = FALSE;
-
-       overo_link.up.msg.valid.imu = 1;
-
-       RATES_COPY(overo_link.up.msg.gyro, booz_imu.gyro);
-
-       VECT3_COPY(overo_link.up.msg.accel, booz_imu.accel);
-
-       VECT3_COPY(overo_link.up.msg.mag, booz_imu.mag);
-
-       overo_link.up.msg.rc_pitch = radio_control.values[RADIO_CONTROL_PITCH];
-       overo_link.up.msg.rc_roll = radio_control.values[RADIO_CONTROL_ROLL];
-       overo_link.up.msg.rc_yaw = radio_control.values[RADIO_CONTROL_YAW];
-       overo_link.up.msg.rc_thrust = 
radio_control.values[RADIO_CONTROL_THROTTLE];
-       overo_link.up.msg.rc_mode = radio_control.values[RADIO_CONTROL_MODE];
-       overo_link.up.msg.rc_kill = radio_control.values[RADIO_CONTROL_KILL];
-       overo_link.up.msg.rc_gear = radio_control.values[RADIO_CONTROL_GEAR];
-       overo_link.up.msg.rc_aux3 = radio_control.values[RADIO_CONTROL_AUX3];
-       overo_link.up.msg.rc_aux4 = radio_control.values[RADIO_CONTROL_AUX4];
-       overo_link.up.msg.rc_status = radio_control.status;
-
-       overo_link.up.msg.stm_msg_cnt = overo_link.msg_cnt;
-       overo_link.up.msg.stm_crc_err_cnt = overo_link.crc_err_cnt;
-
-       for (int i = 0; i < LISA_PWM_OUTPUT_NB; i++)
-         booz_actuators_pwm_values[i] = 
overo_link.down.msg.pwm_outputs_usecs[i];
-       booz_actuators_pwm_commit();
+  overo_link.up.msg.valid.rc = new_radio_msg;
+  new_radio_msg = FALSE;
+  
+  overo_link.up.msg.valid.imu = 1;
+  
+  RATES_COPY(overo_link.up.msg.gyro, booz_imu.gyro);
+  
+  VECT3_COPY(overo_link.up.msg.accel, booz_imu.accel);
+  
+  VECT3_COPY(overo_link.up.msg.mag, booz_imu.mag);
+  
+  overo_link.up.msg.rc_pitch = radio_control.values[RADIO_CONTROL_PITCH];
+  overo_link.up.msg.rc_roll = radio_control.values[RADIO_CONTROL_ROLL];
+  overo_link.up.msg.rc_yaw = radio_control.values[RADIO_CONTROL_YAW];
+  overo_link.up.msg.rc_thrust = radio_control.values[RADIO_CONTROL_THROTTLE];
+  overo_link.up.msg.rc_mode = radio_control.values[RADIO_CONTROL_MODE];
+#ifdef RADIO_CONTROL_KILL
+  overo_link.up.msg.rc_kill = radio_control.values[RADIO_CONTROL_KILL];
+#endif
+#ifdef RADIO_CONTROL_GEAR
+  overo_link.up.msg.rc_gear = radio_control.values[RADIO_CONTROL_GEAR];
+#endif
+  overo_link.up.msg.rc_aux3 = radio_control.values[RADIO_CONTROL_AUX3];
+  overo_link.up.msg.rc_aux4 = radio_control.values[RADIO_CONTROL_AUX4];
+  overo_link.up.msg.rc_status = radio_control.status;
+  
+  overo_link.up.msg.stm_msg_cnt = overo_link.msg_cnt;
+  overo_link.up.msg.stm_crc_err_cnt = overo_link.crc_err_cnt;
+  
+  for (int i = 0; i < LISA_PWM_OUTPUT_NB; i++)
+    booz_actuators_pwm_values[i] = overo_link.down.msg.pwm_outputs_usecs[i];
+  booz_actuators_pwm_commit();
 }
 
 static inline void on_overo_link_lost(void) {




reply via email to

[Prev in Thread] Current Thread [Next in Thread]