attempted to fix problems with the D control loop
converted motor values to floats to fix PD errors
PD control is now working, needs to be tuned
Merge pull request #7 from ekovacs3/D

D