FOME-Tech
/
fome-fw
mirror of https://github.com/FOME-Tech/fome-fw.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

#435

This commit is contained in:
rusefi 2017-06-02 22:28:12 -04:00
parent 3fea210652
commit 6b61023b6d
2 changed files with 8 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
firmware/controllers/math/pid.cpp
View File

@ -50,11 +50,11 @@ float Pid::getValue(float target, float input, float dTime) {
* If we have exceeded the ability of the controlled device to hit target, the I factor will keep accumulating and approach infinity.
* Here we limit the I-term #353
*/
if (iTerm > pid->maxValue - (pTerm + dTerm + pid->offset))
iTerm = pid->maxValue - (pTerm + dTerm + pid->offset);
if (iTerm > pid->maxValue)
iTerm = pid->maxValue;
if (iTerm < pid->minValue - (pTerm + dTerm + pid->offset))
iTerm = pid->minValue - (pTerm + dTerm + pid->offset);
if (iTerm < pid->minValue)
iTerm = pid->minValue;
float result = pTerm + iTerm + dTerm + pid->offset;
if (result > pid->maxValue) {

10
unit_tests/test_idle_controller.cpp
View File

@ -57,14 +57,12 @@ void testPidController(void) {
assertEqualsM("target=50, input=0 iTerm", 0, pid.iTerm);
assertEqualsM("target=50, input=70", 0, pid.getValue(/*target*/50, /*input*/70));
assertEqualsM("target=50, input=70 iTerm", 20, pid.iTerm);
assertEqualsM("target=50, input=70 iTerm", 0, pid.iTerm);
assertEqualsM("target=50, input=70 #2", 0, pid.getValue(/*target*/50, /*input*/70));
// WOW, we are getting non-zero iTerm while iFactor is zero?!
assertEqualsM("target=50, input=70 iTerm #2", 20, pid.iTerm);
assertEqualsM("target=50, input=70 iTerm #2", 0, pid.iTerm);
// and now we inherit this iTerm even for cases where targer==input?! NOT RIGHT
assertEqualsM("target=50, input=50", 20, pid.getValue(/*target*/50, /*input*/50));
assertEqualsM("target=50, input=50 iTerm", 20, pid.iTerm);
assertEqualsM("target=50, input=50", 0, pid.getValue(/*target*/50, /*input*/50));
assertEqualsM("target=50, input=50 iTerm", 0, pid.iTerm);
}