Implement discrete PID
Add discrete PID update docs