Merge pull request #1 from bradydoll/develop

New Interface
Merge pull request #3 from bradydoll/develop

Support Kp values over 1000.
Merge pull request #4 from bradydoll/develop

More information in logs.