Updated Interlocks (NO and NC inverted)
git-svn-id: https://svn.vbchaos.nl/svn/hsb/trunk@256 05563f52-14a8-4384-a975-3d1654cca0fa
This commit is contained in:
@@ -116,7 +116,7 @@ int PID_calculate(struct Pid* self, int error)
|
||||
|
||||
// Calculate proportional
|
||||
pTerm = (self->Kp * error);
|
||||
LOGGER_WARNING(mainLog, "pTerm %d, Kp %d, error %d", pTerm, self->Kp, error);
|
||||
LOGGER_WARNING(mainLog, "pTerm %d, iTerm %d, Kp %d, Ki %d, error %d", pTerm, self->iTerm, self->Kp, self->Ki, error);
|
||||
|
||||
returnValue = (self->iTerm + dTerm + pTerm) / PID_FIXED_POINT_FACTOR;
|
||||
self->input_d1 = error;
|
||||
|
||||
Reference in New Issue
Block a user