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.