Setting the I and D values needs to be scaled by the sample time.
Whenever I and D are set they are now scaled appropriately
Merge pull request #216 from wolfmanjm/fix/pid

Fix/pid
Merge remote-tracking branch 'upstream/edge' into edge