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

etb CL test (#1361)

This commit is contained in:
Matthew Kennedy 2020-04-24 14:54:03 -07:00 committed by GitHub
parent 8b5f689e54
commit c9ca028c9c
1 changed files with 24 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

24
unit_tests/tests/test_etb.cpp
View File

@ -290,3 +290,27 @@ TEST(etb, setOutputOutOfRangeLow) {
// Off scale - should get clamped to -90%
etb.setOutput(-110);
}
TEST(etb, closedLoopPid) {
pid_s pid = {};
pid.pFactor = 5;
pid.maxValue = 75;
pid.minValue = -60;
EtbController etb;
etb.init(nullptr, 0, &pid, nullptr);
// Disable autotune for now
Engine e;
e.etbAutoTune = false;
etb.engine = &e;
// Setpoint greater than actual, should be positive output
EXPECT_FLOAT_EQ(etb.getClosedLoop(50, 40).value_or(-1), 50);
// Likewise but negative
EXPECT_FLOAT_EQ(etb.getClosedLoop(50, 52).value_or(-1), -10);
// Test PID limiting
EXPECT_FLOAT_EQ(etb.getClosedLoop(50, 70).value_or(-1), -60);
EXPECT_FLOAT_EQ(etb.getClosedLoop(50, 30).value_or(-1), 75);
}