20140728 - Simplified PID implementation