Fixed bug in motor windup calculation
This commit is contained in:
parent
26955c1c12
commit
800fb1876e
Binary file not shown.
|
@ -169,7 +169,7 @@ float motorControl(byte motorID, int speedCMD_, int saturation, float dbPos_, fl
|
||||||
windup = saturation - speedCMD_;
|
windup = saturation - speedCMD_;
|
||||||
speedCMD_ = saturation;
|
speedCMD_ = saturation;
|
||||||
} else if (speedCMD_ < -saturation) {
|
} else if (speedCMD_ < -saturation) {
|
||||||
windup = saturation - speedCMD_;
|
windup = -saturation - speedCMD_;
|
||||||
speedCMD_ = -saturation;
|
speedCMD_ = -saturation;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue