Added Motor Driver code
Removed ISR. Removed higher level function.
Merge pull request #8 from QUT-EESS-org/Shaun/New

Shaun/new