Skip to content

Commit

Permalink
Final fix to guarantee safety when not using EKF
Browse files Browse the repository at this point in the history
  • Loading branch information
mgreiff committed Dec 1, 2016
1 parent d69fb2f commit b954bf0
Showing 1 changed file with 3 additions and 2 deletions.
5 changes: 3 additions & 2 deletions src/deck/drivers/src/vl53l0x.c
Original file line number Diff line number Diff line change
Expand Up @@ -44,15 +44,16 @@
#include "arm_math.h"

//#define UPDATE_KALMAN_WITH_RANGING // uncomment to push into the kalman
#ifdef UPDATE_KALMAN_WITH_RANGING
#define RANGE_OUTLIER_LIMIT 1500 // the measured range is in [mm]
// Measurement noise model
static float expPointA = 1.0f;
static float expStdA = 0.0025f; // STD at elevation expPointA [m]
static float expPointB = 1.3f;
static float expStdB = 0.2f; // STD at elevation expPointB [m]
static float expCoeff;

#endif
#endif // UPDATE_KALMAN_WITH_RANGING
#endif // ESTIMATOR_TYPE_kalman

static uint8_t devAddr;
static I2C_Dev *I2Cx;
Expand Down

0 comments on commit b954bf0

Please sign in to comment.