[rotorcraft] INS_PROPAGATE_FREQUENCY for vff

- defaults to 1/PERIODIC_FREQUENCY
- should be the frequency of new accel measurements
This commit is contained in:
Felix Ruess
2013-08-28 14:06:16 +02:00
parent 446c7f1f2e
commit 7344099703
4 changed files with 19 additions and 2 deletions
@@ -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
@@ -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
@@ -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 ]
+8
View File
@@ -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))
/*