added sd support, PID coefficients adjusted