Some little work on PID's
Merge pull request #76 from Kenny9999/master

Some little work on PID's