Corrected Motor Controller functions

Removed the unnecessary delays to make the function faster.
Merge branch 'master' of https://github.com/purduerov/X7-hardware