i-term zeroing fixed
http://www.multiwii.com/forum/viewtopic.php?p=53441#p53402
This commit is contained in:
parent
ae0f842266
commit
fe5a864a85
|
@ -194,7 +194,7 @@ static void pidMultiWii(pidProfile_t *pidProfile, controlRateConfig_t *controlRa
|
|||
PTermGYRO = rcCommand[axis];
|
||||
|
||||
errorGyroI[axis] = constrain(errorGyroI[axis] + error, -16000, +16000); // WindUp
|
||||
if ((abs(gyroData[axis]) > (640 * 4)) || (abs(rcCommand[axis]) > 50))
|
||||
if ((abs(gyroData[axis]) > (640 * 4)) || (axis == FD_YAW && abs(rcCommand[axis]) > 50))
|
||||
errorGyroI[axis] = 0;
|
||||
|
||||
ITermGYRO = (errorGyroI[axis] / 125 * pidProfile->I8[axis]) / 64;
|
||||
|
|
Loading…
Reference in New Issue