439,10 → 439,10 |
int32_t deltaOffsets[3] = { 0, 0, 0 }; |
|
// Set the filters... to be removed again, once some good settings are found. |
GYROS_PID_FILTER = (dynamicParams.UserParams[4] & (0x7 & (1<<0))) + 1; |
GYROS_PID_FILTER = (staticParams.sensorFilterSettings & (0x7 & (1<<0))) + 1; |
GYROS_ATT_FILTER = 1; |
GYROS_D_FILTER = (dynamicParams.UserParams[4] & (0x3 & (1<<4))) + 1; |
ACC_FILTER = (dynamicParams.UserParams[4] & (0x3 & (1<<6))) + 1; |
GYROS_D_FILTER = (staticParams.sensorFilterSettings & (0x3 & (1<<4))) + 1; |
ACC_FILTER = (staticParams.sensorFilterSettings & (0x3 & (1<<6))) + 1; |
|
gyro_calibrate(); |
|