[ahrs] warn if PERIODIC_FREQUENCY is lower than AHRS freqs

This commit is contained in:
Felix Ruess
2013-11-12 15:40:23 +01:00
parent f8334066bb
commit 0c7c09c740
2 changed files with 13 additions and 0 deletions
@@ -127,10 +127,17 @@ PRINT_CONFIG_VAR(MODULES_FREQUENCY)
#define AHRS_PROPAGATE_FREQUENCY PERIODIC_FREQUENCY #define AHRS_PROPAGATE_FREQUENCY PERIODIC_FREQUENCY
#endif #endif
PRINT_CONFIG_VAR(AHRS_PROPAGATE_FREQUENCY) PRINT_CONFIG_VAR(AHRS_PROPAGATE_FREQUENCY)
#if AHRS_PROPAGATE_FREQUENCY > PERIODIC_FREQUENCY
#warning PERIODIC_FREQUENCY should be >= AHRS_PROPAGATE_FREQUENCY
#endif
#ifndef AHRS_CORRECT_FREQUENCY #ifndef AHRS_CORRECT_FREQUENCY
#define AHRS_CORRECT_FREQUENCY PERIODIC_FREQUENCY #define AHRS_CORRECT_FREQUENCY PERIODIC_FREQUENCY
#endif #endif
PRINT_CONFIG_VAR(AHRS_CORRECT_FREQUENCY) PRINT_CONFIG_VAR(AHRS_CORRECT_FREQUENCY)
#if AHRS_CORRECT_FREQUENCY > PERIODIC_FREQUENCY
#warning PERIODIC_FREQUENCY should be >= AHRS_CORRECT_FREQUENCY
#endif
static inline void on_gyro_event( void ); static inline void on_gyro_event( void );
static inline void on_accel_event( void ); static inline void on_accel_event( void );
@@ -60,11 +60,17 @@ PRINT_CONFIG_MSG("LOW PASS FILTER ON GYRO RATES")
#define AHRS_PROPAGATE_FREQUENCY PERIODIC_FREQUENCY #define AHRS_PROPAGATE_FREQUENCY PERIODIC_FREQUENCY
#endif #endif
PRINT_CONFIG_VAR(AHRS_PROPAGATE_FREQUENCY) PRINT_CONFIG_VAR(AHRS_PROPAGATE_FREQUENCY)
#if AHRS_PROPAGATE_FREQUENCY > PERIODIC_FREQUENCY
#warning PERIODIC_FREQUENCY should be >= AHRS_PROPAGATE_FREQUENCY
#endif
#ifndef AHRS_CORRECT_FREQUENCY #ifndef AHRS_CORRECT_FREQUENCY
#define AHRS_CORRECT_FREQUENCY AHRS_PROPAGATE_FREQUENCY #define AHRS_CORRECT_FREQUENCY AHRS_PROPAGATE_FREQUENCY
#endif #endif
PRINT_CONFIG_VAR(AHRS_CORRECT_FREQUENCY) PRINT_CONFIG_VAR(AHRS_CORRECT_FREQUENCY)
#if AHRS_CORRECT_FREQUENCY > PERIODIC_FREQUENCY
#warning PERIODIC_FREQUENCY should be >= AHRS_CORRECT_FREQUENCY
#endif
#ifndef AHRS_MAG_CORRECT_FREQUENCY #ifndef AHRS_MAG_CORRECT_FREQUENCY
#define AHRS_MAG_CORRECT_FREQUENCY 50 #define AHRS_MAG_CORRECT_FREQUENCY 50