pid controller now working