[imu] Fix new imu structure

This commit is contained in:
Freek van Tienen
2022-05-18 13:21:22 +02:00
parent 7c7cfbc395
commit ff37e63af4
120 changed files with 826 additions and 1302 deletions
-33
View File
@@ -37,39 +37,6 @@
#define FAILSAFE_HOME_RADIUS 100
#define SECTION_IMU 1
#define IMU_GYRO_P_SENS 4.359
#define IMU_GYRO_P_SENS_NUM 4359
#define IMU_GYRO_P_SENS_DEN 1000
#define IMU_GYRO_Q_SENS 4.359
#define IMU_GYRO_Q_SENS_NUM 4359
#define IMU_GYRO_Q_SENS_DEN 1000
#define IMU_GYRO_R_SENS 4.359
#define IMU_GYRO_R_SENS_NUM 4359
#define IMU_GYRO_R_SENS_DEN 1000
#define IMU_ACCEL_X_NEUTRAL -85
#define IMU_ACCEL_Y_NEUTRAL 51
#define IMU_ACCEL_Z_NEUTRAL -76
#define IMU_ACCEL_X_SENS 2.44493965424
#define IMU_ACCEL_X_SENS_NUM 61989
#define IMU_ACCEL_X_SENS_DEN 25354
#define IMU_ACCEL_Y_SENS 2.43424121497
#define IMU_ACCEL_Y_SENS_NUM 61579
#define IMU_ACCEL_Y_SENS_DEN 25297
#define IMU_ACCEL_Z_SENS 2.44715908645
#define IMU_ACCEL_Z_SENS_NUM 4307
#define IMU_ACCEL_Z_SENS_DEN 1760
#define IMU_MAG_X_NEUTRAL 0
#define IMU_MAG_Y_NEUTRAL 0
#define IMU_MAG_Z_NEUTRAL 0
#define IMU_MAG_X_SENS 7.28514789391
#define IMU_MAG_X_SENS_NUM 23888
#define IMU_MAG_X_SENS_DEN 3279
#define IMU_MAG_Y_SENS 7.33022132691
#define IMU_MAG_Y_SENS_NUM 21199
#define IMU_MAG_Y_SENS_DEN 2892
#define IMU_MAG_Z_SENS 7.57102035692
#define IMU_MAG_Z_SENS_NUM 63589
#define IMU_MAG_Z_SENS_DEN 8399
#define IMU_BODY_TO_IMU_PHI 0.
#define IMU_BODY_TO_IMU_THETA 0.
#define IMU_BODY_TO_IMU_PSI 0