Skip to content
Snippets Groups Projects
Commit d53c5319 authored by ChristophTobler's avatar ChristophTobler Committed by Lorenz Meier
Browse files

mpu9250 wrapper: set autopublish rate

before it didn't integrate IMU values and HIGHRES_IMU was using the filtered values
parent 47e5382e
No related branches found
No related tags found
No related merge requests found
...@@ -69,15 +69,14 @@ ...@@ -69,15 +69,14 @@
#include <mpu9250/MPU9250.hpp> #include <mpu9250/MPU9250.hpp>
#include <DevMgr.hpp> #include <DevMgr.hpp>
// We don't want to auto publish, therefore set this to 0.
#define MPU9250_NEVER_AUTOPUBLISH_US 0
#define MPU9250_ACCEL_DEFAULT_RATE 1000 #define MPU9250_ACCEL_DEFAULT_RATE 1000
#define MPU9250_GYRO_DEFAULT_RATE 1000 #define MPU9250_GYRO_DEFAULT_RATE 1000
#define MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ 30 #define MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ 30
#define MPU9250_GYRO_DEFAULT_DRIVER_FILTER_FREQ 30 #define MPU9250_GYRO_DEFAULT_DRIVER_FILTER_FREQ 30
#define MPU9250_PUB_RATE 250
extern "C" { __EXPORT int df_mpu9250_wrapper_main(int argc, char *argv[]); } extern "C" { __EXPORT int df_mpu9250_wrapper_main(int argc, char *argv[]); }
...@@ -198,8 +197,8 @@ DfMpu9250Wrapper::DfMpu9250Wrapper(bool mag_enabled, enum Rotation rotation) : ...@@ -198,8 +197,8 @@ DfMpu9250Wrapper::DfMpu9250Wrapper(bool mag_enabled, enum Rotation rotation) :
_accel_orb_class_instance(-1), _accel_orb_class_instance(-1),
_gyro_orb_class_instance(-1), _gyro_orb_class_instance(-1),
_mag_orb_class_instance(-1), _mag_orb_class_instance(-1),
_accel_int(MPU9250_NEVER_AUTOPUBLISH_US, false), _accel_int(1000000 / MPU9250_PUB_RATE, false),
_gyro_int(MPU9250_NEVER_AUTOPUBLISH_US, true), _gyro_int(1000000 / MPU9250_PUB_RATE, true),
_accel_filter_x(MPU9250_ACCEL_DEFAULT_RATE, MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ), _accel_filter_x(MPU9250_ACCEL_DEFAULT_RATE, MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ),
_accel_filter_y(MPU9250_ACCEL_DEFAULT_RATE, MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ), _accel_filter_y(MPU9250_ACCEL_DEFAULT_RATE, MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ),
_accel_filter_z(MPU9250_ACCEL_DEFAULT_RATE, MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ), _accel_filter_z(MPU9250_ACCEL_DEFAULT_RATE, MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ),
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment