2017-09-14 04:58:58 -07:00
|
|
|
/*
|
|
|
|
* test_pid_auto.cpp
|
|
|
|
*
|
|
|
|
* Created on: Sep 14, 2017
|
|
|
|
* @author Andrey Belomutskiy, (c) 2012-2017
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
#include "main.h"
|
2017-09-14 18:00:28 -07:00
|
|
|
#include "test_pid_auto.h"
|
2017-09-14 18:49:26 -07:00
|
|
|
#include "pid_auto_tune.h"
|
2017-09-14 04:58:58 -07:00
|
|
|
|
|
|
|
efitimems_t mockTimeMs = 0;
|
|
|
|
|
|
|
|
efitimems_t currentTimeMillis(void) {
|
|
|
|
return mockTimeMs;
|
|
|
|
}
|
|
|
|
|
2017-09-14 18:49:26 -07:00
|
|
|
Logging logging;
|
|
|
|
|
|
|
|
static zigZagValue(int index) {
|
|
|
|
int i = index % 20;
|
|
|
|
if ( i <= 10)
|
|
|
|
return i * 10;
|
|
|
|
return (20 - i) * 10;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
2017-09-14 18:00:28 -07:00
|
|
|
void testPidAutoZigZag() {
|
|
|
|
mockTimeMs = 0;
|
2017-09-14 04:58:58 -07:00
|
|
|
|
2017-09-14 18:49:26 -07:00
|
|
|
PID_AutoTune at;
|
|
|
|
|
|
|
|
at.outputStart = 50;
|
|
|
|
|
|
|
|
at.input = zigZagValue(mockTimeMs);
|
|
|
|
at.Runtime(&logging);
|
|
|
|
|
|
|
|
mockTimeMs++;
|
|
|
|
at.input = zigZagValue(mockTimeMs);
|
|
|
|
at.Runtime(&logging);
|
|
|
|
assertEqualsLM("min@1", 0, at.absMin);
|
|
|
|
assertEqualsLM("max@1", 10, at.absMax);
|
|
|
|
assertEqualsM("peakCount", 0, at.peakCount);
|
|
|
|
|
|
|
|
for (;mockTimeMs<=11;mockTimeMs++) {
|
|
|
|
at.input = zigZagValue(mockTimeMs);
|
|
|
|
at.Runtime(&logging);
|
|
|
|
|
|
|
|
}
|
|
|
|
assertEqualsLM("min@11", 0, at.absMin);
|
|
|
|
assertEqualsLM("max@11", 100, at.absMax);
|
|
|
|
assertEqualsM("peakCount", 0, at.peakCount);
|
|
|
|
|
|
|
|
for (;mockTimeMs<=21;mockTimeMs++) {
|
|
|
|
at.input = zigZagValue(mockTimeMs);
|
|
|
|
at.Runtime(&logging);
|
|
|
|
}
|
|
|
|
assertEqualsM("peakCount", 1, at.peakCount);
|
|
|
|
|
|
|
|
for (;mockTimeMs<=41;mockTimeMs++) {
|
|
|
|
at.input = zigZagValue(mockTimeMs);
|
|
|
|
at.Runtime(&logging);
|
|
|
|
}
|
|
|
|
assertEqualsM("peakCount", 2, at.peakCount);
|
|
|
|
|
|
|
|
|
2017-09-14 18:00:28 -07:00
|
|
|
}
|