added a mapping function to map PID control
Merge pull request #1 from amarschn/master

added a mapping function to map PID control