28 lines
590 B
C
28 lines
590 B
C
#ifndef IMU_PROCESSING_H
|
|
#define IMU_PROCESSING_H
|
|
|
|
#include "imu.h"
|
|
|
|
|
|
#define ACCEL_SENS_SCALE_FACTOR 8192.0f
|
|
#define GYRO_SENS_SCALE_FACTOR 16.4f
|
|
#define PI 3.14159265359f
|
|
#define DEG2RAD PI / 180.0f
|
|
|
|
typedef struct
|
|
{
|
|
float ax, ay, az; // g
|
|
float gx, gy, gz; // dps
|
|
} imu_scaled_t;
|
|
|
|
void imu_processing_init();
|
|
|
|
void imu_read_scaled(imu_scaled_t* out, const uint8_t* allowed_calib);
|
|
void imu_calib(imu_raw_t* imu, long gyrLim, long accZero, long accMax);
|
|
|
|
void imu_calibrate();
|
|
|
|
float normalize(float value, float scale, float min, float max);
|
|
long absl(long value);
|
|
|
|
#endif |