double PID(double In)
{
out = P_gain * In + I_gain * InSum + D_gain * InDiff;
InSum += In;
InDiff = In - InOld;
InOld = In;
return out;
}
It takes some 10-20 machine instructions.