Merge pull request #1 from amarschn/master

added a mapping function to map PID control
found the issue - float64s wont work on arduino. negative numbers are set to 0. we need to set the incoming twist to numbers between 0 and 255.
Merge pull request #1 from ericdanz/master

Merged Eric's changes