New PI controller for the motors
Merge pull request #1 from cjpedc/master

New PI controller for the motors