Results 1 issues of Slaih

Why did you do output equation like this: output += uPID->OutputSum - uPID->Kd * dInput; I think that uPID->Kd * dInput value should be added to output instead of substracted.