Team Virgo v3 / Orion_newPCB_test_LV

Implement new controller

Dependencies:   mbed-rtos mbed QEI BNO055 MPU6050_DMP_Nucleo-I2Cdev virgo3_imuHandler_Orion_PCB MAX17048 Servo

Fork of Orion_newPCB_test by Team Virgo v3

Diff: Configuration/imuCalib.h

Revision:
2:761e3c932ce0
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Configuration/imuCalib.h	Mon Jan 18 06:00:43 2016 +0000
@@ -0,0 +1,18 @@
+#ifndef imuCalib_H
+#define imuCalib_H
+
+//** IMU offsets ********************************
+#define MPU6050_Offset_Ax 150
+#define MPU6050_Offset_Ay -350
+#define MPU6050_Offset_Az 1000
+#define MPU6050_Offset_Gx -110
+#define MPU6050_Offset_Gy 5
+#define MPU6050_Offset_Gz 0
+
+//** IMU yaw drift correction polynomial ********
+#define kp1  2.207/(1000*1000*10)
+#define kp2 -7.921/1000
+#define kp3 -0.1917
+#define eq_correction  0.01
+
+#endif
\ No newline at end of file