auto-sync

This commit is contained in:
rusEfi 2015-03-21 22:05:10 -05:00
parent bb10956832
commit 16f8c7c42b
3 changed files with 9 additions and 9 deletions

View File

@ -16,7 +16,7 @@ Pid::Pid(float pFactor, float iFactor, float dFactor, float minResult, float max
this->minResult = minResult;
this->maxResult = maxResult;
integration = 0;
iTerm = 0;
prevError = 0;
}
@ -24,17 +24,17 @@ float Pid::getValue(float target, float input, float dTime) {
float error = target - input;
float pTerm = pFactor * error;
integration += iFactor * dTime * error;
iTerm += iFactor * dTime * error;
float dTerm = dFactor / dTime * (error - prevError);
prevError = error;
float result = pTerm + integration + dTerm;
float result = pTerm + iTerm + dTerm;
if (result > maxResult) {
// integration -= result - maxResult;
// iTerm -= result - maxResult;
result = maxResult;
} else if (result < minResult) {
// integration += minResult - result;
// iTerm += minResult - result;
result = minResult;
}
return result;
@ -48,7 +48,7 @@ void Pid::updateFactors(float pFactor, float iFactor, float dFactor) {
}
void Pid::reset(void) {
integration = 0;
iTerm = 0;
prevError = 0;
}
@ -61,7 +61,7 @@ float Pid::getI(void) {
}
float Pid::getIntegration(void) {
return integration;
return iTerm;
}
float Pid::getD(void) {

View File

@ -26,7 +26,7 @@ private:
float minResult;
float maxResult;
float integration;
float iTerm;
float prevError;
};

View File

@ -136,7 +136,7 @@ public class TcpConnector implements LinkConnector {
String command = LinkManager.encodeCommand(text);
FileLog.MAIN.logLine("Writing " + command);
try {
writer.write(command + "\r\n");
writer.write(command + "\n");
writer.flush();
} catch (IOException e) {
withError = true;