execute telemetryPeriodic later so modem does not hang up on startup

This commit is contained in:
Felix Ruess
2010-06-20 18:04:42 +00:00
parent 588f68eb9f
commit 9bf16e8193
+5 -6
View File
@@ -136,9 +136,8 @@ STATIC_INLINE void booz2_main_init( void ) {
STATIC_INLINE void booz2_main_periodic( void ) {
booz_imu_periodic();
/* run control loops */
booz2_autopilot_periodic();
/* set actuators */
@@ -152,9 +151,6 @@ STATIC_INLINE void booz2_main_periodic( void ) {
booz2_autopilot_mode != BOOZ2_AP_MODE_NAV) \
booz2_autopilot_set_mode(BOOZ2_AP_MODE_FAILSAFE); \
}, \
{ \
Booz2TelemetryPeriodic(); \
}, \
{ \
booz_fms_periodic(); \
}, \
@@ -168,7 +164,10 @@ STATIC_INLINE void booz2_main_periodic( void ) {
{}, \
{}, \
{}, \
{} \
{}, \
{ \
Booz2TelemetryPeriodic(); \
} \
); \
#ifdef USE_GPS