Merge pull request #513 from paparazzi/ins_propagate_freq

[rotorcraft] INS_PROPAGATE_FREQUENCY for vff

conf/firmwares/subsystems/rotorcraft/ins.makefile

@@ -8,5 +8,5 @@ $(TARGET).srcs += $(SRC_SUBSYSTEMS)/ins/ins_int.c
 
 #  vertical filter float version
 $(TARGET).srcs += $(SRC_SUBSYSTEMS)/ins/vf_float.c
-$(TARGET).CFLAGS += -DUSE_VFF -DDT_VFILTER='(1./$(PERIODIC_FREQUENCY).)'
+$(TARGET).CFLAGS += -DUSE_VFF
 

conf/firmwares/subsystems/rotorcraft/ins_extended.makefile

@@ -8,5 +8,5 @@ $(TARGET).srcs += $(SRC_SUBSYSTEMS)/ins/ins_int_extended.c
 
 #  vertical filter float version
 $(TARGET).srcs += $(SRC_SUBSYSTEMS)/ins/vf_extended_float.c
-$(TARGET).CFLAGS += -DUSE_VFF_EXTENDED -DDT_VFILTER='(1./$(PERIODIC_FREQUENCY).)'
+$(TARGET).CFLAGS += -DUSE_VFF_EXTENDED
 

sw/airborne/subsystems/ins/vf_extended_float.c

@@ -30,6 +30,7 @@
  */
 
 #include "subsystems/ins/vf_extended_float.h"
+#include "generated/airframe.h"
 
 #define DEBUG_VFF_EXTENDED 1
 
@@ -39,6 +40,14 @@
 #include "subsystems/datalink/downlink.h"
 #endif
 
+#ifndef INS_PROPAGATE_FREQUENCY
+#define INS_PROPAGATE_FREQUENCY PERIODIC_FREQUENCY
+#endif
+PRINT_CONFIG_VAR(INS_PROPAGATE_FREQUENCY)
+
+#define DT_VFILTER (1./(INS_PROPAGATE_FREQUENCY))
+
+
 /*
 
 X = [ z zdot accel_bias baro_offset ]

sw/airborne/subsystems/ins/vf_float.c

@@ -27,6 +27,14 @@
  */
 
 #include "subsystems/ins/vf_float.h"
+#include "generated/airframe.h"
+
+#ifndef INS_PROPAGATE_FREQUENCY
+#define INS_PROPAGATE_FREQUENCY PERIODIC_FREQUENCY
+#endif
+PRINT_CONFIG_VAR(INS_PROPAGATE_FREQUENCY)
+
+#define DT_VFILTER (1./(INS_PROPAGATE_FREQUENCY))
 
 /*