From ad17b2573b2e6b7ab7bd24a2716db8af2a7d20ca Mon Sep 17 00:00:00 2001
From: Felix Ruess <felix.ruess@gmail.com>
Date: Tue, 2 Sep 2014 19:18:16 +0200
Subject: [PATCH] [rotorcraft] ahrs dt: only calc if USE_AUTO_AHRS_FREQ or
 !defined(AHRS_PROPAGATE_FREQUENCY)

---
 sw/airborne/firmwares/rotorcraft/main.c | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/sw/airborne/firmwares/rotorcraft/main.c b/sw/airborne/firmwares/rotorcraft/main.c
index 9506fe36e1b..4a2a9f63170 100644
--- a/sw/airborne/firmwares/rotorcraft/main.c
+++ b/sw/airborne/firmwares/rotorcraft/main.c
@@ -319,6 +319,8 @@ static inline void on_accel_event( void ) {
 }
 
 static inline void on_gyro_event( void ) {
+#if USE_AUTO_AHRS_FREQ || !defined(AHRS_PROPAGATE_FREQUENCY)
+PRINT_CONFIG_MSG("Calculating dt for AHRS/INS propagation.")
   // timestamp when last callback was received
   static float last_ts = 0.f;
   // current timestamp
@@ -326,6 +328,11 @@ static inline void on_gyro_event( void ) {
   // dt between this and last callback
   float dt = now_ts - last_ts;
   last_ts = now_ts;
+#else
+PRINT_CONFIG_MSG("Using fixed AHRS_PROPAGATE_FREQUENCY for AHRS/INS propagation.")
+PRINT_CONFIG_VAR(AHRS_PROPAGATE_FREQUENCY)
+  const float dt = (1./AHRS_PROPAGATE_FREQUENCY);
+#endif
 
   ImuScaleGyro(imu);