Added LPF to transfer function. Need method to solve for PID coefficients.