updated motor.cpp and tested diffdrive

Compatible for Jessie release.
diffdrive updated to accomodate changes and tested as well