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:
@@ -95,7 +95,7 @@ bool Interlock_isClosed(struct Interlock* self)
|
||||
IODevice_read((struct IODevice*)self->NO.io, &no, 1, &actualLength);
|
||||
IODevice_read((struct IODevice*)self->NC.io, &nc, 1, &actualLength);
|
||||
|
||||
if ((no != 0) && (nc == 0))
|
||||
if ((nc != 0) && (no == 0))
|
||||
{
|
||||
returnValue = true;
|
||||
}
|
||||
|
||||
@@ -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